Robot dynamics algorithms - Featherstone, Roy (Kluwer international series in engineering and computer science ;, 1987)