Refactored jacobian test.
Merge pull request #41 from ros-planning/jacobian-test-refactor

Refactored jacobian test.