From a1a1c89b91fc9476c51981699aaa7c2bccdd8570 Mon Sep 17 00:00:00 2001
From: tao_z <tzj0429@163.com>
Date: Sun, 07 Aug 2022 14:19:02 +0800
Subject: [PATCH] SX7H初步完成
---
Shifter.py | 183 ++++++++++++++++++++++++++++++++++++++++-----
1 files changed, 163 insertions(+), 20 deletions(-)
diff --git a/Shifter.py b/Shifter.py
index fb8f852..48472d0 100644
--- a/Shifter.py
+++ b/Shifter.py
@@ -1,17 +1,18 @@
-
from ShifterDefine import *
import struct
from udsoncan import DidCodec
import configparser
+import cantools
+
+ProjectDBC = cantools.database.load_file("DBC/SX7H.dbc")
class AsciiCodec(DidCodec):
def __init__(self, string_len=None):
if string_len is None:
- raise ValueError(
- "You must provide a length to the AsciiCodec")
+ raise ValueError("You must provide a length to the AsciiCodec")
self.string_len = string_len
def encode(self, string_ascii):
@@ -36,6 +37,7 @@
class PartNumberCodec(DidCodec):
+
def __init__(self, byte_len=None):
if byte_len is None:
raise ValueError(
@@ -68,6 +70,7 @@
class PartNumberVersionCodec(DidCodec):
+
def __init__(self, byte_len=None):
if byte_len is None:
raise ValueError(
@@ -115,7 +118,7 @@
data = bytearray()
for i in range(self.byte_len):
- part = string_ascii[2 * i: 2 * i + 2]
+ part = string_ascii[2 * i:2 * i + 2]
data.append(int(part, 16))
return data
@@ -131,28 +134,52 @@
return self.byte_len
+UnlockButton_dic = {"Unlock Button No Request": 0, "Unlock Button Request": 1}
+
+
class ShifterClass():
+
def __init__(self):
- self.position = ShifterPosition(0)
- self.Pbutton = 0
- self.UnlockButton = 0
+ self.position = None
+ self.Pbutton = None
+ self.UnlockButton = None
self.Voltage = 0
self.canid = ShifterCANID()
+
self.did_config = {
+ 0x2100: PartNumberCodec(1),
+ 0x2101: PartNumberCodec(1),
+ 0x2103: AsciiCodec(8),
+ 0x2104: AsciiCodec(4),
+ 0x2105: AsciiCodec(16),
+ 0x2106: PartNumberCodec(1),
+ 0xF187: AsciiCodec(16),
+ 0x2108: AsciiCodec(18),
+ 0xF18A: AsciiCodec(10),
+ 0x210B: BCDCodec(4),
+ 0xF18C: AsciiCodec(14),
0xF190: AsciiCodec(17),
- 0xF1B1: AsciiCodec(9),
- 0xF1B2: AsciiCodec(16),
-
- 0xF1D0: PartNumberCodec(4),
- 0xF1D1: PartNumberVersionCodec(2),
- 0xF1D2: PartNumberCodec(4),
- 0xF1D3: PartNumberVersionCodec(2),
- 0xF0DF: PartNumberVersionCodec(1),
-
- 0xF187: AsciiCodec(21),
- 0xF195: AsciiCodec(16),
- 0xF198: BCDCodec(8),
- 0xF199: BCDCodec(4),
+ 0xF193: AsciiCodec(26),
+ 0xF195: AsciiCodec(28),
+ 0x2110: AsciiCodec(8),
+ 0x2111: AsciiCodec(16),
+ 0x2112: BCDCodec(4),
+ 0x2113: BCDCodec(4),
+ 0x2116: PartNumberCodec(2),
+ 0x2118: PartNumberCodec(1),
+ 0x2119: PartNumberCodec(1),
+ 0x211A: PartNumberCodec(1),
+ 0x211B: PartNumberCodec(1),
+ 0x211c: PartNumberCodec(2),
+ 0xF197: AsciiCodec(8),
+ 0xF15a: AsciiCodec(10),
+ 0xF15B: AsciiCodec(10),
+ 0xDF00: PartNumberCodec(1),
+ 0xDF01: PartNumberCodec(2),
+ 0xDF02: PartNumberCodec(1),
+ 0xDF03: PartNumberCodec(3),
+ 0xDF04: PartNumberCodec(3),
+ 0x1000: PartNumberCodec(2),
}
try:
config = configparser.ConfigParser()
@@ -166,3 +193,119 @@
self.canid.phy_rxId = 0x742
self.canid.fun_rxId = 0x7df
self.canid.normalid = 0x420
+ self.SA1_message = ProjectDBC.get_message_by_name('SA1')
+
+ def FramUnpack(self, id=0x420, frame=[]):
+ input_signal = ProjectDBC.decode_message(id, frame)
+ # part_str = str(input_signal['SA1_Status_ParkButtonReq'])
+ # print(type(part_str))
+ # if input_signal['SA1_Status_ParkButtonReq'] == 'No request':
+ # print('yes')
+ # print(SA1_Status_ParkButtonReq_dic[part_str])
+ self.Pbutton = SA1_Status_ParkButtonReq_dic[str(
+ input_signal['SA1_Status_ParkButtonReq'])]
+ self.UnlockButton = SA1_Status_UnlockButtonReq_dic[str(
+ input_signal['SA1_Status_UnlockButtonReq'])]
+ self.position = SA1_Status_GearShftPosReq_dic[str(
+ input_signal['SA1_Status_GearShftPosReq'])]
+
+ def PackFrame(self, dic):
+ data = self.SA1_message.encode({
+ 'SA1_Status_PRNDL':
+ 0,
+ 'SA1_Status_GearShftPosReq':
+ SA1_Status_GearShftPosReq_dic[self.position],
+ 'SA1_Status_ParkButtonReq':
+ SA1_Status_ParkButtonReq_dic[self.Pbutton],
+ "SA1_ShifterManualSignal":
+ 0,
+ "SA1_ShifterModeSignal":
+ 0,
+ "SA1_Status_ShftSensSng_Fault":
+ 0,
+ "SA1_IND_ShifterMisUsd":
+ 0,
+ "SA1_Live_counter":
+ 1,
+ "SA1_Status_UnlockButtonReq":
+ SA1_Status_UnlockButtonReq_dic[self.UnlockButton],
+ "SA1_Status_EcoShifterModeReq":
+ 0,
+ "SA1_Status_RqGearPosInV":
+ 0xf,
+ "SA1_Status_ShiftPosValidFlag":
+ 0,
+ })
+ return data
+
+
+class VehicleClass():
+
+ def __init__(self):
+ self.Odm = 0
+ self.speed = 0
+ self.brake = 0
+ self.ShiftLeverPos = 'P'
+ self.pre_ShiftLeverPos = 'P'
+ self.max_pos = 'Shifter position Zero'
+ self.IC1_message = ProjectDBC.get_message_by_name('IC1')
+ self.TCU2_message = ProjectDBC.get_message_by_name('TCU2')
+ self.ABS1_message = ProjectDBC.get_message_by_name('ABS1')
+ self.Engine2_message = ProjectDBC.get_message_by_name('Engine2')
+
+ def pack_IC1(self, odm):
+ self.Odm = odm
+ data = self.IC1_message.encode({"odometer_value": odm})
+ return data
+
+ def pack_TCU2(self, shiftpos):
+ #from value get key
+ self.ShiftLeverPos = [
+ k for k, v in TCU2_ShiterLevel_dic.items() if v == shiftpos
+ ][0]
+ data = self.TCU2_message.encode({
+ "ShiftLeverPos": shiftpos,
+ "TCUDrivingMode": 0,
+ "ActualGear": 0
+ })
+ return data
+
+ def pack_ABS1(self, speed):
+ self.speed = speed
+ data = self.ABS1_message.encode({"vehicle_speed": speed})
+ return data
+
+ def pack_Engine2(self, brake):
+ self.brake = brake
+ data = self.Engine2_message.encode({"brake_pedal_status ": brake})
+ return data
+
+ def ShiftLogic(self, shift: ShifterClass):
+ reqpos = 0
+ if shift.Pbutton == SA1_Status_ParkButtonReq_dic[
+ 'Driver request park button']:
+ reqpos = TCU2_ShiterLevel_dic['P']
+ self.pre_ShiftLeverPos = "P"
+ self.max_pos = 'Shifter position Zero'
+ elif (shift.position >= SA1_Status_GearShftPosReq_dic['M-']) and (
+ shift.position <= SA1_Status_GearShftPosReq_dic['M']):
+ reqpos = TCU2_ShiterLevel_dic['M']
+ self.pre_ShiftLeverPos = "P"
+ self.max_pos = 'Shifter position Zero'
+ elif shift.position is SA1_Status_GearShftPosReq_dic[
+ 'Shifter not initialized']:
+ pass
+ else:
+ if shift.position is not SA1_Status_GearShftPosReq_dic[
+ 'Shifter position Zero']:
+ self.max_pos = ShiftMaxPosMap_dic[self.max_pos][shift.position]
+ reqpos = GearShiftMap_dic[self.pre_ShiftLeverPos][self.max_pos]
+ else:
+ reqpos = GearShiftMap_dic[self.pre_ShiftLeverPos][self.max_pos]
+ self.max_pos = 'Shifter position Zero'
+ self.pre_ShiftLeverPos = [
+ k for k, v in TCU2_ShiterLevel_dic.items() if v == reqpos
+ ][0]
+
+ data = self.pack_TCU2(reqpos)
+ return data
--
Gitblit v1.8.0