Function queue is now a circular array to avoid malloc. Fixed up some formatting and conventions on functions to avoid compiler warnings
Merge remote-tracking branch 'refs/remotes/duncan/crawler' into crawler

Conflicts:
	cmd.c
	pid-ip2.5.c
	python/test_suite.py
Fixed a bit of derp from the last merge. UART telemetry TX is commented out until we figure out why it is hanging.
1MBaud with 1KHz updated working with sbRIO
Now sending actual telemetry data
Merge remote-tracking branch 'refs/remotes/duncan/crawler' into crawler
Got MPU working by scheduing on timer interrput before PID set, works with streaming data
Merge remote-tracking branch 'refs/remotes/duncan/crawler' into crawler

Conflicts:
	cmd.c
	main.c
Fixed some errors with cmdZeroPos
Fixed PID bug invovling index, added zero position command.
Merge remote-tracking branch 'Buchan/crawler' into crawler

Conflicts:
	cmd.c
	main.c