feat: Implement a method to change the device id

src/Device.cpp

@@ -42,6 +42,10 @@ uint32_t Device::getSerialNumber() const {
     return m_serial_number;
 }
 
+canbus::Message Device::querySetId(uint8_t id, uint32_t serial_number) {
+    return queryWrite<uint32_t>(OID_CAN_ID, id, serial_number);
+}
+
 canbus::Message Device::queryTransmitPeriod() {
     return queryRead(OID_TRANSMIT_PERIOD);
 }

src/Device.hpp

@@ -48,6 +48,7 @@ namespace power_whisperpower {
         static const int OID_SOFTWARE_VERSION = 0x100A;
         static const int OID_SERIAL_NUMBER = 0x1018;
         static const int OID_TRANSMIT_PERIOD = 0x9100;
+        static const int OID_CAN_ID = 0x9200;
 
     protected:
         virtual void processRead(
@@ -60,6 +61,7 @@ namespace power_whisperpower {
 
         bool isWaiting() const;
 
+        canbus::Message querySetId(uint8_t id, uint32_t serial_number);
         /** How long we have been waiting for a specific reply from the device
          */
         base::Time getElapsedWaitTime() const;

src/Main.cpp

@@ -96,6 +96,20 @@ int main(int argc, char** argv)
         }
         std::cout << wp_device.getConfig() << std::endl;
     }
+    else if (cmd == "set_id") {
+        if (argc != 7)
+        {
+            std::cerr << "wrong number of arguments" << std::endl;
+        }
+        power_whisperpower::Device device(device_group, device_id);
+        waitResult(*can_device, device, device.querySerialNumber());
+        uint32_t serial_number = device.getSerialNumber();
+        int device_new_id(std::stoi(argv[6]));
+        waitResult(*can_device, device, device.querySetId(device_new_id, serial_number));
+
+        // TODO: get the actual returned id
+        std::cout << "New device Id: " << device_new_id << std::endl;
+    }
 
     return 0;
 }