Biomechanical Solver for Musculo-Skeletal Rigid Body Motion with Wrapping Surfaces