// Human_Radicon_Transmitter.ino
// 2021.2.13   mtakapii4@gmail.com
// ヒューマンアカデミーロボット向け,ラジコン送信機モード！
// Use mkII

//const int A0_PIN = A0;  
//const int A1_PIN = A1;
const int A2_PIN = A2;
const int A3_PIN = A3;
//const int A4_PIN = A4;

//int sensorValue0 = 0;  // Tact Switch
//int sensorValue1 = 0;  // Right-Finger, Right-Left
int sensorValue2 = 0;  // Left- Finger, Up-Down
int sensorValue3 = 0;  // Right-Finger, Up-Down
//int sensorValue4 = 0;  // Left- Finger, Right-Left
int ledPin = 13;
boolean tglsw ;
void LED_tgl();

void setup() {
  Serial.begin(38400);
  pinMode(ledPin, OUTPUT);                                                                                                                                                                                                                                                                                                                                                                                                                           
  delay(500);
  tglsw = true;
  digitalWrite(ledPin, HIGH);
  delay(2000);
  digitalWrite(ledPin, LOW);
  delay(1000);
  //Serial.println("Transmitter");
  //Serial.println("A0        A1");
}

void loop() {
  sensorValue3 = analogRead(A3_PIN);
  sensorValue2 = analogRead(A2_PIN);
  Serial.print(sensorValue3);  
  Serial.print(",");
  Serial.println(sensorValue2);
  delay(140);
  LED_tgl();
}

void LED_tgl(){ 
  if(tglsw){
    digitalWrite(ledPin, HIGH);
  }
  else{
    digitalWrite(ledPin, LOW);
  }
  tglsw = !tglsw;
}