Output to txt file
Output to txt file addition
Debugging in process, added solvePnPRansac mode