Implemented joint limit aware cartesian control. Increasingly dampens joints when they're heading toward joint limits.
Added new way point (reach toward nose).