mirror of
https://github.com/firestar5683/StarPilot.git
synced 2026-06-28 01:52:06 +08:00
Add paramsd Stdev to message (#22443)
* add STD to message * use modified names for car_kf state stdev atttributes * update refs * add modofied cereal * update refs old-commit-hash: 244fbde56e90a937c887b3a24edce7da2ee5c699
This commit is contained in:
+1
-1
Submodule cereal updated: d5a85fe5d7...517fd56398
@@ -139,6 +139,7 @@ def main(sm=None, pm=None):
|
||||
|
||||
if sm.updated['liveLocationKalman']:
|
||||
x = learner.kf.x
|
||||
P = np.sqrt(learner.kf.P.diagonal())
|
||||
if not all(map(math.isfinite, x)):
|
||||
cloudlog.error("NaN in liveParameters estimate. Resetting to default values")
|
||||
learner = ParamsLearner(CP, CP.steerRatio, 1.0, 0.0)
|
||||
@@ -162,6 +163,10 @@ def main(sm=None, pm=None):
|
||||
0.2 <= msg.liveParameters.stiffnessFactor <= 5.0,
|
||||
min_sr <= msg.liveParameters.steerRatio <= max_sr,
|
||||
))
|
||||
msg.liveParameters.steerRatioStd = float(P[States.STEER_RATIO])
|
||||
msg.liveParameters.stiffnessFactorStd = float(P[States.STIFFNESS])
|
||||
msg.liveParameters.angleOffsetAverageStd = float(P[States.ANGLE_OFFSET])
|
||||
msg.liveParameters.angleOffsetFastStd = float(P[States.ANGLE_OFFSET_FAST])
|
||||
|
||||
if sm.frame % 1200 == 0: # once a minute
|
||||
params = {
|
||||
|
||||
@@ -1 +1 @@
|
||||
a69e0b5fe4f506b8b9d372bfa68d8a47cf105a3f
|
||||
d643d6ff47522e00d06035ab0cb9e14d1c0c0ae0
|
||||
Reference in New Issue
Block a user