#include "Metro.h"     //Include Metro library
#include "MLX90316.h"  // Include MLX90316 library

int pinSS = 6;
int pinSCK = 3;
int pinMOSI = 4;

int pinSS1 = 6;
int pinSCK1 = 3;
int pinMOSI1 = 4;
int ii, ii1;
Metro mlxMetro = Metro(5);
MLX90316 mlx_1  = MLX90316();
MLX90316 mlx_2  = MLX90316();
void setup(){
  Serial.begin(115200);
  mlx_1.attach(pinSS,pinSCK, pinMOSI );
  mlx_2.attach(pinSS1,pinSCK1, pinMOSI1 );
  Serial.println(" MLX90316 Rotary Position Sensor");
}

void loop() {

 if (mlxMetro.check() == 1)
  { int i, z1,z2,z,v[2],z3,z4;
    int a[5], temp;
    for ( i=0;i<4;i++)
    {a[i]=mlx_2.readAngle();
   }
    for(i=0;i<3;i++)
     if(a[i]<a[i+1])
     {temp=a[i];
      a[i]=a[i+1];
      a[i+1]=temp;
      }
      if(a[0]==a[1] && a[2]==a[3] && a[0]>0 && a[1]>0 )
       {
       Serial.print("angle2 = ");
       Serial.println(a[0]/10);
       }
/*
       Serial.print("a[0]=");
       Serial.print(a[0]);
       Serial.print("a[2]=");
       Serial.print(a[2]);
       Serial.print("a[2]=");
       Serial.println(a[2]);
       delay(100);
        */
  }
  }