fix for computing jacobian when the root_joint is not an active joint
Merge pull request #127 from ros-planning/fix_jacobian

fix for computing jacobian when the root_joint is not an active joint