wip

selfdrive/car/hyundai/hyundaicanfd.py

@@ -99,6 +99,38 @@ def create_buttons_alt(packer, CP, CAN, cnt, btn):
   bus = CAN.ECAN # if CP.flags & HyundaiFlags.CANFD_HDA2 else CAN.CAM
   return packer.make_can_msg("CRUISE_BUTTONS_ALT", bus, values)
 
+
+def create_acc_set_speed(packer, CP, CAN, cruise_info_copy, speed):
+  # why are we executing this at all?
+  # TODO: why do we copy different values here?
+  if CP.flags & HyundaiFlags.CANFD_CAMERA_SCC.value:
+    values = {s: cruise_info_copy[s] for s in [
+      "COUNTER",
+      "CHECKSUM",
+      "NEW_SIGNAL_1",
+      "MainMode_ACC",
+      "ACCMode",
+      "ZEROS_9",
+      "CRUISE_STANDSTILL",
+      "ZEROS_5",
+      "DISTANCE_SETTING",
+      "VSetDis",
+    ]}
+  else:
+    values = {s: cruise_info_copy[s] for s in [
+      "COUNTER",
+      "CHECKSUM",
+      "ACCMode",
+      "VSetDis",
+      "CRUISE_STANDSTILL",
+    ]}
+  values.update({
+    "ACCMode": 1, # testing 1 instead of 4
+    "VSetDis", speed
+  })
+  return packer.make_can_msg("SCC_CONTROL", CAN.ECAN, values)
+
+
 def create_acc_cancel(packer, CP, CAN, cruise_info_copy):
   # why are we executing this at all?
   # TODO: why do we copy different values here?