Docstring fixes, and small bug fix

- Fixed the docstring issues found in code review.
- Also, M_uqd = f_3.jacobian(qd), not f_2.jacobian(qd) as was
written previously.