working on new firmware based on ChibiOS for AVR