Starting to correct null space function
Added weighted least norm functionality
Attempting to calculate pseudo inverse directly
Integrated HRP MatrixSolvers library including lapack
Tweaks
Before refactoring
Renamed ik_solver_pinverse file
Debugging null space
Added new debug_mode for comparing with euslisp