TEST GUARIA2

Dependencies:   BufferedSerial

Files at this revision

API Documentation at this revision

Comitter:
mvargas_dtk
Date:
Tue Aug 30 23:43:29 2022 +0000
Parent:
1:67969835e6a7
Child:
3:30bdde2d1597
Commit message:
rev30_8_2022

Changed in this revision

main.cpp Show annotated file Show diff for this revision Revisions of this file
--- a/main.cpp	Mon Aug 29 21:49:46 2022 +0000
+++ b/main.cpp	Tue Aug 30 23:43:29 2022 +0000
@@ -9,6 +9,7 @@
 #include <string.h>
 #include <math.h>
 #include "BufferedSerial.h" 
+//#include "TextLCD.h"
 
 
 DigitalOut led1(PB_4);
@@ -16,8 +17,8 @@
 DigitalOut BT_RST(PB_5);
 DigitalIn button(PC_13);
 DigitalOut Stby_can(PD_3);
-DigitalOut reg_3v3(PC_10);
-DigitalOut reg_5v(PB_10);
+DigitalOut re_3v3(PC_10);
+DigitalOut re_5v(PB_10);
 DigitalIn bt_state (PA_15);
 
 DigitalIn in1 (PA_7);
@@ -70,9 +71,23 @@
 DigitalOut OUT4(PC_0);  //Salidas activas en bajo
 
 
+// I2C Communication
+//I2C i2c_lcd(PC_9,PA_8); // SDA, SCL  Nucleo F103RB Board
+//TextLCD_I2C lcd(&i2c_lcd, 0x4E, TextLCD::LCD16x2, TextLCD::HD44780); // I2C bus, PCF8574 Slaveaddress, LCD Type, Device Type
+//LCD Type possible for example: LCD16x2, LCD20x4
+//!!Adress here is 0x4E normal adress 0x27, but thats the same, you have to shift left
+//  Adress-shift:    0100 1110     <-   0010 0111 (0x27)
+
+//AnalogIn ana_A0(A0);      //same as Pin PA_0
+
+
 //////////////////////////////////////////////////////////////////////////////
 int main()
 {
+  //  lcd.setMode(TextLCD::DispOn); //DispOff, DispOn
+  //  lcd.setBacklight(TextLCD::LightOff);//LightOff, LightOn ->!LightOff->on!
+  //  lcd.setCursor(TextLCD::CurOff_BlkOff);//CurOff_BlkOff, CurOn_BlkOff, CurOff_BlkOn, CurOn_BlkOn
+    
     Stby_can = 0;
     led1 = 0;
     led2 = 0;
@@ -129,16 +144,20 @@
     vm.baud(9600);
     wait_us(1000000);
     
-    BT.printf("Inicio\n");
-    RS232_1.printf("Inicio\n");
-    RS232_2.printf("Inicio\n");
+    BT.printf("BT: Inicio\n");
+    RS232_1.printf("RS232_1: Inicio\n");
+    RS232_2.printf("RS232_1: Inicio\n");
+    TTL.printf("TTL: Inicio\n");
     
-    reg_3v3 = 0;
-    reg_5v = 0;
+    re_3v3 = 0;
+    re_5v = 0;
     x = 0;
     
     wait_us(1000000);
     
+    //lcd.printf("Inicio\n" );   //   \n will produce newcolumn
+    //lcd.printf("Test Guaria2\n" );       //   \n will produce newcolumn
+    
  //////////////////////////////////////////////////////////////////////////////
  
     while (true) {
@@ -147,46 +166,46 @@
         led1 = !led1;
         led2 = !led2;
         
-        BT.printf("Boton = %d, in1 = %d, in2 = %d , in3 = %d, in4 = %d, in5 = %d, in6 = %d, in7 = %d, in8 = %d \r\n",button.read(),in1.read(),in2.read(),in3.read(),in4.read(),
+        BT.printf("BT: Boton = %d, in1 = %d, in2 = %d , in3 = %d, in4 = %d, in5 = %d, in6 = %d, in7 = %d, in8 = %d \r\n",button.read(),in1.read(),in2.read(),in3.read(),in4.read(),
                                                                                                         in5.read(),in6.read(),in7.read(),in8.read()); 
-        RS232_1.printf("Boton = %d, in1 = %d, in2 = %d , in3 = %d, in4 = %d, in5 = %d, in6 = %d, in7 = %d, in8 = %d \r\n",button.read(),in1.read(),in2.read(),in3.read(),in4.read(),
+        RS232_1.printf("RS232_1: Boton = %d, in1 = %d, in2 = %d , in3 = %d, in4 = %d, in5 = %d, in6 = %d, in7 = %d, in8 = %d \r\n",button.read(),in1.read(),in2.read(),in3.read(),in4.read(),
                                                                                                         in5.read(),in6.read(),in7.read(),in8.read()); 
-        RS232_2.printf("Boton = %d, in1 = %d, in2 = %d , in3 = %d, in4 = %d, in5 = %d, in6 = %d, in7 = %d, in8 = %d \r\n",button.read(),in1.read(),in2.read(),in3.read(),in4.read(),
+        RS232_2.printf("RS232_2: Boton = %d, in1 = %d, in2 = %d , in3 = %d, in4 = %d, in5 = %d, in6 = %d, in7 = %d, in8 = %d \r\n",button.read(),in1.read(),in2.read(),in3.read(),in4.read(),
                                                                                                         in5.read(),in6.read(),in7.read(),in8.read());                                                                                                  
-        TTL.printf("Boton = %d, in1 = %d, in2 = %d , in3 = %d, in4 = %d, in5 = %d, in6 = %d, in7 = %d, in8 = %d \r\n",button.read(),in1.read(),in2.read(),in3.read(),in4.read(),
+        TTL.printf("TTL: Boton = %d, in1 = %d, in2 = %d , in3 = %d, in4 = %d, in5 = %d, in6 = %d, in7 = %d, in8 = %d \r\n",button.read(),in1.read(),in2.read(),in3.read(),in4.read(),
                                                                                                         in5.read(),in6.read(),in7.read(),in8.read());                                                                                             
-        RS485.printf("Boton = %d, in1 = %d, in2 = %d , in3 = %d, in4 = %d, in5 = %d, in6 = %d, in7 = %d, in8 = %d \r\n",button.read(),in1.read(),in2.read(),in3.read(),in4.read(),
+        RS485.printf("RS485: Boton = %d, in1 = %d, in2 = %d , in3 = %d, in4 = %d, in5 = %d, in6 = %d, in7 = %d, in8 = %d \r\n",button.read(),in1.read(),in2.read(),in3.read(),in4.read(),
                                                                                                         in5.read(),in6.read(),in7.read(),in8.read()); 
         
-        BT.printf("GPIOP1: %d%d%d%d%d%d%d, GPIOP2: %d%d%d%d%d%d%d, GPIOP3: %d%d%d%d%d%d%d\r\n",gpio7.read(),gpio6.read(),gpio5.read(),gpio4.read(),
+        BT.printf("BT: GPIOP1: %d%d%d%d%d%d%d, GPIOP2: %d%d%d%d%d%d%d, GPIOP3: %d%d%d%d%d%d%d\r\n",gpio7.read(),gpio6.read(),gpio5.read(),gpio4.read(),
                                                                                                gpio3.read(),gpio2.read(),gpio1.read(),
                                                                                                gpio14.read(),gpio13.read(),gpio12.read(),gpio11.read(),
                                                                                                gpio10.read(),gpio9.read(),gpio8.read(),
                                                                                                gpio21.read(),gpio20.read(),gpio19.read(),gpio18.read(),
                                                                                                gpio17.read(),gpio16.read(),gpio15.read());             
                                                                                                                                                                                    
-        RS232_1.printf("GPIOP1: %d%d%d%d%d%d%d, GPIOP2: %d%d%d%d%d%d%d, GPIOP3: %d%d%d%d%d%d%d\r\n",gpio7.read(),gpio6.read(),gpio5.read(),gpio4.read(),
+        RS232_1.printf("RS232_1: GPIOP1: %d%d%d%d%d%d%d, GPIOP2: %d%d%d%d%d%d%d, GPIOP3: %d%d%d%d%d%d%d\r\n",gpio7.read(),gpio6.read(),gpio5.read(),gpio4.read(),
                                                                                                gpio3.read(),gpio2.read(),gpio1.read(),
                                                                                                gpio14.read(),gpio13.read(),gpio12.read(),gpio11.read(),
                                                                                                gpio10.read(),gpio9.read(),gpio8.read(),
                                                                                                gpio21.read(),gpio20.read(),gpio19.read(),gpio18.read(),
                                                                                                gpio17.read(),gpio16.read(),gpio15.read());             
 
-        RS232_2.printf("GPIOP1: %d%d%d%d%d%d%d, GPIOP2: %d%d%d%d%d%d%d, GPIOP3: %d%d%d%d%d%d%d\r\n",gpio7.read(),gpio6.read(),gpio5.read(),gpio4.read(),
+        RS232_2.printf("RS232_2: GPIOP1: %d%d%d%d%d%d%d, GPIOP2: %d%d%d%d%d%d%d, GPIOP3: %d%d%d%d%d%d%d\r\n",gpio7.read(),gpio6.read(),gpio5.read(),gpio4.read(),
                                                                                                gpio3.read(),gpio2.read(),gpio1.read(),
                                                                                                gpio14.read(),gpio13.read(),gpio12.read(),gpio11.read(),
                                                                                                gpio10.read(),gpio9.read(),gpio8.read(),
                                                                                                gpio21.read(),gpio20.read(),gpio19.read(),gpio18.read(),
                                                                                                gpio17.read(),gpio16.read(),gpio15.read());             
  
-        TTL.printf("GPIOP1: %d%d%d%d%d%d%d, GPIOP2: %d%d%d%d%d%d%d, GPIOP3: %d%d%d%d%d%d%d\r\n",gpio7.read(),gpio6.read(),gpio5.read(),gpio4.read(),
+        TTL.printf("TTL: GPIOP1: %d%d%d%d%d%d%d, GPIOP2: %d%d%d%d%d%d%d, GPIOP3: %d%d%d%d%d%d%d\r\n",gpio7.read(),gpio6.read(),gpio5.read(),gpio4.read(),
                                                                                                gpio3.read(),gpio2.read(),gpio1.read(),
                                                                                                gpio14.read(),gpio13.read(),gpio12.read(),gpio11.read(),
                                                                                                gpio10.read(),gpio9.read(),gpio8.read(),
                                                                                                gpio21.read(),gpio20.read(),gpio19.read(),gpio18.read(),
                                                                                                gpio17.read(),gpio16.read(),gpio15.read());                                                                                                                     
 
-        RS485.printf("GPIOP1: %d%d%d%d%d%d%d, GPIOP2: %d%d%d%d%d%d%d, GPIOP3: %d%d%d%d%d%d%d\r\n",gpio7.read(),gpio6.read(),gpio5.read(),gpio4.read(),
+        RS485.printf("RS485: GPIOP1: %d%d%d%d%d%d%d, GPIOP2: %d%d%d%d%d%d%d, GPIOP3: %d%d%d%d%d%d%d\r\n",gpio7.read(),gpio6.read(),gpio5.read(),gpio4.read(),
                                                                                                gpio3.read(),gpio2.read(),gpio1.read(),
                                                                                                gpio14.read(),gpio13.read(),gpio12.read(),gpio11.read(),
                                                                                                gpio10.read(),gpio9.read(),gpio8.read(),
@@ -195,11 +214,11 @@
                                                                                                                                                                 
         if (((bt_state.read())==1)&&(y==0)){
             
-            BT.printf("Bluetooth Conectado\r\n");
-            RS232_1.printf("Bluetooth Conectado\r\n");
-            RS232_2.printf("Bluetooth Conectado\r\n");
-            RS485.printf("Bluetooth Conectado\r\n");
-            TTL.printf("Bluetooth Conectado\r\n");
+            BT.printf("BT: Bluetooth Conectado\r\n");
+            RS232_1.printf("RS232_1: Bluetooth Conectado\r\n");
+            RS232_2.printf("RS232_2: Bluetooth Conectado\r\n");
+            RS485.printf("RS485: Bluetooth Conectado\r\n");
+            TTL.printf("TTL: Bluetooth Conectado\r\n");
             vm.putc(0XAA);
             vm.putc(0X07);
             vm.putc(0X02);
@@ -249,34 +268,39 @@
          if (x != 0) {
             datoUSB[x] = '\0';
 
-            BT.printf("DATA: %s\r\n", datoUSB);
-            BT.printf("\nCaracteres: %d\r\n", x);
-            BT.printf("\r\n");
-            BT.printf("\r\n");
+            BT.printf("BT: DATA: %s\r\n", datoUSB);
+            BT.printf("BT: \nCaracteres: %d\r\n", x);
+            BT.printf("BT: \r\n");
+            BT.printf("BT: \r\n");
         
-            RS232_1.printf("DATA: %s\r\n", datoUSB);
-            RS232_1.printf("\nCaracteres: %d\r\n", x);
-            RS232_1.printf("\r\n");
-            RS232_1.printf("\r\n");
+            RS232_1.printf("RS232_1: DATA: %s\r\n", datoUSB);
+            RS232_1.printf("RS232_1: \nCaracteres: %d\r\n", x);
+            RS232_1.printf("RS232_1: \r\n");
+            RS232_1.printf("RS232_1: \r\n");
             
-            RS232_2.printf("DATA: %s\r\n", datoUSB);
-            RS232_2.printf("\nCaracteres: %d\r\n", x);
-            RS232_2.printf("\r\n");
-            RS232_2.printf("\r\n");
+            RS232_2.printf("RS232_2: DATA: %s\r\n", datoUSB);
+            RS232_2.printf("RS232_2: \nCaracteres: %d\r\n", x);
+            RS232_2.printf("RS232_2: \r\n");
+            RS232_2.printf("RS232_2: \r\n");
+
+            RS485.printf("RS485: DATA: %s\r\n", datoUSB);
+            RS485.printf("RS485: \nCaracteres: %d\r\n", x);
+            RS485.printf("RS485: \r\n");
+            RS485.printf("RS485: \r\n");
             
-            TTL.printf("DATA: %s\r\n", datoUSB);
-            TTL.printf("\nCaracteres: %d\r\n", x);
-            TTL.printf("\r\n");
-            TTL.printf("\r\n");
+            TTL.printf("TTL: DATA: %s\r\n", datoUSB);
+            TTL.printf("TTL: \nCaracteres: %d\r\n", x);
+            TTL.printf("TTL: \r\n");
+            TTL.printf("TTL: \r\n");
                   
             if(strcmp(ONOUTS,datoUSB) == 0) {
                 OUT1 = OUT2 = OUT3 = OUT4 = 1;
                 i= 1;
-                BT.printf("Salidas activadas\r\n");
-                RS232_1.printf("Salidas activadas\r\n");
-                RS232_2.printf("Salidas activadas\r\n");
-                TTL.printf("Salidas activadas\r\n");
-                RS485.printf("Salidas activadas\r\n");
+                BT.printf("BT: Salidas activadas\r\n");
+                RS232_1.printf("RS232_1: Salidas activadas\r\n");
+                RS232_2.printf("RS232_2: Salidas activadas\r\n");
+                TTL.printf("TTL: Salidas activadas\r\n");
+                RS485.printf("RS485: Salidas activadas\r\n");
                 vm.putc(0XAA);
                 vm.putc(0X07);
                 vm.putc(0X02);
@@ -288,11 +312,11 @@
             else if(strcmp(OFFOUTS,datoUSB) == 0) {
                 OUT1 = OUT2 = OUT3 = OUT4 = 0;
                 i= 1;
-                BT.printf("Salidas desactivadas\r\n");
-                RS232_1.printf("Salidas desactivadas\r\n");
-                RS232_2.printf("Salidas desactivadas\r\n");
-                RS485.printf("Salidas desactivadas\r\n");
-                TTL.printf("Salidas desactivadas\r\n");
+                BT.printf("BT: Salidas desactivadas\r\n");
+                RS232_1.printf("RS232_1: Salidas desactivadas\r\n");
+                RS232_2.printf("RS232_2: Salidas desactivadas\r\n");
+                RS485.printf("RS485: Salidas desactivadas\r\n");
+                TTL.printf("TTL: Salidas desactivadas\r\n");
                 vm.putc(0XAA);
                 vm.putc(0X07);
                 vm.putc(0X02);
@@ -305,11 +329,11 @@
                 OUT2 = OUT3 = OUT4 = 0;
                 OUT1 = 1;
                 i= 1;
-                BT.printf("Salida 1 Activada\r\n");
-                RS232_1.printf("Salida 1 Activada\r\n");
-                RS232_2.printf("Salida 1 Activada\r\n");
-                RS485.printf("Salida 1 Activada\r\n");
-                TTL.printf("Salida 1 Activada\r\n");
+                BT.printf("BT: Salida 1 Activada\r\n");
+                RS232_1.printf("RS232_1: Salida 1 Activada\r\n");
+                RS232_2.printf("RS232_2: Salida 1 Activada\r\n");
+                RS485.printf("RS485_1: Salida 1 Activada\r\n");
+                TTL.printf("TTL: Salida 1 Activada\r\n");
                 vm.putc(0XAA);
                 vm.putc(0X07);
                 vm.putc(0X02);
@@ -322,11 +346,11 @@
                 OUT1 = OUT3 = OUT4 = 0;
                 OUT2 = 1;
                 i= 1;
-                BT.printf("Salida 2 Activada\r\n");
-                RS232_1.printf("Salida 2 Activada\r\n");
-                RS232_2.printf("Salida 2 Activada\r\n");
-                RS485.printf("Salida 2 Activada\r\n");
-                TTL.printf("Salida 2 Activada\r\n");
+                BT.printf("BT: Salida 2 Activada\r\n");
+                RS232_1.printf("RS232_1: Salida 2 Activada\r\n");
+                RS232_2.printf("RS232_2: Salida 2 Activada\r\n");
+                RS485.printf("RS485: Salida 2 Activada\r\n");
+                TTL.printf("TTL: Salida 2 Activada\r\n");
                 vm.putc(0XAA);
                 vm.putc(0X07);
                 vm.putc(0X02);
@@ -339,11 +363,11 @@
                 OUT1 = OUT2 = OUT4  = 0;
                 OUT3 = 1;
                 i= 1;
-                BT.printf("Salida 3 Activada\r\n");
-                RS232_1.printf("Salida 3 Activada\r\n");
-                RS232_2.printf("Salida 3 Activada\r\n");
-                RS485.printf("Salida 3 Activada\r\n");
-                TTL.printf("Salida 3 Activada\r\n");
+                BT.printf("BT: Salida 3 Activada\r\n");
+                RS232_1.printf("RS232_1: Salida 3 Activada\r\n");
+                RS232_2.printf("RS232_2: Salida 3 Activada\r\n");
+                RS485.printf("RS485: Salida 3 Activada\r\n");
+                TTL.printf("TTL: Salida 3 Activada\r\n");
                 vm.putc(0XAA);
                 vm.putc(0X07);
                 vm.putc(0X02);
@@ -356,11 +380,11 @@
                 OUT1 = OUT2 = OUT3 = 0;
                 OUT4 = 1;
                 i= 1;
-                BT.printf("Salida 4 Activada\r\n");
-                RS232_1.printf("Salida 4 Activada\r\n");
-                RS232_2.printf("Salida 4 Activada\r\n");
-                RS485.printf("Salida 4 Activada\r\n");
-                TTL.printf("Salida 4 Activada\r\n");
+                BT.printf("BT: Salida 4 Activada\r\n");
+                RS232_1.printf("RS232_1: Salida 4 Activada\r\n");
+                RS232_2.printf("RS232_2: Salida 4 Activada\r\n");
+                RS485.printf("RS485: Salida 4 Activada\r\n");
+                TTL.printf("TTL: Salida 4 Activada\r\n");
                 vm.putc(0XAA);
                 vm.putc(0X07);
                 vm.putc(0X02);
@@ -370,12 +394,12 @@
             }
             
             else if(strcmp(ON3V3,datoUSB) == 0) {
-                reg_3v3 = 1;
-                BT.printf("Regulador 3.3V activado\r\n");
-                RS232_1.printf("Regulador 3.3V activado\r\n");
-                RS232_2.printf("Regulador 3.3V activado\r\n");
-                RS485.printf("Regulador 3.3V activado\r\n");
-                TTL.printf("Regulador 3.3V activado\r\n");
+                re_3v3 = 1;
+                BT.printf("BT: Regulador 3.3V activado\r\n");
+                RS232_1.printf("RS232_1: Regulador 3.3V activado\r\n");
+                RS232_2.printf("RS232_2: Regulador 3.3V activado\r\n");
+                RS485.printf("RS485: Regulador 3.3V activado\r\n");
+                TTL.printf("TTL: Regulador 3.3V activado\r\n");
                 vm.putc(0XAA);
                 vm.putc(0X07);
                 vm.putc(0X02);
@@ -385,12 +409,12 @@
             }
             
                 else if(strcmp(OFF3V3,datoUSB) == 0) {
-                reg_3v3 = 0;
-                BT.printf("Regulador 3.3V desactivado\r\n");
-                RS232_1.printf("Regulador 3.3V desactivado\r\n");
-                RS232_2.printf("Regulador 3.3V desactivado\r\n");
-                RS485.printf("Regulador 3.3V desactivado\r\n");
-                TTL.printf("Regulador 3.3V desactivado\r\n");
+                re_3v3 = 0;
+                BT.printf("BT: Regulador 3.3V desactivado\r\n");
+                RS232_1.printf("RS232_1: Regulador 3.3V desactivado\r\n");
+                RS232_2.printf("RS232_2:Regulador 3.3V desactivado\r\n");
+                RS485.printf("RS485: Regulador 3.3V desactivado\r\n");
+                TTL.printf("TTL: Regulador 3.3V desactivado\r\n");
                 vm.putc(0XAA);
                 vm.putc(0X07);
                 vm.putc(0X02);
@@ -405,20 +429,20 @@
                 BT_RST = 1;
                 y = 0;
                 
-                BT.printf("Reset BT\r\n");
-                RS232_1.printf("Reset BT\r\n");
-                RS232_2.printf("Reset BT\r\n");
-                RS485.printf("Reset BT\r\n");
-                TTL.printf("Reset BT\r\n");
+                BT.printf("BT: Reset BT\r\n");
+                RS232_1.printf("RS232_1: Reset BT\r\n");
+                RS232_2.printf("RS232_2: Reset BT\r\n");
+                RS485.printf("RS485: Reset BT\r\n");
+                TTL.printf("TTL: Reset BT\r\n");
             }
                         
                 else if(strcmp(ON5V,datoUSB) == 0) {
-                reg_5v = 1;
-                BT.printf("Regulador 5V activado\r\n");
-                RS232_1.printf("Regulador 5V activado\r\n");
-                RS232_2.printf("Regulador 5V activado\r\n");
-                RS485.printf("Regulador 5V activado\r\n");
-                TTL.printf("Regulador 5V activado\r\n");
+                re_5v = 1;
+                BT.printf("BT: Regulador 5V activado\r\n");
+                RS232_1.printf("RS232_1: Regulador 5V activado\r\n");
+                RS232_2.printf("RS232_2: Regulador 5V activado\r\n");
+                RS485.printf("RS485: Regulador 5V activado\r\n");
+                TTL.printf("TTL: Regulador 5V activado\r\n");
                 vm.putc(0XAA);
                 vm.putc(0X07);
                 vm.putc(0X02);
@@ -428,12 +452,12 @@
             }
             
                 else if(strcmp(OFF5V,datoUSB) == 0) {
-                reg_5v = 0; 
-                BT.printf("Regulador 5V desactivado\r\n");
-                RS232_1.printf("Regulador 5V desactivado\r\n");
-                RS232_2.printf("Regulador 5V desactivado\r\n");
-                RS485.printf("Regulador 5V desactivado\r\n");
-                TTL.printf("Regulador 5V desactivado\r\n");
+                re_5v = 0; 
+                BT.printf("BT: Regulador 5V desactivado\r\n");
+                RS232_1.printf("RS232_1: Regulador 5V desactivado\r\n");
+                RS232_2.printf("RS232_2: Regulador 5V desactivado\r\n");
+                RS485.printf("RS485: Regulador 5V desactivado\r\n");
+                TTL.printf("TTL: Regulador 5V desactivado\r\n");
                 vm.putc(0XAA);
                 vm.putc(0X07);
                 vm.putc(0X02);
@@ -452,11 +476,11 @@
             }
     
             else{
-                BT.printf("COMANDO INVALIDO\n");
-                RS232_1.printf("COMANDO INVALIDO\n");
-                RS232_2.printf("COMANDO INVALIDO\n");
-                RS485.printf("COMANDO INVALIDO\n");
-                TTL.printf("COMANDO INVALIDO\n");
+                BT.printf("BT: COMANDO INVALIDO\n");
+                RS232_1.printf("RS232_1: COMANDO INVALIDO\n");
+                RS232_2.printf("RS232_2: COMANDO INVALIDO\n");
+                RS485.printf("RS485: COMANDO INVALIDO\n");
+                TTL.printf("TTL: COMANDO INVALIDO\n");
                 }
       }