SimHub: Read config from pedal. ESP: Added BLE PID

Arduino/Esp32/Main/Controller.cpp

@@ -54,6 +54,8 @@ static const int16_t JOYSTICK_RANGE = JOYSTICK_MAX_VALUE - JOYSTICK_MIN_VALUE;
     bleGamepadConfig.setButtonCount(0);
     bleGamepadConfig.setHatSwitchCount(0);
     bleGamepadConfig.setAutoReport(false);
+    bleGamepadConfig.setPid(chip); // product id
+
     bleGamepad.begin(&bleGamepadConfig);
   }
 

Arduino/Esp32/Main/Main.ino

@@ -779,6 +779,11 @@ void serialCommunicationTask( void * pvParameters )
             Serial.println("Start system identification");
             systemIdentificationMode_b = true;
             break;
+          case 4:
+            DAP_config_st * dap_config_st_local_ptr;
+            dap_config_st_local_ptr = &dap_config_st;
+            Serial.write((char*)dap_config_st_local_ptr, sizeof(DAP_config_st));
+            break;
 
           default:
             Serial.println("Default case:");

SimHubPlugin/SettingsControlDemo.xaml

@@ -69,6 +69,7 @@
             <!-- send config buttons -->
             <styles:SHButtonPrimary Click="ResetPedalPosition_click" HorizontalAlignment="Left" Grid.Row="2" Grid.Column="0" Width="180" >Reset pedal position</styles:SHButtonPrimary>
             <styles:SHButtonPrimary Click="SendConfigToPedal_click" HorizontalAlignment="Left" Grid.Row="3"  Grid.Column="0" Width="180" >Send config to pedal</styles:SHButtonPrimary>
+            <styles:SHButtonPrimary Click="ReadConfigFromPedal_click" HorizontalAlignment="Left" Grid.Row="4"  Grid.Column="0" Width="180" >Read config from pedal</styles:SHButtonPrimary>
 
             <!-- read/write config from/to JSON file buttons -->
             <!--<styles:SHButtonPrimary Click="SaveStructToJson_click" HorizontalAlignment="Left" Grid.Row="4"  Grid.Column="1" Width="180" >Save config to JSON</styles:SHButtonPrimary>-->

SimHubPlugin/SettingsControlDemo.xaml.cs

@@ -247,6 +247,23 @@ public byte[] getBytes(DAP_config_st aux)
         }
 
 
+        public DAP_config_st getConfigFromBytes(byte[] myBuffer)
+        {
+            DAP_config_st aux;
+
+            // see https://stackoverflow.com/questions/31045358/how-do-i-copy-bytes-into-a-struct-variable-in-c
+            int size = Marshal.SizeOf(typeof(DAP_config_st));
+            IntPtr ptr = Marshal.AllocHGlobal(size);
+
+            Marshal.Copy(myBuffer, 0, ptr, size);
+
+            aux = (DAP_config_st)Marshal.PtrToStructure(ptr, typeof(DAP_config_st));
+            Marshal.FreeHGlobal(ptr);
+
+            return aux;
+        }
+
+
         unsafe private UInt16 checksumCalc(byte* data, int length)
         {
 
@@ -992,11 +1009,69 @@ unsafe public void SendConfigToPedal_click(object sender, RoutedEventArgs e)
                     while (Plugin._serialPort[indexOfSelectedPedal_u].BytesToRead > 0)
                     {
                         string message = Plugin._serialPort[indexOfSelectedPedal_u].ReadLine();
-
                         TextBox_debugOutput.Text += message;
 
+                    }
+                }
+                catch (TimeoutException) { }
+
+
+
+            }
+        }
+
+
+
+
+        /********************************************************************************************************************/
+        /*							Read config from pedal																	*/
+        /********************************************************************************************************************/
+        unsafe public void ReadConfigFromPedal_click(object sender, RoutedEventArgs e)
+        {
+            if (Plugin._serialPort[indexOfSelectedPedal_u].IsOpen)
+            {
+
+                // send query command
+                Plugin._serialPort[indexOfSelectedPedal_u].DiscardInBuffer();
+                Plugin._serialPort[indexOfSelectedPedal_u].Write("4");
+
+                // wait for response
+                System.Threading.Thread.Sleep(100);
+
+                try
+                {
+                    int length = sizeof(DAP_config_st);
+                    byte[] newBuffer = new byte[length];
 
+                    if (Plugin._serialPort[indexOfSelectedPedal_u].BytesToRead == length)
+                    {
+                        Plugin._serialPort[indexOfSelectedPedal_u].Read(newBuffer, 0, length);
+                        DAP_config_st pedalConfig_read_st = getConfigFromBytes(newBuffer);
+
+                        // check CRC
+                        payloadPedalConfig tmp = pedalConfig_read_st.payloadPedalConfig_;
+                        payloadPedalConfig* v = &tmp;
+                        byte* p = (byte*)v;
+
+                        if (checksumCalc(p, sizeof(payloadPedalConfig)) == pedalConfig_read_st.payloadHeader_.checkSum)
+                        {
+                            this.dap_config_st[indexOfSelectedPedal_u] = pedalConfig_read_st;
+                            updateTheGuiFromConfig();
+                            TextBox_debugOutput.Text = "Read config from pedal successful!";
+                        }
+                        else
+                        {
+                            TextBox_debugOutput.Text = "CRC mismatch!";
+                        }
+                    }
+                    else 
+                    {
+                        TextBox_debugOutput.Text = "Data size mismatch!";
                     }
+
+
+
+
                 }
                 catch (TimeoutException) { }