Added buildSentrySwitchMessage() (#15)

yoziru · Dec 7, 2024 · 879c37e · 879c37e
1 parent cd7be88
commit 879c37e
Show file tree

Hide file tree

Showing 2 changed files with 32 additions and 0 deletions.
diff --git a/include/client.h b/include/client.h
@@ -168,6 +168,11 @@ namespace TeslaBLE
         pb_byte_t *output_buffer,
         size_t *output_length);
 
+    int buildSentrySwitchMessage(
+        bool isOn,
+        pb_byte_t *output_buffer,
+        size_t *output_length);
+
     Peer *getPeer(UniversalMessage_Domain domain)
     {
       if (domain == UniversalMessage_Domain_DOMAIN_VEHICLE_SECURITY)

diff --git a/src/client.cpp b/src/client.cpp
@@ -775,6 +775,33 @@ namespace TeslaBLE
     return 0;
   }
 
+  int Client::buildSentrySwitchMessage(bool isOn,
+                                       pb_byte_t *output_buffer,
+                                       size_t *output_length)
+  {
+    CarServer_Action action = CarServer_Action_init_default;
+    action.which_action_msg = CarServer_Action_vehicleAction_tag;
+
+    CarServer_VehicleAction vehicle_action = CarServer_VehicleAction_init_default;
+    vehicle_action.which_vehicle_action_msg = CarServer_VehicleAction_vehicleControlSetSentryModeAction_tag;
+    CarServer_VehicleControlSetSentryModeAction vehicle_action_msg = CarServer_VehicleControlSetSentryModeAction_init_default;
+    vehicle_action_msg.on = isOn;
+    vehicle_action.vehicle_action_msg.vehicleControlSetSentryModeAction = vehicle_action_msg;
+    action.action_msg.vehicleAction = vehicle_action;
+
+    size_t universal_encode_buffer_size = UniversalMessage_RoutableMessage_size;
+    pb_byte_t universal_encode_buffer[universal_encode_buffer_size];
+    int status = this->buildCarServerActionPayload(&action, universal_encode_buffer, &universal_encode_buffer_size);
+    if (status != 0)
+    {
+      LOG_ERROR("Failed to build car action message");
+      return status;
+    }
+    this->prependLength(universal_encode_buffer, universal_encode_buffer_size,
+                        output_buffer, output_length);
+    return 0;
+  }
+
   int Client::buildHVACMessage(bool isOn,
                                pb_byte_t *output_buffer,
                                size_t *output_length)