Schematics added and firmware changed to reflect final schematics