Added another Matlab generated function, 'formInvJacobian', and removed
manual method for pseudo-inverse. Now both forward and inverse velocity
kinematics match the test case from Matlab within a few milimeters. This
commit closes Issue #18.