copy from existing poscontrol
reactivated pos-estimator
Merge branch 'd3_second_try' of ssh://git@github.com/helios57/Firmware.git into d3_second_try