Sto creando un MOSTRO

[FIDOCAD]
MC 60 30 0 0 200
MC 80 60 1 0 280
MC 80 45 0 0 115
FCJ
TY 90 55 4 3 0 0 0 * 10K
TY 90 50 4 3 0 0 0 *
MC 95 30 0 0 000
FCJ
TY 105 40 4 3 0 0 0 * Tx
TY 105 35 4 3 0 0 0 * Tx
MC 95 75 0 0 000
FCJ
TY 105 85 4 3 0 0 0 * Rx
TY 105 80 4 3 0 0 0 * Rx
LI 35 30 60 30 0
LI 75 30 95 30 0
LI 80 60 80 55 0
LI 80 45 80 30 0
LI 50 75 50 30 0
LI 90 75 95 75 0
LI 70 75 50 75 0
SA 80 30 0
SA 50 30 0
LI 35 30 33 30 0
EV 33 32 29 28 0
TY 30 35 5 3 0 0 0 * RTx

#include <SoftwareSerial.h>


// Gestione stufa
// step 1: solo echo verso un PC
// step 2: formattazione dei dati

const byte rxPin = 2;
const byte txPin = 3;
const byte r2Pin = 4;
const byte t2Pin = 5;

SoftwareSerial ser1(rxPin, txPin); // serve per la stufa
SoftwareSerial ser2(r2Pin, t2Pin); // serve per la comunicazione

byte doma_nda(byte msb , byte lsb)
{
 char stringa[3];

 

 // trasmette alla stufa il codice e restituisce il risultato//
 // non esegue il test di integrità
 // step 2 esegue il test di integrità

 digitalWrite(led, HIGH);
 //un ciclo, prova tre volte, se ricevuto OK fa break, altrimente restituisce default
 for (int j = 0; j < 3; j++)
 {
   ser1.write(msb);
   ser1.write(lsb);
   ser1.listen();
   //ok adesso 1/3 secondo di ascolto

   delay(300);

   for (int i = 0 ; ser1.available() > 0 ; i++)
   {
     stringa[i] = ser1.read();
   }
   ser2.listen();
   // effettuo il test
   if (msb + lsb + stringa[1] == stringa[0])
   {
     //test OK

     return stringa[1];
     break;

   }
   else
   {
     return 0;
   }
   digitalWrite(led, LOW);
 }

}

doma_nda(00, 33))

Serial.print(F("Stato della stufa: "));
Serial.println(doma_nda(00, 33));

uint16_t _inverse_logic:1;
 //mxc
 uint16_t _dual_bit:1;

public:
 // public methods
 //mxc
 SoftwareSerial(uint8_t receivePin, uint8_t transmitPin, bool inverse_logic = false, bool dual_bit=false);

// skip the stop bit
   tunedDelay(_rx_delay_stopbit);
   DebugPulse(_DEBUG_PIN1, 1);




//mxc aggiunto secondo stop bit
   if(_dual_bit)
     tunedDelay(_rx_delay_stopbit);





   // Re-enable interrupts when we're sure to be inside the stop bit
   setRxIntMsk(true);
al(uint8_t receivePin, uint8_t transmitPin, bool inverse_logic = false, bool dual_bit=false);


//omissis





//
// Constructor
//
SoftwareSerial::SoftwareSerial(uint8_t receivePin, uint8_t transmitPin, bool inverse_logic , bool dual_bit) :



 _rx_delay_centering(0),
 _rx_delay_intrabit(0),
 _rx_delay_stopbit(0),
 _tx_delay(0),
 _buffer_overflow(false),
 _inverse_logic(inverse_logic),


 _dual_bit(dual_bit)




//omissis

 SREG = oldSREG; // turn interrupts back on
 tunedDelay(_tx_delay);



// mxc aggiunto secondo stop bit in trasmissione
 if (_dual_bit)
   tunedDelay(_tx_delay);




 return 1;

SoftwareSerial ser1(rxPin, txPin, false, true); // serve per la stufa
SoftwareSerial ser2(r2Pin, t2Pin); // serve per la comunicazione