mawei/StarPilot
1
0
Fork 0
mirror of https://github.com/firestar5683/StarPilot.git synced 2026-07-03 12:32:06 +08:00
Code Issues Packages Projects Releases Wiki Activity

Revert "Try Simons stuff"

Browse Source 
This reverts commit d9ca40bc22.
This commit is contained in:
firestarsdog
2026-02-03 14:09:12 -05:00
parent 67ad32c0f5
commit bcd9a35be8
1 changed files with 10 additions and 10 deletions
Download Patch File Download Diff File Expand all files Collapse all files
selfdrive/car/gm/interface.py
+10 -10
View File
@@ -28,20 +28,20 @@ ACCELERATOR_POS_MSG = 0xbe
NON_LINEAR_TORQUE_PARAMS = {
CAR.CHEVROLET_BOLT_EUV: {
"left": [1.85, 1.8, 0.1, 0, 0.3],
"right": [1.85, 1.8, 0.1, 0, 0.3],
"left": [1.8, 1.1, 0.27, 0.0],
"right": [2.0, 1.0, 0.205, 0.0],
},
CAR.CHEVROLET_BOLT_CC: {
"left": [1.85, 1.8, 0.1, 0, 0.3],
"right": [1.85, 1.8, 0.1, 0, 0.3],
"left": [1.8, 1.1, 0.27, 0.0],
"right": [2.0, 1.0, 0.205, 0.0],
},
CAR.GMC_ACADIA: {
"left": [4.78003305, 1.0, 0.3122, 0.05591772, 0.],
"right": [4.78003305, 1.0, 0.3122, 0.05591772, 0.],
"left": [4.78003305, 1.0, 0.3122, 0.05591772],
"right": [4.78003305, 1.0, 0.3122, 0.05591772],
},
CAR.CHEVROLET_SILVERADO: {
"left": [3.29974374, 1.0, 0.25571356, 0.0465122, 0.],
"right": [3.29974374, 1.0, 0.25571356, 0.0465122, 0.],
"left": [3.29974374, 1.0, 0.25571356, 0.0465122],
"right": [3.29974374, 1.0, 0.25571356, 0.0465122],
},
}
@@ -74,8 +74,8 @@ class CarInterface(CarInterfaceBase):
assert non_linear_torque_params, "The params are not defined"
# Left is positive
side_key = "left" if lateral_acceleration >= 0 else "right"
a, b, c, d, e = non_linear_torque_params[side_key]
sig_input = a * lateral_acceleration + e
a, b, c, d = non_linear_torque_params[side_key]
sig_input = a * lateral_acceleration
sig = np.sign(sig_input) * (1 / (1 + exp(-fabs(sig_input))) - 0.5)
steer_torque = (sig * b) + (lateral_acceleration * c) + d
return float(steer_torque)