无人机飞行初始高度问题

无人机在进行初始位置设定后,在执行自动飞行达到目标高度1m的运行代码时,发生初始位姿z坐标从0突变到-44m然后 极速攀升然后炸机

原始数据进来要先消抖,不要把杂波当数据
如果消抖之后还是异常,换个传感器