"Rigid body dynamics algorithms" - читать интересную книгу автора (Roy Featherstone)