update missing status msg remove virtual function

This commit is contained in:
Pin Loon Lee
2021-07-14 18:39:50 +08:00
parent 89bde24d21
commit 4341d4f831

View File

@@ -178,7 +178,7 @@ class AgilexBase : public RobotInterface {
if (can_connected_) can_->StopService();
}
virtual void ParseCANFrame(can_frame *rx_frame) {
void ParseCANFrame(can_frame *rx_frame) {
AgxMessage status_msg;
if (parser_.DecodeMessage(rx_frame, &status_msg)) {
UpdateRobotCoreState(status_msg);
@@ -204,6 +204,16 @@ class AgilexBase : public RobotInterface {
core_state_msgs_.light_state = status_msg.body.light_state_msg;
break;
}
case AgxMsgMotionModeState: {
// std::cout << "motion mode feedback received" << std::endl;
core_state_msgs_.motion_mode_state = status_msg.body.motion_mode_state_msg;
break;
}
case AgxMsgRcState: {
// std::cout << "rc feedback received" << std::endl;
core_state_msgs_.rc_state = status_msg.body.rc_state_msg;
break;
}
default:
break;
}