Firmware for Medulla 2 robot motor controller