The current code uses the cisstRobot robManipulator class with some extra tweaks (add base frame, tool tip, modulus 2 pi for roll, constraint optimizer for snake like tools...) which makes it hard to reproduce in a separate program. It would be nice to provide:
ROS service to query the forward/inverse kinematic
A simple command line tool using the arm class without starting the whole console to query the forward/inverse kinematic
The current code uses the cisstRobot robManipulator class with some extra tweaks (add base frame, tool tip, modulus 2 pi for roll, constraint optimizer for snake like tools...) which makes it hard to reproduce in a separate program. It would be nice to provide: