电子罗盘量程扩大，加上校正后效果很好

于是用上MadgwickAHRSupdate，可以直接锁定航向