implemented translate and rotate in globalRobotTree.c. Can change between the two. Pivot in works