fixed manipulator H matrix derivatives with floating bases.  resolves issue #165