Testing code for sphero robot