54 long pulsePos[MAX_PULSE_AXES];
55 long pulseSpeed[MAX_PULSE_AXES];
125 memset(replyMsg, 0x00,
sizeof(
SimpleMsg));
176 memset(replyMsg, 0x00,
sizeof(
SimpleMsg));
197 printf(
"Dumping SmBodyJointTrajPtFull:\r\n");
198 printf(
" groupNo=%d\r\n", data->
groupNo);
199 printf(
" sequence=%d\r\n", data->
sequence);
201 printf(
" time=%.5f\r\n", data->
time);
202 printf(
" pos: %.5f, %.5f, %.5f, %.5f, %.5f, %.5f, %.5f\r\n",
204 data->
pos[4], data->
pos[5], data->
pos[6]);
205 printf(
" vel: %.5f, %.5f, %.5f, %.5f, %.5f, %.5f, %.5f\r\n",
207 data->
vel[4], data->
vel[5], data->
vel[6]);
208 printf(
" acc: %.5f, %.5f, %.5f, %.5f, %.5f, %.5f, %.5f\r\n",
210 data->
acc[4], data->
acc[5], data->
acc[6]);
SmBodyJointFeedback jointTrajPtData[MOT_MAX_GR]
SmBodyJointTrajPtFull jointTrajData
SmBodyJointFeedbackEx jointFeedbackEx
struct _SmHeader SmHeader
SmBodyMotoMotionCtrl motionCtrl
BOOL Ros_CtrlGroup_GetFBPulsePos(CtrlGroup *ctrlGroup, long pulsePos[MAX_PULSE_AXES])
SmBodyJointTrajPtFullEx jointTrajDataEx
int Ros_SimpleMsg_JointFeedbackEx_Build(int groupIndex, SimpleMsg *src_msgFeedback, SimpleMsg *dst_msgExtendedFeedback)
int Ros_SimpleMsg_MotionReply(SimpleMsg *receiveMsg, int result, int subcode, SimpleMsg *replyMsg, int ctrlGrp)
SmBodyMotoMotionReply motionReply
SmBodySelectTool selectTool
float data[ROS_MAX_JOINT]
SmBodyJointFeedback jointFeedback
void Ros_SimpleMsg_JointFeedbackEx_Init(int numberOfGroups, SimpleMsg *sendMsg)
int Ros_SimpleMsg_IoReply(int result, int subcode, SimpleMsg *replyMsg)
BOOL Ros_CtrlGroup_GetFBServoSpeed(CtrlGroup *ctrlGroup, long pulseSpeed[MAX_PULSE_AXES])
FlagsValidFields validFields
int Ros_SimpleMsg_JointFeedback(CtrlGroup *ctrlGroup, SimpleMsg *sendMsg)
SmBodyMotoIoCtrlReply ioCtrlReply
FlagsValidFields validFields
void Ros_CtrlGroup_ConvertToRosPos(CtrlGroup *ctrlGroup, long motopulsePos[MAX_PULSE_AXES], float rosPos[MAX_PULSE_AXES])