Robot dynamics algorithms - Featherstone, Roy (Kluwer, 1987)