proto1 almost done the first part
fixed bug now the robot will run