To the point code for tracking closest object

Only important stuff, understandable variable names etc etc.
Change the #define variable isFile if you want it to return outputs to arduino serial too. Else it will just be printing the things to be sent to arduino.