Updated the frame of the disc, C, instead of B, in defining the RigidBody.
Updated theassert of Fr_star and Fr_star_steady with Matrix and expand.
Updated the assert in test_rollingdisc_nonminimal with Matrix and expand().