wip

common/params.cc

@@ -234,6 +234,7 @@ std::unordered_map<std::string, uint32_t> keys = {
     {"CarSpeedLimit", PERSISTENT},
     {"CarSpeedLimitLiteral", PERSISTENT},
     {"SpeedLimitLatDesired", PERSISTENT},
+    ("adjustedCruise", PERSISTENT),
     {"CECurves", PERSISTENT},
     {"CECurvesLead", PERSISTENT},
     {"CENavigation", PERSISTENT},

selfdrive/frogpilot/controls/frogpilot_planner.py

@@ -274,6 +274,8 @@ class FrogPilotPlanner:
 
     frogpilotPlan.vtscControllingCurve = bool(self.mtsc_target > self.vtsc_target)
 
+    self.params.set_int("adjustedCruise", frogpilotPlan.adjustedCruise)
+
     pm.send('frogpilotPlan', frogpilot_plan_send)
 
   def update_frogpilot_params(self):

selfdrive/ui/qt/onroad.cc

@@ -452,6 +452,10 @@ void AnnotatedCameraWidget::drawHud(QPainter &p) {
   QString SpeedLimitLatDesired = QString::number(paramsMemory.getInt("SpeedLimitLatDesired"));
   drawSpeedWidget(p, 60, 45 + (225 * 2), QString("Exp"), SpeedLimitLatDesired, QColor(0xff, 0xff, 0xff));
 
+  // Todo: needs to be changed to calculate off of actual speed limit for release
+  QString adjustedCruise = QString::number(paramsMemory.getInt("adjustedCruise"));
+  drawSpeedWidget(p, 60, 45 + (225 * 2), QString("VTSC"), adjustedCruise, QColor(0xff, 0xff, 0xff));
+
   // Todo: lead speed
   // Todo: Experimental speed