 #include "DW1000Device.h"
 #include <MatrixMath.h>
 #include <math.h>
-//A3: 1
-//A2: 3
-//A1: 2
+
+#define CALIBRATE_OFFSET false
+#define CALIBRATE_MULTIPLIER false
+#define CALIBRATION_DISTANCE 1.0
+
+#define BEACON_1_ADDRESS 0x1A1A
+#define BEACON_2_ADDRESS 0x2A1A
+#define BEACON_3_ADDRESS 0x1A3A
+
+#define BEACON_1_X 10.0f
+#define BEACON_1_Y 5.0f
+
+#define BEACON_2_X 10.0f
+#define BEACON_2_Y 0.0f
+
+#define BEACON_3_X 0.0f
+#define BEACON_3_Y 0.0f
+
+#define BEACON_1_OFFSET -0.09f
+#define BEACON_1_MULTIPLIER 1.2f
+
+#define BEACON_2_OFFSET -0.09f
+#define BEACON_2_MULTIPLIER 0.7257f
+
+#define BEACON_3_OFFSET -0.09f
+#define BEACON_3_MULTIPLIER 1.55f
+
 // connection pins
 const uint8_t PIN_RST = 3; // reset pin
 const uint8_t PIN_IRQ = 7; // irq pin

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 A[3][3];
void setup() {

  }
  else digitalWrite(6,LOW);
}

