两个arduino mega 2560 之间双向数传 出现问题

因为山在那里

要做的事：在做通讯时做的一个握手程序，大致描述是这样的，上电后，主机从机发送字符‘S’，然后等待返回，
从机收到确认后，返回一个‘C’然后跳出握手循环，主机确认返回‘C‘后也跳出握手循环，
问题：不知道为什么实际只有一个会跳出，跳出握手循环！谁先跳出跟复位先后有关，但不出现预期的两个都跳出握手循环，
希望各路大侠指点迷津……多谢！！！！！
//主机
#define Uchar unsigned char   
Uchar TX_Packet[6]={0};
Uchar RX_Packet[6]={0};
Uchar i=0;
Uchar connectSuccess=0;

////////////////////////////////////////////////////////////////////////////
void setup()
{
  Serial.begin(9600);
  Serial1.begin(9600);
//  while (!Serial) ;
  TX_Packet[0]='S';
  TX_Packet[1]='C';

}
/////////////////////////////////////////////////////////////////////////
void loop()
{
  connectTX();
  while(1)
  {
    Serial.println("TX Success!!! ^-^ ");
  }
}
//////////////////////////////////////////////////////////////////
void connectTX(void)
{
  while(connectSuccess==0)
{
    if(i>9)
    {
      Serial1.write(TX_Packet[0]);
      i=0;
    }
    i++;
    Serial.println("TXconnecting........");
    if(Serial1.available()>0)
    {
      RX_Packet[1]=Serial1.read();
      Serial.println(RX_Packet[1]);
      if(RX_Packet[1]=='C')
      {
        connectSuccess=1;      
      }else
        {
          connectSuccess=0;      
        }
        Serial.println(connectSuccess);     }
  }
  connectSuccess=0;
}

//从机
#define Uchar unsigned char   
Uchar TX_Packet[6]={0};
Uchar RX_Packet[6]={0};
Uchar i=0;
Uchar connectSuccess=0;

////////////////////////////////////////////////////////////////////////////
void setup()
{
  Serial.begin(9600);
  Serial1.begin(9600);
//  while (!Serial) ;
  TX_Packet[0]='S';
  TX_Packet[1]='C';

}
/////////////////////////////////////////////////////////////////////////
void loop()
{
  connectRX();
  while(1)
  {
    Serial.println("RX Success!!! ^-^ ");
  }
}
///////////////////////////////////////////////////////////////////////////
void connectRX(void)
{
  while(connectSuccess==0)
  {
    Serial.println("RXconnecting........");
    delay(2);
    if(Serial1.available()>0)
    {
      RX_Packet[0]=Serial1.read();
      Serial.println(RX_Packet[0]);
      delay(2);
      if(RX_Packet[0]=='S')
      {
        connectSuccess=1;
        Serial1.write(TX_Packet[1]);
       }else
        {
          connectSuccess=0;
        }
        Serial.println(connectSuccess);     }
  }
  connectSuccess=0;
}

yyy_zc

未见 “主机确认返回‘C‘”这一句的具体实现。
可进一步简化程序后测试问题所在