Added physical parameter measurements.
Updated to ChibiOS with USE_FPU fixed.