sixDoFRigidBodyState function object not built

As title - code also requires further integration updates re: writeFile class usage and would benefit from using enums for angle types