diff --git a/src/main/java/ipos/project/Functionality/Triangulation.java b/src/main/java/ipos/project/Functionality/Triangulation.java index 88aee3fbda1d561d98e1ee7517fe18f623c5dc99..a523e3425c3f1a2f098f588291becb1aab1309f5 100644 --- a/src/main/java/ipos/project/Functionality/Triangulation.java +++ b/src/main/java/ipos/project/Functionality/Triangulation.java @@ -26,7 +26,7 @@ public class Triangulation { private static IPos_DatamodelFactory modelFactory = IPos_DatamodelFactory.eINSTANCE; public static PositionEvent update(UWB uwbRawDataEvent) throws ParseException { - + double[][] positions = new double[][]{{0, 0}, {0, 0}, {0, 0}, {0, 0}}; double[] distances = new double[]{0,0,0,0}; EMap uwbData = (EMap) uwbRawDataEvent.getDistances(); @@ -35,7 +35,7 @@ public class Triangulation { Point3D beaconPoint3D = modelFactory.createPoint3D(); beaconPoint3D = (Point3D) DataServices.getPoiByIdOrNull((String) key).getPlacing().getPosition(); positions[index] = new double[]{beaconPoint3D.getX(), beaconPoint3D.getY()}; - distances[index] = Math.sqrt(Math.pow((Double) uwbData.get(key), 2) + Math.pow((beaconPoint3D.getZ() - 0.1), 2)); + distances[index] = (Double) uwbData.get(key); index ++; }