Fixed actuator_to_cartesian

See http://forum.conceptforge.org/viewtopic.php?f=6&t=174&p=2045#p2045 for the math