Sonar and flow initial changes, debug
Merge branch 'upstream_shared' of https://github.com/robido/multiwii-firmware into upstream_shared

Conflicts:
	MultiWii/IMU.cpp
Rotation matrix work in progress. TBC.