const values read from sensors
Remove disabled unused debug code
Removed disabled delay code
Implement better behavior for 5 sensors (new robot)