px4io_uploader cleanup and minor optimization

Remove redundant code
Cleanup error handling in program function