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]; }