Added basic model infrastructure and a first version of a full rigid body model (with unit tests). Also has a partial implementation of the single rigid body model with a few todos and tests left there.
Automated tests won't work right now as I changed the pinocchio dependency to 3.0, but last I checked the pinocchio apt repo was still on 2.7.1. Tests pass locally.
Added basic model infrastructure and a first version of a full rigid body model (with unit tests). Also has a partial implementation of the single rigid body model with a few todos and tests left there.