RBDL is a highly efficient C++ library that contains some essential rigid body dynamics algorithms.