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; } } } }