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