Finished robot commands and tests