rework CAN
This commit is contained in:
@@ -29,7 +29,7 @@ typedef union {
|
||||
uint16_t full;
|
||||
} BYTES_2;
|
||||
|
||||
void CM_processIncome(uint8_t idSender, uint8_t idMsg, uint32_t data){
|
||||
void CM_processIncome(uint8_t idSender, uint8_t idMsg, bool rtr, uint32_t data){
|
||||
BYTES_4 incomeData;
|
||||
incomeData.full = data;
|
||||
BYTES_4 revertData;
|
||||
@@ -59,21 +59,21 @@ void CM_processIncome(uint8_t idSender, uint8_t idMsg, uint32_t data){
|
||||
|
||||
if(idMsg == 0x1) { // CONTROL_SPEED_FACTOR
|
||||
// valHH valH valL valLL
|
||||
KART_CST.CONTROL_SPEED_FACTOR = data;
|
||||
KART_CST.CONTROL_SPEED_FACTOR = revertData.full;
|
||||
MEM_write_4_byte(MEMADD_CONTROL_SPEED_FACTOR, KART_CST.CONTROL_SPEED_FACTOR);
|
||||
|
||||
}
|
||||
|
||||
if(idMsg == 0x2) { // CONTROL_POWER_FACTOR
|
||||
// valHH valH valL valLL
|
||||
KART_CST.CONTROL_POWER_FACTOR = data;
|
||||
KART_CST.CONTROL_POWER_FACTOR = revertData.full;
|
||||
MEM_write_4_byte(MEMADD_CONTROL_POWER_FACTOR, KART_CST.CONTROL_POWER_FACTOR);
|
||||
CAN_Send(0, 5, KART_CST.CONTROL_POWER_FACTOR);
|
||||
}
|
||||
|
||||
if(idMsg == 0x3) { // CONTROL_STEERING_FACTOR
|
||||
// valHH valH valL valLL
|
||||
KART_CST.CONTROL_STEERING_FACTOR = data;
|
||||
KART_CST.CONTROL_STEERING_FACTOR = revertData.full;
|
||||
MEM_write_4_byte(MEMADD_CONTROL_STEERING_FACTOR, KART_CST.CONTROL_STEERING_FACTOR);
|
||||
|
||||
}
|
||||
|
||||
@@ -32,7 +32,7 @@ S R M
|
||||
* @param idMsg is of the message
|
||||
* @param data data of the message
|
||||
*/
|
||||
void CM_processIncome(uint8_t idSender, uint8_t idMsg, uint32_t data);
|
||||
void CM_processIncome(uint8_t idSender, uint8_t idMsg, bool rtr, uint32_t data);
|
||||
|
||||
/**
|
||||
* Send alive message from controller
|
||||
|
||||
Reference in New Issue
Block a user