Support for velocity/displacement, integration ctrl and a bugfix
Support for velocity/displacement, integration ctrl and a bugfix

- Added registers for velocity/displacement.
- Added register for integration control (yaw and vel/disp reset)
- Optimized CRC calculation code to use a table lookup and perform
lookups in a static inline function.
- Fixed a bug in the serialization to/from binary protocol streams of
floats stored in 16:16 format.

Beachbot330/navxmxp,kauailabs/navxmxp,FRC900/navxmxp,FRC900/navxmxp,FRC900/navxmxp,FRC900/navxmxp,aeastet/navxmxp,kauailabs/navxmxp,Beachbot330/navxmxp,aeastet/navxmxp,kauailabs/navxmxp,Beachbot330/navxmxp,aeastet/navxmxp,kauailabs/navxmxp,aeastet/navxmxp,kauailabs/navxmxp,FRC900/navxmxp,aeastet/navxmxp,Beachbot330/navxmxp,aeastet/navxmxp,Beachbot330/navxmxp,kauailabs/navxmxp,kauailabs/navxmxp,Beachbot330/navxmxp,FRC900/navxmxp