px4io_uploader cleanup and minor optimization

Remove redundant code
Cleanup error handling in program function
Tested on V1 and V2 PX4
We already know that count != n and that n !=0, so no need to check again