Added pullback functions for pulling state or position task potentials back into the configuration space (q, qd).
Finished full pull through test. Baring numerical precision issues, the system works as advertised.