added pid telemetry
Merge branch 'crawler-treadmill' into crawler
Added mpu test command
Changed set vel profile to take only velcoity, do calculations PIC side
Added stop/hold position functionality to velocity command
Merge remote-tracking branch 'refs/remotes/duncan/crawler' into crawler

Conflicts:
	cmd.c
	pid-ip2.5.c
	python/test_suite.py