New Firmware Upgrade implementation
Fix compiler warnings
Merge pull request #904 from DonLakeFlyer/NewFirmware

New Firmware Upgrade implementation