private void ReceiveActualJointStates(Messages.Sensor.JointState jointState) { int index; for (int i = 0; i < jointState.name.Length; i++) { index = jointNames.IndexOf(jointState.name[i]); if (index != -1) { trajectoryPositionsWriters[index].actualJointState = (float)jointState.position[i]; } } }
private static void JointStateHandler(sensor_msgs.JointState message) { Debug.Log((message).name[0]); }