Adding firmware. tested with master system controller on teensy. Need update hardware and test with other controllers.