Add velocity calculator.
Merge branch 'setpoint' of github.com:osurdml/offboard_comm into setpoint

Resolved:
	offboard_comm.h