Program to read LIDAR values using I2C and send UART messages using UART 2 & UART 3

Dependencies:   mbed LidarLitev2

main.cpp

Committer:
rajas1812
Date:
2019-03-28
Revision:
1:89b49ebbe3db
Parent:
0:ee825cd264b6

File content as of revision 1:89b49ebbe3db:

#include "LidarLitev2.h"


LidarLitev2 Lidar(PTE25, PTE24);
Serial pc(USBTX,USBRX);             //UART0
Serial device(PTC17, PTC16);           //UART3
Serial kw41z(PTD3, PTD2);                     //UART2

int counter = 0;

Timer dt;

int main()
{   
    
    pc.baud(115200);
    device.baud(115200);
    kw41z.baud(115200);
    Lidar.configure();
    dt.start();

    while(1){
         pc.printf( "distance =%d cm\t",Lidar.distance());
       //device.printf( "%d" ,Lidar.distance());
         //int temp=Lidar.distance();
         wait_ms(500);
          //pc.printf("%d\n",temp);
         
         dt.reset();
         if(Lidar.distance()>1 and Lidar.distance()<=15)
         {
         device.printf("1"); 
         //kw41z.printf("coap CON POST fd18:16b7:2982:2c23:d07c:a5c0:a751:5e10 /led rgb r255 g0 b0\n");
         pc.printf("case: 1\r\n"); 
         if (counter == 0){
         kw41z.printf("coap CON POST fd18:16b7:2982:2c23:d07c:a5c0:a751:5e10 /led rgb r255 g0 b0\n"); 
        counter = 1;
           }    
        }
        
        else if(Lidar.distance()>15 and Lidar.distance()<=60)
        {
         device.printf("2"); 
         pc.printf("case: 2\r\n");
         if (counter == 0){
         kw41z.printf("coap CON POST fd18:16b7:2982:2c23:d07c:a5c0:a751:5e10 /led rgb r255 g0 b0\n"); 
        counter = 1;
           }  
         }
                 else if(Lidar.distance()>60 and Lidar.distance()<=120)
        {
         device.printf("3");  
         //kw41z.printf("coap CON POST fd18:16b7:2982:2c23:d07c:a5c0:a751:5e10 /led rgb r0 g255 b0\n");
           pc.printf("case: 3\r\n"); 
           if (counter == 1) {
               kw41z.printf("coap CON POST fd18:16b7:2982:2c23:d07c:a5c0:a751:5e10 /led rgb r0 g255 b0\n");
               counter = 0;
               }
         }
                 else if(Lidar.distance()>120 and Lidar.distance()<=180)
        {
         device.printf("4");
         //kw41z.printf("coap CON POST fd18:16b7:2982:2c23:d07c:a5c0:a751:5e10 /led rgb r0 g255 b0\n"); 
           pc.printf("case: 4\r\n");  
            if (counter == 1) {
               kw41z.printf("coap CON POST fd18:16b7:2982:2c23:d07c:a5c0:a751:5e10 /led rgb r0 g255 b0\n");
               counter = 0;
               } 
         }
                 else if(Lidar.distance()>180)
        {
         device.printf("5");
         //kw41z.printf("coap CON POST fd18:16b7:2982:2c23:d07c:a5c0:a751:5e10 /led rgb r0 g255 b0\n");
           pc.printf("case: 5\r\n"); 
            if (counter == 1) {
               kw41z.printf("coap CON POST fd18:16b7:2982:2c23:d07c:a5c0:a751:5e10 /led rgb r0 g255 b0\n");
               counter = 0;
               }   
         }
         else
         {
             device.printf("0");
             //kw41z.printf("coap CON POST fd18:16b7:2982:2c23:d07c:a5c0:a751:5e10 /led rgb r0 g255 b0\n");
               pc.printf("case: 0\r\n"); 
                if (counter == 0) {
               kw41z.printf("coap CON POST fd18:16b7:2982:2c23:d07c:a5c0:a751:5e10 /led rgb r255 g0 b0\n");
               counter = 1;
               } 
             }
         
}
}