ChibiOS/RT based sketch for Pololu Zumo with ZumoShield, Arduino and Sharp IR range finder