158 lines
4.6 KiB
Java
158 lines
4.6 KiB
Java
package com.henrypump.io;
|
|
|
|
import java.time.Duration;
|
|
import java.time.Instant;
|
|
import java.util.HashMap;
|
|
import java.util.List;
|
|
|
|
/**
|
|
* Created by patrickjmcd on 6/14/17.
|
|
*/
|
|
public class AnalogIn {
|
|
|
|
private int channel;
|
|
private int rawValue;
|
|
private double lastValue;
|
|
private Instant lastStored = Instant.EPOCH;
|
|
private double rawMax, rawMin, euMax, euMin;
|
|
private List<Integer> channelMux;
|
|
private double m, b;
|
|
private double[] history = new double[100];
|
|
private long badReads = 0;
|
|
|
|
public AnalogIn(int channel, double rawMin, double rawMax, double euMin, double euMax) {
|
|
this.channel = channel;
|
|
if (channel != 99) {
|
|
this.channelMux = MuxSetup.muxValues.get(channel);
|
|
}
|
|
this.rawMax = rawMax;
|
|
this.rawMin = rawMin;
|
|
this.euMax = euMax;
|
|
this.euMin = euMin;
|
|
|
|
m = (euMax - euMin) / (rawMax - rawMin);
|
|
b = euMax - m * (rawMax);
|
|
}
|
|
|
|
public int getChannel() {
|
|
return channel;
|
|
}
|
|
|
|
public double getRawMax() {
|
|
return rawMax;
|
|
}
|
|
|
|
public double getRawMin() {
|
|
return rawMin;
|
|
}
|
|
|
|
public double getEuMax() {
|
|
return euMax;
|
|
}
|
|
|
|
public double getEuMin() {
|
|
return euMin;
|
|
}
|
|
|
|
public long getBadReads() {
|
|
return badReads;
|
|
}
|
|
|
|
public int getRawValue() {
|
|
return rawValue;
|
|
}
|
|
|
|
public double getLastValue() {
|
|
return lastValue;
|
|
}
|
|
|
|
public Instant getLastStored() {
|
|
return lastStored;
|
|
}
|
|
|
|
public double getHistory(int pointIndex) {
|
|
return history[pointIndex];
|
|
}
|
|
|
|
double setValue(int value) {
|
|
// System.out.println(value);
|
|
this.rawValue = value;
|
|
double pv = m * rawValue + b;
|
|
lastValue = pv;
|
|
lastStored = Instant.now();
|
|
System.arraycopy(history, 0, history,1, history.length - 1);
|
|
history[0] = lastValue;
|
|
// System.out.println(value + " --> " + pv);
|
|
return pv;
|
|
}
|
|
|
|
public double read(MuxSetup mux){
|
|
mux.set(channelMux.get(0), channelMux.get(1), channelMux.get(2));
|
|
int rawIn = mux.readAnalog();
|
|
if (rawIn != -1){
|
|
badReads = 0;
|
|
return setValue(rawIn);
|
|
} else {
|
|
badReads++;
|
|
try {
|
|
Thread.sleep(5);
|
|
} catch (InterruptedException e) {
|
|
e.printStackTrace();
|
|
}
|
|
}
|
|
return lastValue;
|
|
}
|
|
|
|
public double readSim(double simRaw){
|
|
double pv = ((euMax - euMin)/(rawMax - rawMin)) * simRaw + (euMax - ((euMax - euMin)/(rawMax - rawMin)) * rawMax);
|
|
lastValue = pv;
|
|
System.arraycopy(history, 0, history,1, history.length - 1);
|
|
history[0] = lastValue;
|
|
return pv;
|
|
}
|
|
|
|
public HashMap<String, Long> getStatus(){
|
|
HashMap<String, Long> status;
|
|
status = new HashMap<String, Long>();
|
|
|
|
status.put("badReads", badReads);
|
|
status.put("measurementAge", Duration.between(lastStored, Instant.now()).toMillis());
|
|
return status;
|
|
}
|
|
|
|
|
|
public static void main(String[] args) {
|
|
MuxSetup mux = null;
|
|
Instant now = Instant.now();
|
|
mux = new MuxSetup();
|
|
HashMap<String, Long> aI1status;
|
|
// HashMap<String, Long> aI2status;
|
|
|
|
System.out.println("Testing Analog Inputs");
|
|
|
|
AnalogIn aI1 = new AnalogIn(1, 32560, 65535, 0, 100);
|
|
// AnalogIn aI2 = new AnalogIn(2, 0, 65535, 0, 50000);
|
|
// AnalogIn aI3 = new AnalogIn(3, 0, 65535, 0, 100);
|
|
// AnalogIn aI4 = new AnalogIn(4, 0, 65535, 0, 100);
|
|
|
|
for (int i = 0; i < 500; i++) {
|
|
|
|
double a1Val = aI1.read(mux);
|
|
// double a2Val = aI2.read(mux);
|
|
aI1status = aI1.getStatus();
|
|
// aI2status = aI2.getStatus();
|
|
System.out.println("Input " + aI1.channel + ": " + aI1.lastValue + ", age= " + aI1status.get("measurementAge") + "ms" + ", badReads= " + aI1status.get("badReads"));
|
|
// System.out.println("Input " + aI2.channel + ": " + aI2.lastValue + ", age= " + aI2status.get("measurementAge") + "ms" + ", badReads= " + aI2status.get("badReads"));
|
|
// System.out.println("Input " + aI3.channel + ": " + aI3.lastValue + ", age= " + Duration.between(aI3.lastStored, now).toMillis() + "ms");
|
|
// System.out.println("Input " + aI4.channel + ": " + aI4.lastValue + ", age= " + Duration.between(aI4.lastStored, now).toMillis() + "ms");
|
|
// System.out.println("--");
|
|
// System.out.printf("%s,%s%n", aI1.lastValue, aI2.lastValue);
|
|
|
|
}
|
|
// for (int j = 0; j < 100; j++){
|
|
// System.out.println("History[" + j + "]= " + aI3.getHistory(j));
|
|
// }
|
|
|
|
}
|
|
}
|