px4io_uploader cleanup and minor optimization

Remove redundant code
Cleanup error handling in program function
Tested on V1 and V2 PX4
No need to test for rev3 and then do the same thing for rev4 or greater