Updated driving functions

They still need some fine tuning
Gyro is still calibrated correctly
Merge branch 'IRLocating' into mapping

Conflicts:
	Constants.h
	Firefighter.ino
	Turret.cpp
Added better mapping test