this is the firmware of the controller based on the Arduino Nano

controller.ino.zip