Firmware for the Mentor training arm (ChiBIOS)