First commit to set up a rigid body equations set class

Tracker item: 3681