adds getPoint() functionality for homog matrices (sort of)
adds length of vector
Merge branch 'master' into manipulator
completes inverse kinematics math/visualization/etc