Fixes after forwardKin gradient change.
Fewer tests. Taking too long.