Everything is working time to test on the robot