รบกวนดู Code ให้ผมหน่อยคับ

คือผมต้องการเขียนให้ เมื่อรับค่า A จาก HC-05 มาแล้ว ให้เปิด รีเรย์ตัวที่1 (RL1) จากนั้น ให้รอรับค่าต่อ หากมีค่า C เข้ามาให้เปิดใช้งาน RL2 โดยมีเงื่อนไขว่า RL1 ต้องเปิดอยู่ด้วย หาก RL1 ไม่ได้เปิดอยู่ ไม่สามารถเปิด RL2 แต่หาก มีค่า B มา ให้ปิดรีเรย์ทัง 2 ตัว ผมเขียนแบบนี้ถูกใหมคับ


#include <SoftwareSerial.h>

SoftwareSerial BTserial(3,2);//RX,TX

int RL1 = 4;

int RL2 = 5;

void setup() {

  BTserial.begin(9600);

  BTserial.println("BTserial");

  pinMode(RL1, OUTPUT);

}

void loop() {

  if(BTserial.available()){

    char ch = BTserial.read();

    if(ch == 'A')

      digitalWrite(RL1, HIGH);

      if(RL1 == HIGH){

        char ch = BTserial.read();

        if(ch == 'C')

        digitalWrite(RL2, HIGH);   

        delay(1000);   

        }     

      else if(ch == 'B')

      digitalWrite(RL1, LOW);

    }

}