handle joint limits
fixed sticking points with num positions > num dof
Updates docs and continues implementing code for velocity controlled surfaces.