fixed loop adding and subtracting
fixing danMario
leftovers
Merge branch 'master' of ssh://github.com/mrplants/RoboDog

Conflicts:
	constants.h