px4io_uploader cleanup and minor optimization

Remove redundant code
Cleanup error handling in program function
Tested on V1 and V2 PX4