MS4 Full movement algorithm
Merge branch 'master' of https://github.com/carlodelmundo/ece4534

Conflicts:
	ARMCode/RTOSDemo/MainFiles/i2cController.c