Implemented tree inverse dynamics solver and generic (with arbitrary base) kinematic and dynamics loops