Added debug code to nxt
Fixed joystick backwards driving issue by changing to atan2(joy1x1,joy1y1)