Added write verification routine
Added write verification routine
Removed debug printf. Added check for firmware upload OK
Added extra printf statements
Cleaned up status printout