altoslib: Set all 3 axes of accel cal data when present

[fw/altos] / altoslib / AltosAccelCal.java

diff --git a/altoslib/AltosAccelCal.java b/altoslib/AltosAccelCal.java
index 38c4182cfef5da2b5fe9cb997722473e0e471b7a..e8859b27aec7c7ddbff9b73a6d16be44f99d961d 100644 (file)
--- a/altoslib/AltosAccelCal.java
+++ b/altoslib/AltosAccelCal.java
@@ -181,8 +181,16 @@ public class AltosAccelCal implements Runnable {
                                                  plus, minus);
                                if (config_data.pad_orientation != AltosLib.MISSING)
                                        link.printf("c o %d\n", config_data.pad_orientation);
-                               if (plus != AltosLib.MISSING && minus != AltosLib.MISSING)
-                                       link.printf("c a %d %d\n", plus, minus);
+                               if (plus != AltosLib.MISSING && minus != AltosLib.MISSING && plus != 0) {
+                                       if (config_data.accel_zero_along != AltosLib.MISSING)
+                                               link.printf("c a %d %d %d %d %d\n",
+                                                           plus, minus,
+                                                           config_data.accel_zero_along,
+                                                           config_data.accel_zero_across,
+                                                           config_data.accel_zero_through);
+                                       else
+                                               link.printf("c a %d %d\n", plus, minus);
+                               }
                                link.flush_output();
                                stop_link();
                        }