#include <MD_Parola.h>
#include <MD_MAX72xx.h>
#include <SPI.h>
#include "nRF24L01.h"
#include "RF24.h"
#include "printf.h"

const uint16_t WAIT_TIME = 1000;

#define HARDWARE_TYPE MD_MAX72XX::FC16_HW
#define MAX_DEVICES 4

#define CLK_PIN  13
#define DATA_PIN 11
#define CS_PIN   10

MD_Parola P = MD_Parola(HARDWARE_TYPE, CS_PIN, MAX_DEVICES);

const int trigPin1 = 6;
const int echoPin1 = 7;
const int trigPin2 = 6;
const int echoPin2 = 7;

long duration1;
int distance1;

long duration2;
int distance2;
char text[9];


RF24 radio(9, 8);
// Radio pipe addresses for the 2 nodes to communicate.
const byte address[6] = "00001";
const uint64_t pipes[3] = { 0xF0F0F0F0E1LL, 0xF0F0F0F0E2LL, 0xF0F0F0F0E3LL };



void setup(void)
{
  while (!Serial);
  Serial.begin(9600);



  P.begin(1);
  P.setZone(0, 0, 3);
  P.displayZoneText(0, text,  PA_CENTER, 25, 0, PA_PRINT, PA_NO_EFFECT);

  radio.begin();

  radio.setDataRate(RF24_250KBPS);
  radio.openReadingPipe(1, pipes[1]);
  radio.openReadingPipe(2, pipes[2]);

  radio.startListening();


}

void loop(void) {


  if (radio.available())
  {

    radio.read(&distance1, sizeof(distance1));
    //P.print(distance1);
    radio.read(&distance2, sizeof(distance2));
    //P.print(distance1);


    if (distance1 < distance2) {
      P.displayReset();
      P.print(distance1);

    }
    else {
      P.displayReset();
      P.print(distance2);
    }
  }

}