Code for lab6, making a robot move