Robot_AVR_Master_main.c: change code