ERROR:Quaternion has length close to zero... discarding as navigation goal解决办法

原因：变量origation_w为0了