Refactoring

Refactored: got rid of draw function and instead have a value printed
out if marker is seen.
Also mvoed point conversoin into it's own function
put robot movement into its own function