Some location fixes, added wiggleMillimeters function stub
Fixed a typo
Worked more on straight line driving code