Have a stable kinematics model.

Need to rewrite the kinematics end of the platform... petty much
botched. Refer to the GreenFoot_plotter code.