Robot_RPi_MD49_Console_main.cpp: Update code