ROS Resources: Documentation | Support | Discussion Forum | Index | Service Status | ros @ Robotics Stack Exchange |
1 | initial version |
There are many libraries which can do that for you. Bullet, KDL, and Eigen all have methods. There's a summary of available methods here