@@ -96,8 +96,8 @@ void Get_Vesc_Pack_Data(COMM_PACKET_ID id)
9696 command [0 ] = id ;
9797
9898 if (id == COMM_CUSTOM_APP_DATA ) {
99- command [1 ] = 101 ;
100- command [2 ] = 24 ; // FLOAT_COMMAND_POLL
99+ command [1 ] = FLOAT_COMMAND_ID ;
100+ command [2 ] = FLOAT_COMMAND_LCM_POLL ;
101101 len = 3 ;
102102 if (!lcmConfig .isSet ) {
103103 // write firmware id string to command
@@ -109,8 +109,8 @@ void Get_Vesc_Pack_Data(COMM_PACKET_ID id)
109109
110110 if (id == COMM_CHARGE_INFO ) {
111111 command [0 ] = COMM_CUSTOM_APP_DATA ;
112- command [1 ] = 101 ;
113- command [2 ] = 28 ; // FLOAT_COMMAND_CHARGESTATE
112+ command [1 ] = FLOAT_COMMAND_ID ;
113+ command [2 ] = FLOAT_COMMAND_CHARGING_STATE ;
114114 command [3 ] = 151 ; // -charging: 1/0 aka true/false
115115 command [4 ] = Charge_Flag == 2 ? 1 : 0 ; // -charging: 1/0 aka true/false
116116 uint8_t ind = 5 ;
@@ -121,8 +121,8 @@ void Get_Vesc_Pack_Data(COMM_PACKET_ID id)
121121
122122 if (id == COMM_CUSTOM_DEBUG ) {
123123 command [0 ] = COMM_CUSTOM_APP_DATA ;
124- command [1 ] = 101 ;
125- command [2 ] = 99 ; // FLOAT_COMMAND_LCM_DEBUG
124+ command [1 ] = FLOAT_COMMAND_ID ;
125+ command [2 ] = FLOAT_COMMAND_LCM_DEBUG ;
126126 command [3 ] = Power_Flag ;
127127 command [4 ] = Charge_Flag ;
128128 command [5 ] = data .dutyCycleNow ;
@@ -333,12 +333,12 @@ uint8_t Protocol_Parse(uint8_t * message)
333333
334334 case COMM_CUSTOM_APP_DATA :
335335
336- if (len < 12 ) {
336+ if (len < 12 ) {
337337 break ;
338338 }
339- uint8_t magicnr = pdata [ind ++ ];
340- uint8_t floatcmd = pdata [ind ++ ];
341- if ((magicnr != 101 ) || (floatcmd != FLOAT_COMMAND_LCM_POLL )) {
339+ uint8_t magicnr = pdata [ind ++ ];
340+ uint8_t cmdid = pdata [ind ++ ];
341+ if ((magicnr != FLOAT_COMMAND_ID ) || (cmdid != FLOAT_COMMAND_LCM_POLL )) {
342342 break ;
343343 }
344344 data .floatPackageSupported = true;
0 commit comments