mirrors/ugv_sdk
1
0
Fork 0
mirror of https://github.com/westonrobot/ugv_sdk synced 2023-04-08 06:32:14 +08:00
Code Issues Packages Projects Releases Wiki Activity

read more motor data

Browse Source
This commit is contained in:
wangzheqie
2021-04-23 15:07:31 +08:00
parent 74d2c7e894
commit 7520f1fd32
3 changed files with 15 additions and 5 deletions
Download Patch File Download Diff File Expand all files Collapse all files

12
src/agx_msg_parser.c
View File

@@ -145,7 +145,11 @@ bool DecodeCanFrame(const struct can_frame *rx_frame, AgxMessage *msg) {
case CAN_MSG_ACTUATOR1_HS_STATE_ID:
case CAN_MSG_ACTUATOR2_HS_STATE_ID:
case CAN_MSG_ACTUATOR3_HS_STATE_ID:
case CAN_MSG_ACTUATOR4_HS_STATE_ID: {
case CAN_MSG_ACTUATOR4_HS_STATE_ID:
case CAN_MSG_ACTUATOR5_HS_STATE_ID:
case CAN_MSG_ACTUATOR6_HS_STATE_ID:
case CAN_MSG_ACTUATOR7_HS_STATE_ID:
case CAN_MSG_ACTUATOR8_HS_STATE_ID: {
msg->type = AgxMsgActuatorHSState;
ActuatorHSStateFrame *frame = (ActuatorHSStateFrame *)(rx_frame->data);
msg->body.actuator_hs_state_msg.motor_id =
@@ -167,7 +171,11 @@ bool DecodeCanFrame(const struct can_frame *rx_frame, AgxMessage *msg) {
case CAN_MSG_ACTUATOR1_LS_STATE_ID:
case CAN_MSG_ACTUATOR2_LS_STATE_ID:
case CAN_MSG_ACTUATOR3_LS_STATE_ID:
case CAN_MSG_ACTUATOR4_LS_STATE_ID: {
case CAN_MSG_ACTUATOR4_LS_STATE_ID:
case CAN_MSG_ACTUATOR5_LS_STATE_ID:
case CAN_MSG_ACTUATOR6_LS_STATE_ID:
case CAN_MSG_ACTUATOR7_LS_STATE_ID:
case CAN_MSG_ACTUATOR8_LS_STATE_ID: {
msg->type = AgxMsgActuatorLSState;
ActuatorLSStateFrame *frame = (ActuatorLSStateFrame *)(rx_frame->data);
msg->body.actuator_hs_state_msg.motor_id =