working more on the ChibiOS version for AVR (Arduino Mega)