Finished all init and helper methods, only evolution and force and torque calc methods remain.  Also need to decide what Im measuring and calculate that