X-Git-Url: https://git.gag.com/?p=fw%2Faltos;a=blobdiff_plain;f=altoslib%2FAltosCalData.java;h=c90534a924e4159ea62cc0a1db5575e8493a67d0;hp=98f6b5b1c06f47340e27df6d46c7222efebc9c8c;hb=db950e97caefdd3257c1a2de3547ab88a2bd2344;hpb=f2e45e4b1351ce505b9294d5dc25429ab9721e62 diff --git a/altoslib/AltosCalData.java b/altoslib/AltosCalData.java index 98f6b5b1..c90534a9 100644 --- a/altoslib/AltosCalData.java +++ b/altoslib/AltosCalData.java @@ -12,7 +12,7 @@ * General Public License for more details. */ -package org.altusmetrum.altoslib_13; +package org.altusmetrum.altoslib_14; /* * Calibration and other data needed to construct 'real' values from various data @@ -120,6 +120,13 @@ public class AltosCalData { this.ground_accel = ground_accel; } + public double ground_motor_pressure = AltosLib.MISSING; + + public void set_ground_motor_pressure(double ground_motor_pressure) { + if (ground_motor_pressure != AltosLib.MISSING) + this.ground_motor_pressure = ground_motor_pressure; + } + /* Raw acceleration value */ public double accel = AltosLib.MISSING; @@ -305,12 +312,24 @@ public class AltosCalData { return temp_gps; } - public int imu_type = AltosLib.MISSING;; + public int imu_type = AltosLib.MISSING; + + public int imu_model = AltosLib.MISSING; + + public int mag_model = AltosLib.MISSING; public void set_imu_type(int imu_type) { this.imu_type = imu_type; } + public void set_imu_model(int imu_model) { + this.imu_model = imu_model; + } + + public void set_mag_model(int mag_model) { + this.mag_model = mag_model; + } + public double accel_zero_along, accel_zero_across, accel_zero_through; public void set_accel_zero(double zero_along, double zero_across, double zero_through) { @@ -322,18 +341,20 @@ public class AltosCalData { } public double accel_along(double counts) { - return AltosIMU.convert_accel(counts - accel_zero_along, imu_type); + return AltosIMU.convert_accel(counts - accel_zero_along, imu_type, imu_model); } public double accel_across(double counts) { - return AltosIMU.convert_accel(counts - accel_zero_across, imu_type); + return AltosIMU.convert_accel(counts - accel_zero_across, imu_type, imu_model); } public double accel_through(double counts) { - return AltosIMU.convert_accel(counts - accel_zero_through, imu_type); + return AltosIMU.convert_accel(counts - accel_zero_through, imu_type, imu_model); } - public double gyro_zero_roll, gyro_zero_pitch, gyro_zero_yaw; + public double gyro_zero_roll = AltosLib.MISSING; + public double gyro_zero_pitch = AltosLib.MISSING; + public double gyro_zero_yaw = AltosLib.MISSING; public void set_gyro_zero(double roll, double pitch, double yaw) { if (roll != AltosLib.MISSING) { @@ -348,19 +369,19 @@ public class AltosCalData { if (gyro_zero_roll == AltosLib.MISSING || counts == AltosLib.MISSING) return AltosLib.MISSING; - return AltosIMU.gyro_degrees_per_second(counts - gyro_zero_roll, imu_type); + return AltosIMU.gyro_degrees_per_second(counts - gyro_zero_roll, imu_type, imu_model); } public double gyro_pitch(double counts) { if (gyro_zero_pitch == AltosLib.MISSING || counts == AltosLib.MISSING) return AltosLib.MISSING; - return AltosIMU.gyro_degrees_per_second(counts - gyro_zero_pitch, imu_type); + return AltosIMU.gyro_degrees_per_second(counts - gyro_zero_pitch, imu_type, imu_model); } public double gyro_yaw(double counts) { if (gyro_zero_yaw == AltosLib.MISSING || counts == AltosLib.MISSING) return AltosLib.MISSING; - return AltosIMU.gyro_degrees_per_second(counts - gyro_zero_yaw, imu_type); + return AltosIMU.gyro_degrees_per_second(counts - gyro_zero_yaw, imu_type, imu_model); } private double gyro_zero_overflow(double first) { @@ -393,19 +414,19 @@ public class AltosCalData { public double mag_along(double along) { if (along == AltosLib.MISSING) return AltosLib.MISSING; - return AltosIMU.convert_gauss(along, imu_type, AltosIMU.mag_along_axis(imu_type)); + return AltosMag.convert_gauss(along, imu_type, mag_model); } public double mag_across(double across) { if (across == AltosLib.MISSING) return AltosLib.MISSING; - return AltosIMU.convert_gauss(across, imu_type, AltosIMU.mag_across_axis(imu_type)); + return AltosMag.convert_gauss(across, imu_type, mag_model); } public double mag_through(double through) { if (through == AltosLib.MISSING) return AltosLib.MISSING; - return AltosIMU.convert_gauss(through, imu_type, AltosIMU.mag_through_axis(imu_type)); + return AltosMag.convert_gauss(through, imu_type, mag_model); } public AltosCalData() {