X-Git-Url: https://git.gag.com/?p=fw%2Faltos;a=blobdiff_plain;f=altoslib%2FAltosMs5607.java;h=da64a0eab26a40d8cdbaa01baa2ba1d975ac7ebd;hp=a7b902e21fb0418055653a4c2eba2356345b8815;hb=5a3c5de6657d1c26e52015a8acec0cd05e294cef;hpb=f86dac643081987c8994ab57a96640d5e91b342a diff --git a/altoslib/AltosMs5607.java b/altoslib/AltosMs5607.java index a7b902e2..da64a0ea 100644 --- a/altoslib/AltosMs5607.java +++ b/altoslib/AltosMs5607.java @@ -15,7 +15,7 @@ * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA. */ -package org.altusmetrum.AltosLib; +package org.altusmetrum.altoslib; public class AltosMs5607 { public int reserved; @@ -32,29 +32,37 @@ public class AltosMs5607 { public int pa; public int cc; + static final boolean ms5611 = false; + void convert() { int dT; int TEMP; long OFF; long SENS; - int P; + //int P; dT = raw_temp - ((int) tref << 8); - TEMP = (int) (2000 + (((long) dT * tempsens) >> 23)); + TEMP = (int) (2000 + (((long) dT * (long) tempsens) >> 23)); + + if (ms5611) { + OFF = ((long) off << 16) + (((long) tco * (long) dT) >> 7); - OFF = ((long) off << 17) + (((long) tco * dT) >> 6); + SENS = ((long) sens << 15) + (((long) tcs * (long) dT) >> 8); + } else { + OFF = ((long) off << 17) + (((long) tco * (long) dT) >> 6); - SENS = ((long) sens << 16) + (((long) tcs * dT) >> 7); + SENS = ((long) sens << 16) + (((long) tcs * (long) dT) >> 7); + } if (TEMP < 2000) { int T2 = (int) (((long) dT * (long) dT) >> 31); int TEMPM = TEMP - 2000; - long OFF2 = (61 * (long) TEMPM * (long) TEMPM) >> 4; - long SENS2 = 2 * (long) TEMPM * (long) TEMPM; + long OFF2 = ((long) 61 * (long) TEMPM * (long) TEMPM) >> 4; + long SENS2 = (long) 2 * (long) TEMPM * (long) TEMPM; if (TEMP < 1500) { int TEMPP = TEMP + 1500; - long TEMPP2 = TEMPP * TEMPP; + long TEMPP2 = (long) TEMPP * (long) TEMPP; OFF2 = OFF2 + 15 * TEMPP2; SENS2 = SENS2 + 8 * TEMPP2; } @@ -73,4 +81,48 @@ public class AltosMs5607 { convert(); return pa; } + + public boolean parse_line(String line) { + String[] items = line.split("\\s+"); + if (line.startsWith("Pressure:")) { + if (items.length >= 2) + raw_pres = Integer.parseInt(items[1]); + } else if (line.startsWith("Temperature:")) { + if (items.length >= 2) + raw_temp = Integer.parseInt(items[1]); + } else if (line.startsWith("ms5607 reserved:")) { + if (items.length >= 3) + reserved = Integer.parseInt(items[2]); + } else if (line.startsWith("ms5607 sens:")) { + if (items.length >= 3) + sens = Integer.parseInt(items[2]); + } else if (line.startsWith("ms5607 off:")) { + if (items.length >= 3) + off = Integer.parseInt(items[2]); + } else if (line.startsWith("ms5607 tcs:")) { + if (items.length >= 3) + tcs = Integer.parseInt(items[2]); + } else if (line.startsWith("ms5607 tco:")) { + if (items.length >= 3) + tco = Integer.parseInt(items[2]); + } else if (line.startsWith("ms5607 tref:")) { + if (items.length >= 3) + tref = Integer.parseInt(items[2]); + } else if (line.startsWith("ms5607 tempsens:")) { + if (items.length >= 3) + tempsens = Integer.parseInt(items[2]); + } else if (line.startsWith("ms5607 crc:")) { + if (items.length >= 3) + crc = Integer.parseInt(items[2]); + } else if (line.startsWith("Altitude")) + return false; + return true; + } + + public AltosMs5607() { + raw_pres = AltosRecord.MISSING; + raw_temp = AltosRecord.MISSING; + pa = AltosRecord.MISSING; + cc = AltosRecord.MISSING; + } }