Made first changes to adjust to the new robot