Based on the principles, algorithms, data structures and notation presented in the book: Featherstone, R. (2008). Rigid body dynamics algorithms. Springer. This development is sponsored by Carnegie Wave Energy Ltd.