working config, partial implementation of forces
Adding other x equations, error checking for config
Constructors for the position and quaternion elements
Simple constructor and destructor