Fixed my last 2 functions for cm and DIAMETER
Merge remote-tracking branch 'origin/master'

Conflicts:
	functions/twoWheelMovement.c