const int pinNum1 = 13;
const int XZERO = 345;
const int YZERO = 345;
const int ZZERO = 365;

void AnaDigi(int adc);

void setup() {
  pinMode(pinNum1,OUTPUT);
  Serial.begin(9600);
}


int adc[3]={0};
void loop() {
  int i;

  adc[0] = ((analogRead(A0) - ZZERO)/60);//Accel 5pin Z
  delay(1);
  adc[1] = ((analogRead(A1) - YZERO)/60);//Accel 6pin Y
  delay(1);
  adc[2] = ((analogRead(A2) - XZERO)/60);//Accel 7pin X

  const double angleX = atan2(adc[2],adc[0]) / PI * 180;
  const double angleY = atan2(adc[1],adc[0]) / PI * 180;

  Serial.print(angleX);
  Serial.print("\t");
  Serial.print(angleY);
  Serial.print("");
  
/*
 // Serial.print("Z:");
  Serial.print(((float)adc[0] - ZZERO)/60);
  Serial.print("\t");
//  Serial.print("Y:");
  Serial.print(((float)adc[1] - YZERO)/60);
  Serial.print("\t");
//  Serial.print("X:");
  Serial.print(((float)adc[2] - XZERO)/60);
  Serial.print("\n");
  delay(500);
  */

  
}

void AnaDigi(int adc){
  int data[2];
  data[0] = adc >> 2;
//  data[1] = adc & 0b00000000000000000000000000000011;
  data[1] = adc & 0x00000003;
  Serial.write(data[0]);
  Serial.write(data[1]);
  
  
}