//This is assuming your controller is in port one of the OI printf("p1_x= %d p1_y= %d \r",p1_x,p1_y);