Implement LIDAR in the code

[vhfmaia]

At first, just Use LIDAR for anything in the code for later usage at object colision avoidance