Add transformation between pixel units and real units

[kahzmic]

Pygame draw functions require that specify everything in pixels. MCL and pathplanning should be using real units like meters. Some way to transform between the two should be implemented