private void updateJointStates(Message message)
{
SensorJointStates sensorJointStates = (SensorJointStates)message;
JointPositions = rad2Deg(sensorJointStates.position);
JointVelocities = rad2Deg(sensorJointStates.velocity);
foreach (JointStateManager jointStateManager in jointStateManagers)
{
jointStateManager.updateJointState(JointPositions[jointStateManager.jointStateId]);
}
}
public MoveItRobotState()
{
joint_state = new SensorJointStates();
attached_dof_joint_state = new SensorMultiDOFJointState();
attached_collision_objects = new MoveItAttachedCollisionObject[0];
}
