magfit: check for bad ATT data and ignore it

ArduPilot · Jun 27, 2023 · d8cb291 · d8cb291
1 parent b360511
commit d8cb291
Show file tree

Hide file tree

Showing 2 changed files with 12 additions and 0 deletions.
diff --git a/src/components/widgets/MagFitTool.vue b/src/components/widgets/MagFitTool.vue
@@ -450,6 +450,10 @@ export default {
                     yaw: data.yaw[i]
                 }
                 const BAT = null
+                if (ATT.roll === undefined) {
+                    console.log('skipping bad data', ATT)
+                    continue
+                }
                 const yaw = this.getYaw(ATT, MAG, corrections) // matches
                 // console.log('yaw: ', yaw)
                 const expected = this.expectedField(ATT, yaw) // matches
@@ -485,6 +489,10 @@ export default {
                     pitch: data.pitch[i],
                     yaw: data.yaw[i]
                 }
+                if (ATT.roll === undefined) {
+                    console.log('skipping bad data', ATT)
+                    continue
+                }
                 const BAT = null
                 const yaw = this.getYaw(ATT, MAG, corr) // matches
                 // console.log('yaw: ', yaw)

diff --git a/src/mavextra/vector3.js b/src/mavextra/vector3.js
@@ -35,6 +35,10 @@ class Vector3 {
     equals (v) {
         return this.x === v.x && this.y === v.y && this.z === v.z
     }
+
+    isNaN () {
+        return isNaN(this.x) || isNaN(this.y) || isNaN(this.z)
+    }
 }
 
 export { Vector3 }