Fixed actuator_to_cartesian equations. Cleaned a little bit.