p2p-pingpong-clickbutton

Dependencies:   PingPong-P2P-ClickButtonToWork-SX1272 Lora_SX1272_Coragem

Revision:
5:ef21a65a3450
Parent:
3:cbe3f441353e
Child:
6:c305f2aa79a4
--- a/main.cpp	Tue Sep 03 21:25:05 2019 +0000
+++ b/main.cpp	Wed Dec 04 11:50:35 2019 +0000
@@ -1,131 +1,11 @@
-/*
- *  temperature sensor on analog 8 to test the LoRa gateway
- *
- *  Copyright (C) 2016 Congduc Pham, University of Pau, France
- *
- *  This program is free software: you can redistribute it and/or modify
- *  it under the terms of the GNU General Public License as published by
- *  the Free Software Foundation, either version 3 of the License, or
- *  (at your option) any later version.
-
- *  This program is distributed in the hope that it will be useful,
- *  but WITHOUT ANY WARRANTY; without even the implied warranty of
- *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
- *  GNU General Public License for more details.
- *
- *  You should have received a copy of the GNU General Public License
- *  along with the program.  If not, see <http://www.gnu.org/licenses/>.
- *
- *****************************************************************************
- * last update: Sep. 29th, 2017 by C. Pham
- * last update: oct 30th , 2017 by C.Dupaty
- * ADAPTATION FOR NUCLEO STM32, TESTED ON NUCLEO-L073RZ WITH 
- * SX1272MB2xAS SHIELD
- * DRAGINO SHIELD V95 WITH GPS  http://wiki.dragino.com/index.php?title=Lora/GPS_Shield 
- *      For DRAGINO move LORA_CLK LORA_DI LORA_DO straps to the right (arduino 11 12 13)
- * ALL CONFIGURATIONS FOR ARDUINO HAVE BEEN REMOVED
- * WORK ONLY IN EUROPE
- * please visit http://cpham.perso.univ-pau.fr/LORA/LoRaDevices.html
- * for original version for ARDUINO 
-*/
-  
 #include "mbed.h"
-#include "SX1272.h"
-
-
-#define BAND868
-#define MAX_DBM 14
-#define DATA 0
-#define PING 1
-#define PONG 2
-
-#define ADDRESS 10
-
-const uint32_t DEFAULT_CHANNEL=CH_12_900;//915Mhz CH_12_900 =>0xE4C000
-
-//#define WITH_EEPROM            //  TO DO ON STM32
-#define WITH_APPKEY
-#define NEW_DATA_FIELD
-//#define WITH_ACK
-
-///////////////////////////////////////////////////////////////////
-// CHANGE HERE THE LORA MODE, NODE ADDRESS 
-#define LORAMODE  1
-#define node_addr 6
-//////////////////////////////////////////////////////////////////
-
-///////////////////////////////////////////////////////////////////
-// CHANGE HERE THE THINGSPEAK FIELD BETWEEN 1 AND 4
-#define field_index 1
-///////////////////////////////////////////////////////////////////
-
-///////////////////////////////////////////////////////////////////
-// CHANGE HERE THE TIME IN SECONDS BETWEEN 2 READING & TRANSMISSION
-//#define minTime 120 // 2 minutes
-//#define maxTime 600 // 10 minutes
-#define minTime 5 // seconds
-#define maxTime 25 // seconds
-///////////////////////////////////////////////////////////////////
-
-#ifdef WITH_APPKEY
-///////////////////////////////////////////////////////////////////
-// CHANGE HERE THE APPKEY, BUT IF GW CHECKS FOR APPKEY, MUST BE
-// IN THE APPKEY LIST MAINTAINED BY GW.
-uint8_t my_appKey[4]={5, 6, 7, 8};
-///////////////////////////////////////////////////////////////////
-#endif
-
-#ifdef WITH_EEPROM
-#include <EEPROM.h>
-#endif
-
-#define DEFAULT_DEST_ADDR 6
-
-#ifdef WITH_ACK
-#define NB_RETRIES 2
-#endif
-
-#ifdef WITH_EEPROM
-struct sx1272config {
-
-    uint8_t flag1;
-    uint8_t flag2;
-    uint8_t seq;
-    // can add other fields such as LoRa mode,...
-};
-
-sx1272config my_sx1272config;
-#endif
+#include "bme280.txt"
 
 ///////////////////////////////////////
 // Globals variables
 ///////////////////////////////////////
 
-//______________BME_280________________
-char cmd_bme[18];
-uint32_t hum_raw;
-float humf;
-uint32_t temp_raw;
-float tempf;
-uint32_t press_raw;
-float pressf;
-//char cmd[4];
-
-//___________SX1272____________________
-int e;
-
-//___________mensagem_____________________
-uint8_t message[100];
-uint8_t buffer[100];
-uint8_t message_pong[]="Pong";
-uint8_t message_ping[]="Ping";
-uint8_t r_size;
-char float_temp[10];
-char float_press[10];
-char float_hum[10];
-int cont =0;
-
-
+//declaraao gerais
 DigitalOut led1(P1_13);
 DigitalOut led2(P1_14);
 InterruptIn dio0(P0_12);
@@ -135,18 +15,7 @@
 
 EventQueue queue;
 
-int loraMode=LORAMODE;
-
-//_________BME 280___
-
-I2C sensor(p13, p15);
-const int BME280_ADDR = (0x77 << 1);
-
-uint16_t dig_T1,dig_P1,dig_H1, dig_H3;
-int16_t dig_T2, dig_T3,dig_P2, dig_P3, dig_P4, dig_P5, dig_P6, dig_P7, dig_P8, dig_P9,dig_H2, dig_H4, dig_H5, dig_H6;
-int32_t t_fine;
-
- //============= internet of turtles =============
+//============= internet of turtles =============
 Timer time_breathing;
 Timer time_diving;
 bool beathing = false;
@@ -156,402 +25,103 @@
 char float_breathing_time[10];
 char float_diving_time[10];
 
-Timer seconds;
-
+//Timer seconds;
 //================================================
-void bme_init() { //bme initialization
-
-
-    sensor.frequency(1000000);
-
-    cmd_bme[0] = 0xf2; // ctrl_hum
-    cmd_bme[1] = 0x01;
-    sensor.write(BME280_ADDR, cmd_bme, 2);
-
-    cmd_bme[0] = 0xf4; // ctrl_meas
-    cmd_bme[1] = 0x27;
-    sensor.write(BME280_ADDR, cmd_bme, 2);
-
-    cmd_bme[0] = 0xf5; // config
-    cmd_bme[1] = 0xa0;
-    sensor.write(BME280_ADDR, cmd_bme, 2);
-
-    cmd_bme[0] = 0x88; // read dig_T regs
-    sensor.write(BME280_ADDR, cmd_bme, 1);
-    sensor.read(BME280_ADDR, cmd_bme, 6);
-
-    dig_T1 = (cmd_bme[1] << 8) | cmd_bme[0];
-    dig_T2 = (cmd_bme[3] << 8) | cmd_bme[2];
-    dig_T3 = (cmd_bme[5] << 8) | cmd_bme[4];
-
-//    DEBUG_PRINT("dig_T = 0x%x, 0x%x, 0x%x\n", dig_T1, dig_T2, dig_T3);
 
-    cmd_bme[0] = 0x8E; // read dig_P regs
-    sensor.write(BME280_ADDR, cmd_bme, 1);
-    sensor.read(BME280_ADDR, cmd_bme, 18);
-
-    dig_P1 = (cmd_bme[ 1] << 8) | cmd_bme[ 0];
-    dig_P2 = (cmd_bme[ 3] << 8) | cmd_bme[ 2];
-    dig_P3 = (cmd_bme[ 5] << 8) | cmd_bme[ 4];
-    dig_P4 = (cmd_bme[ 7] << 8) | cmd_bme[ 6];
-    dig_P5 = (cmd_bme[ 9] << 8) | cmd_bme[ 8];
-    dig_P6 = (cmd_bme[11] << 8) | cmd_bme[10];
-    dig_P7 = (cmd_bme[13] << 8) | cmd_bme[12];
-    dig_P8 = (cmd_bme[15] << 8) | cmd_bme[14];
-    dig_P9 = (cmd_bme[17] << 8) | cmd_bme[16];
-
-//    DEBUG_PRINT("dig_P = 0x%x, 0x%x, 0x%x, 0x%x, 0x%x, 0x%x, 0x%x, 0x%x, 0x%x\n", dig_P1, dig_P2, dig_P3, dig_P4, dig_P5, dig_P6, dig_P7, dig_P8, dig_P9);
+#include "lora.txt"
 
-    cmd_bme[0] = 0xA1; // read dig_H regs
-    sensor.write(BME280_ADDR, cmd_bme, 1);
-    sensor.read(BME280_ADDR, cmd_bme, 9);
-
-    dig_H1 = cmd_bme[0];
-    dig_H2 = (cmd_bme[2] << 8) | cmd_bme[1];
-    dig_H3 = cmd_bme[3];
-    dig_H4 = (cmd_bme[4] << 4) | (cmd_bme[5] & 0x0f);
-    dig_H5 = (cmd_bme[7] << 4) | ((cmd_bme[6]>>4) & 0x0f);
-    dig_H6 = cmd_bme[8];
-
-//    DEBUG_PRINT("dig_H = 0x%x, 0x%x, 0x%x, 0x%x, 0x%x, 0x%x\n", dig_H1, dig_H2, dig_H3, dig_H4, dig_H5, dig_H6);
-}
-
-float getTemperature(){
-
-    
-    cmd_bme[0] = 0xfa; // temp_msb
-    sensor.write(BME280_ADDR, cmd_bme, 1);
-    sensor.read(BME280_ADDR, &cmd_bme[1], 1);
+int main(void) {
     
-    cmd_bme[0] = 0xfb; // temp_lsb
-    sensor.write(BME280_ADDR, cmd_bme, 1);
-    sensor.read(BME280_ADDR, &cmd_bme[2], 1);
     
-    cmd_bme[0] = 0xfc; // temp_xlsb
-    sensor.write(BME280_ADDR, cmd_bme, 1);
-    sensor.read(BME280_ADDR, &cmd_bme[3], 1);
-    
-    temp_raw = (cmd_bme[1] << 12) | (cmd_bme[2] << 4) | (cmd_bme[3] >> 4);
-    
-    int32_t temp;
-    
-    temp =
-        (((((temp_raw >> 3) - (dig_T1 << 1))) * dig_T2) >> 11) +
-        ((((((temp_raw >> 4) - dig_T1) * ((temp_raw >> 4) - dig_T1)) >> 12) * dig_T3) >> 14);
-    
-    t_fine = temp;
-    temp = (temp * 5 + 128) >> 8;
-    tempf = (float)temp;
     
-    return (tempf/100.0f);
-}
-
-float getPressure(){
-
-    cmd_bme[0] = 0xf7; // press_msb
-    sensor.write(BME280_ADDR, cmd_bme, 1);
-    sensor.read(BME280_ADDR, &cmd_bme[1], 1);
-
-    cmd_bme[0] = 0xf8; // press_lsb
-    sensor.write(BME280_ADDR, cmd_bme, 1);
-    sensor.read(BME280_ADDR, &cmd_bme[2], 1);
-
-    cmd_bme[0] = 0xf9; // press_xlsb
-    sensor.write(BME280_ADDR, cmd_bme, 1);
-    sensor.read(BME280_ADDR, &cmd_bme[3], 1);
-
-    press_raw = (cmd_bme[1] << 12) | (cmd_bme[2] << 4) | (cmd_bme[3] >> 4);
-
-    int32_t var1, var2;
-    uint32_t press;
-
-    var1 = (t_fine >> 1) - 64000;
-    var2 = (((var1 >> 2) * (var1 >> 2)) >> 11) * dig_P6;
-    var2 = var2 + ((var1 * dig_P5) << 1);
-    var2 = (var2 >> 2) + (dig_P4 << 16);
-    var1 = (((dig_P3 * (((var1 >> 2)*(var1 >> 2)) >> 13)) >> 3) + ((dig_P2 * var1) >> 1)) >> 18;
-    var1 = ((32768 + var1) * dig_P1) >> 15;
-    if (var1 == 0) {
-        return 0;
-    }
-    press = (((1048576 - press_raw) - (var2 >> 12))) * 3125;
-    if(press < 0x80000000) {
-        press = (press << 1) / var1;
-    }
-    else {
-        press = (press / var1) * 2;
-    }
-    var1 = ((int32_t)dig_P9 * ((int32_t)(((press >> 3) * (press >> 3)) >> 13))) >> 12;
-    var2 = (((int32_t)(press >> 2)) * (int32_t)dig_P8) >> 13;
-    press = (press + ((var1 + var2 + dig_P7) >> 4));
-
-    pressf = (float)press;
-    return (pressf/100.0f);
-}
-
-float getHumidity(){
+    ///////////////////////////////////////
+    // Variables
+    ///////////////////////////////////////
 
 
-    cmd_bme[0] = 0xfd; // hum_msb
-    sensor.write(BME280_ADDR, cmd_bme, 1);
-    sensor.read(BME280_ADDR, &cmd_bme[1], 1);
-
-    cmd_bme[0] = 0xfd; // hum_lsb
-    sensor.write(BME280_ADDR, cmd_bme, 1);
-    sensor.read(BME280_ADDR, &cmd_bme[2], 1);
-
-    hum_raw = (cmd_bme[1] << 8) | cmd_bme[2];
-
-    int32_t v_x1;
-
-    v_x1 = t_fine - 76800;
-    v_x1 =  (((((hum_raw << 14) -(((int32_t)dig_H4) << 20) - (((int32_t)dig_H5) * v_x1)) +
-               ((int32_t)16384)) >> 15) * (((((((v_x1 * (int32_t)dig_H6) >> 10) *
-                                            (((v_x1 * ((int32_t)dig_H3)) >> 11) + 32768)) >> 10) + 2097152) *
-                                            (int32_t)dig_H2 + 8192) >> 14));
-    v_x1 = (v_x1 - (((((v_x1 >> 15) * (v_x1 >> 15)) >> 7) * (int32_t)dig_H1) >> 4));
-    v_x1 = (v_x1 < 0 ? 0 : v_x1);
-    v_x1 = (v_x1 > 419430400 ? 419430400 : v_x1);
-
-    humf = (float)(v_x1 >> 12);
+    
+//    uint8_t big_message[] = "1234567890qwertyuiopasdfghjklzxcvbnm1234567890qwertyuiopasdfghjklzxcvbnm1234567890qwertyuiopasdfghjklzxcvbnm1234567890qwertyuiopasdfghjklzxcvbnm1234567890qwertyuiopasdfghjklzxcvbnm1234567890qwertyuiopasdfghjklzxcvbnm01234567890123456789";
+//    uint8_t reset_message[] = "Reset";
 
-    return (humf/1024.0f);
-}
-
-/////////////////////////////////////////
-// SETUP SX1272 initialisation
-////////////////////////////////////////
-void setup(){
-      
-    
-      printf("------Coragem LoRa temperature sensor-------------\n");
-      //sx1272.ON();  // Power ON the module
-
-    int error_config_sx1272=0;
-    
-    // Set transmission mode and print the result
-    e = sx1272.setMode(loraMode);
-    printf("Mode: %d\n",loraMode);
-    if (e) error_config_sx1272=1;
-    printf("Setting Mode: state %d\n",e);
-    
-    // enable carrier sense
-    sx1272._enableCarrierSense=true;
-    
-    // for LOW POWER
-    sx1272._RSSIonSend=false;
+    //long int time_start = seconds.read();
+    //printf ("timestart=%d  leitura = %d\n",time_start,seconds.read());
     
     
-    // Select frequency channel
-    e = sx1272.setChannel(DEFAULT_CHANNEL);
-    if (e) error_config_sx1272=1;
-    printf("Setting Channel: state %d\n",e);
-    
-    // Select amplifier line; PABOOST or RFO
-//    #ifdef PABOOST
-//        printf("pabboost\n");
-//        sx1272._needPABOOST=true;
-//    // previous way for setting output power
-//    // powerLevel='x';
-//    #else
-//    // previous way for setting output power
-//    // powerLevel='M';  
-//    #endif
-    
-    // previous way for setting output power
-    // e = sx1272.setPower(powerLevel); 
-    
-    e = sx1272.setPowerDBM((uint8_t)MAX_DBM);
-    if (e) error_config_sx1272=1;
-    printf("Setting Power: state %d\n",e);
-    
-    // Set the node address and print the result
-    e = sx1272.setNodeAddress(node_addr);
-    if (e) error_config_sx1272=1;
-    printf("Setting node addr: state %d\n",e);
-    
-    // Print a success message
-    if (!error_config_sx1272) printf("SX1272 successfully configured\n");
-    else printf("ERROR CONFIGURATION SX1272\n");
-    
-    wait_ms(400);
-}
-
-
-void send_packet(int mode){
-    led1=1;
-    sx1272.writeRegister(0x01,129);//standby    
-    sx1272.setPacketType(PKT_TYPE_DATA);
-    
-    printf ("sendpacket1\n");
-    if (mode == DATA ) {
-       // uint8_t message[100];    
-        sprintf(float_temp,"%2.2f",getTemperature());
-        sprintf(float_press,"%04.2f",getPressure());
-        sprintf(float_hum,"%2.2f",getHumidity());
-        
-        printf ("sendpacket2\n");
-        //============= internet of turtles =============
-        sprintf(float_breathing_time,"%2.2f", last_breathing_time);
-        sprintf(float_diving_time,"%2.2f", last_diving_time);
-        r_size=sprintf((char*)message,"\\!#%s°C_%shPa_%s_Dt%s_Bt%s%%",float_temp,float_press,float_hum,float_diving_time,float_breathing_time);
-        // ==============================================
-        
-            printf ("sendpacket3\n");
-        //size=sprintf((char*)message,"\\!#%s°C_%shPa_%s%%",float_temp,float_press,float_hum);
-        sx1272.sendPacketTimeout(DEFAULT_DEST_ADDR, message, r_size);
-        printf ("sendpacket4\n");
-        printf("packet send :\n%s\n",message);
-       
-    }
-    else if (mode == PING ){   
+    ///////////////////////////////////////
+    // Configuration
+    ///////////////////////////////////////
     
-       // uint8_t message[]="Ping";
-        //strcpy( message, "Ping");
-
-        sx1272.sendPacketTimeout(DEFAULT_DEST_ADDR, message_ping, sizeof(message_ping));
-        printf("packet send :\n%s\n",message_ping);
-        
-        //sx1272.sendPacketTimeout(DEFAULT_DEST_ADDR, message, sizeof(message));
-//        sx1272.writeRegister(REG_OP_MODE, LORA_STANDBY_MODE);  // Stdby LoRa mode to write in FIFO
-        
-//        sx1272.writeRegister(0x0E,0x00);
-//        sx1272.writeRegister(0x0D,0x00);
-        
-//        sx1272.writeRegister(REG_PAYLOAD_LENGTH_LORA, sizeof(message));
-//        for(unsigned int i = 0; i < sizeof(message); i++)
-//        {
-//            sx1272.writeRegister(REG_FIFO, message[i]);  // Writing the payload in FIFO
-//        }
-//        sx1272.writeRegister(REG_OP_MODE, LORA_TX_MODE);  // LORA mode - Tx
-        
-//        int exitTime = millis()+2000;//2 segundos para sair do for
-        
-//        char value = sx1272.readRegister(REG_IRQ_FLAGS);
-//        while (( value && 8 == 0) && (millis() < exitTime))
-//        {
-//            value = sx1272.readRegister(REG_IRQ_FLAGS);
-//        }
-             
-
- //       printf("packet send :\n%s\n",message);
- //       wait_ms(500); 
- //       sx1272.writeRegister(0x12,255);//clean flags
- //       sx1272.writeRegister(REG_OP_MODE, LORA_STANDBY_MODE);  // Stdby LoRa mode to write in FIFO
-        
-    }    
-    else if (mode == PONG )  {   
-       // uint8_t message_pong[]="Pong";
-        //strcpy( message, "Pong");
-
-        sx1272.sendPacketTimeout(DEFAULT_DEST_ADDR, message_pong, sizeof(message_pong));
-        printf("packet send :\n%s\n",message_pong);
-        
-    }
     
-    cont++;
-    led1=0;    
-    sx1272.writeRegister(0x01,133); //leitura continua
-    printf("number=%d\n",cont);
-}
-
-
-void print_packet(){
-
-   led2=1;
-   sx1272.writeRegister(0x01,129);//standby    
-
-    uint8_t pac_size;
-
-    sx1272.writeRegister(0x0D,sx1272.readRegister(0x10));//set fifo pointer to read packet
-    pac_size = sx1272.readRegister(0x13);//read size of packet
-    for(int i =0 ; i<pac_size ; i++){ //print packet
-        buffer[i]=sx1272.readRegister(REG_FIFO);
-        printf("%c",buffer[i]);//print packet
-    }
-    printf("\n");
-
-    for(int i =0 ; i<pac_size ; i++){ //look for Ping in packet
-        if ((buffer[i] =='P') && (buffer[i+1] =='i') ){
-                wait(1);
-                sx1272.writeRegister(0x12,255);//clean flags
-                send_packet(PONG);
-                i=pac_size;
-        }
-    } 
-    
-    for(int i =0 ; i<pac_size ; i++){ //look for Ping in packet
-        if ((buffer[i] =='R') && (buffer[i+1] =='e') && (buffer[i+2] =='s') && (buffer[i+3] =='e')  ){
-             NVIC_SystemReset();
-        }
-    }
-    
-    wait_ms(300);
-    sx1272.writeRegister(0x12,255);//clean flags
-    
-    led2=0; 
-
-}
-
-
-int main(void) {     
-    led1=1;//on leds
+    led1=1;//----on leds---
     led2=1;
 
+    //____Configuration bme280
+    bme_init();
+    
+    //____Configuration Lora    
     Thread eventThread;
     eventThread.start(callback(&queue, &EventQueue::dispatch_forever));
  
-    dio0.rise(queue.event(&print_packet)); //configura rotina de interrupçao para quando receber pacote
-    seconds.start();
-
-    bme_init();//configura sensor bme280
+    dio0.rise(queue.event(&print_packet)); //configure interrupt rotine ro recieve packet
     setup(); //configura sx1272
-    
+       
     //TESTE_COMUNICAÇAO LABRADOR
     //sx1272.writeRegister(0x0B,0x3B);
     //sx1272.writeRegister(0x18,0x10);
     //sx1272.writeRegister(0x33,0x26);
-    //sx1272.writeRegister(0x1D,0x08);
-    //sx1272.writeRegister(0x1E,0xC4); 
-    
-    
+//    sx1272.writeRegister(REG_MODEM_CONFIG1,0x0D);
+//    sx1272.writeRegister(REG_MODEM_CONFIG2,0xC4); 
+        
     sx1272.writeRegister(REG_OP_MODE,133); //leitura continua
-    sx1272.writeRegister(0x11,187);//configure interrupt mask to interrupt only when a packet receive and packet envied 
-    
-    led1=0;//off leds
+    sx1272.writeRegister(REG_IRQ_FLAGS_MASK,187);//configure interrupt mask to interrupt only when a packet receive and packet envied 
+  
+    led1=0;//----off leds--- 
     led2=0;
     
-//    for (int i=2 ; i<255;i++){
-//        int value = sx1272.readRegister(i);
-//        if (value !=0 )
-//            printf("reg 0x%02x= 0x%02x\n",i,value);
-//    }
-    
-    //long int time_start = seconds.read();
-    //printf ("timestart=%d  leitura = %d\n",time_start,seconds.read());
-    while(1){
 
-         if (button3 != beathing) {
-            beathing = !beathing;
-            if(button3){
-                send_packet(DATA);
-                
-                time_breathing.reset();
-                time_breathing.start();
-                
-                time_diving.stop();
-                last_diving_time = time_diving.read();
-            }else{
-                time_diving.reset();
-                time_diving.start();
-                
-                time_breathing.stop();
-                last_breathing_time = time_breathing.read();
+    
+    
+    ///////////////////////////////////////
+    //LOOP
+    ///////////////////////////////////////
+    
+    while(1){
+        
+        if (!button1){
+            led2=1;
+            send_data(PING);
+            led2=0;
+            }
+        
+//         if (button3 != beathing) {
+//                beathing = !beathing;
+//                if(button3){
+//                    send_packet(DATA);
+//                
+//                    time_breathing.reset();
+//                    time_breathing.start();
+//                    
+//                    time_diving.stop();
+//                    last_diving_time = time_diving.read();
+//                }
+//                else{
+//                    time_diving.reset();
+//                    time_diving.start();
+//                    
+//                    time_breathing.stop();
+//                    last_breathing_time = time_breathing.read();
+//
+//                }
+//                
+//        }
+//            if (button3){
+// //               send_data(DATA);
+////                send_packet(big_message,sizeof(big_message));
+////                send_packet(reset_message,sizeof(reset_message));
+////                wait_ms(400);
+        
 
-            }
-                
-        }
-        
+         
         wait_ms(50);
     }