io.github.mianalysis.mia.process.analysis.InstantaneousSpeedCalculator Maven / Gradle / Ivy
package io.github.mianalysis.mia.process.analysis;
import java.util.TreeMap;
/**
* Created by Stephen on 15/04/2017.
*/
public class InstantaneousSpeedCalculator implements SpatialCalculator {
public TreeMap calculate(double[] x, double[] y, double[] z, int[] f) {
TreeMap speed = new TreeMap<>();
speed.put(f[0],0d);
for (int i = 1; i < x.length; i++) {
double dx = x[i] - x[i - 1];
double dy = y[i] - y[i - 1];
double dz = z[i] - z[i - 1];
double currentSpeed = Math.sqrt(dx * dx + dy * dy + dz * dz) / (f[i] - f[i - 1]);
speed.put(f[i],currentSpeed);
}
return speed;
}
}