 volatile int address = 0;
 
 volatile float dist[3] = {655.35, 655.35, 655.35};
-float beacons[3][2] = {{0.0f, 2.94f},
-                       {0.0f, 0.0f},
-                       {2.94f, 0.0f}};
+
+float beacons[3][2] = {{BEACON_1_X, BEACON_1_Y},
+                       {BEACON_2_X, BEACON_2_Y},
+                       {BEACON_3_X, BEACON_3_Y}};
+
+float shortestDistanceBeacon1 = 900.0f;
+float shortestDistanceBeacon2 = 900.0f;
+float shortestDistanceBeacon3 = 900.0f;
 
 float A[3][3];
 void setup() {

#include "DW1000Device.h"
#include <MatrixMath.h>
#include <math.h>
//A3: 1
//A2: 3
//A1: 2
// connection pins
const uint8_t PIN_RST = 3; // reset pin
const uint8_t PIN_IRQ = 7; // irq pin

  }
  else digitalWrite(6,LOW);
}

