We should create a cisst/SAW message matching this and provide a conversion method. For the dVRK we can provide a measured joint state using the sawRobotIO class with the last encoder reading for position, compute a velocity, and report the current feedback. We can also provide a desired joint state using the info from the PID class and the computed requested current.
ROS uses a single message to pass:
We should create a cisst/SAW message matching this and provide a conversion method. For the dVRK we can provide a measured joint state using the sawRobotIO class with the last encoder reading for position, compute a velocity, and report the current feedback. We can also provide a desired joint state using the info from the PID class and the computed requested current.