Full thread and explanation: http://www.vexforum.com/index.php/14430-robot-position-calculation/