// Human_Radicon_Transmitter_channel_type.ino
// 2022.3.31  mtakapii4@gmail.com
// ヒューマンアカデミーロボット向け,ラジコン送信機モード！
// channel"A","B"指定可，command"Z"送信追加
// チャンネル"B"はタクトスイッチを押しながら電源投入
// ◇Data Sequence ===> A,mmm,nnnL/F
//          Aはチャンネル名，
//          , はデータセパレータ
//          mmm, nnn は可変抵抗両端のADC数値
// 1 Finger(Stick) 方式とした（上下，左右）後ほど

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;
char channel ;
boolean tglsw ;
void LED_tgl();

void setup() {
 Serial.begin(38400);
 pinMode(ledPin, OUTPUT);
 delay(100);

 if ( analogRead(A0_PIN) < 500) {
   channel = 'B';   // channel B
 }
 else {
   channel = 'A';   // channel A
 }
 tglsw = true;
 //Serial.println("Transmitter");
}

void loop() {
 if ( analogRead(A0_PIN) < 500) {
   Serial.println("Z");   // command Z
 }
 else {
   sensorValue3 = analogRead(A3_PIN);
   sensorValue2 = analogRead(A2_PIN);
   Serial.print(channel); Serial.print(",");
   Serial.print(sensorValue3);
   Serial.print(",");
   Serial.println(sensorValue2);
 }
 delay(150);
 LED_tgl();
}

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