* 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
*/
-package org.altusmetrum.AltosLib;
+package org.altusmetrum.altoslib_8;
-public class AltosMs5607 {
+import java.util.concurrent.*;
+import java.io.*;
+
+public class AltosMs5607 implements Serializable {
public int reserved;
public int sens;
public int off;
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));
- OFF = ((long) off << 17) + (((long) tco * dT) >> 6);
+ TEMP = (int) (2000 + (((long) dT * (long) tempsens) >> 23));
+
+ if (ms5611) {
+ OFF = ((long) off << 16) + (((long) tco * (long) dT) >> 7);
- SENS = ((long) sens << 16) + (((long) tcs * dT) >> 7);
+ 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 * (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;
}
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;
+ }
+
+ static public void update_state(AltosState state, AltosLink link, AltosConfigData config_data) throws InterruptedException {
+ try {
+ AltosMs5607 ms5607 = new AltosMs5607(link, config_data);
+
+ if (ms5607 != null) {
+ state.set_ms5607(ms5607);
+ return;
+ }
+ } catch (TimeoutException te) {
+ }
+ }
+
+ public AltosMs5607() {
+ raw_pres = AltosLib.MISSING;
+ raw_temp = AltosLib.MISSING;
+ pa = AltosLib.MISSING;
+ cc = AltosLib.MISSING;
+ }
+
+ public AltosMs5607 (AltosLink link, AltosConfigData config_data) throws InterruptedException, TimeoutException {
+ this();
+ reserved = config_data.ms5607_reserved;
+ sens = config_data.ms5607_sens;
+ off = config_data.ms5607_off;
+ tcs = config_data.ms5607_tcs;
+ tco = config_data.ms5607_tco;
+ tref = config_data.ms5607_tref;
+ tempsens = config_data.ms5607_tempsens;
+ crc = config_data.ms5607_crc;
+ link.printf("B\n");
+ for (;;) {
+ String line = link.get_reply_no_dialog(5000);
+ if (line == null) {
+ throw new TimeoutException();
+ }
+ if (!parse_line(line)) {
+ break;
+ }
+ }
+ convert();
+ }
}