Move solving ddq = Minv (-Cg + tau) from World class to Skeleton class.