3D simulation by TFmini lidar

[glv]

The original poster formatted code and continued here:

3D room map by TFmini Lidar

Hi, I’m a beginner so I hope this time I worte as should. I’m trying to simulate room with TFmini lidar by using arduino Mega with serial port communication. The simulation is not good at all. I need help. My Arduino code: #include <Servo.h> #include <arduino.h><br>#include "TeensyThreads.h" Servo yaw, pitch; volatile int liDARval; char s[15]; double x, y, z; float theta, phi; #define MATH_PI 3.1415f #define msec 10 unsigned int pitchPos, yawPos; unsigned int flag; unsigned long yawCurrentT…

Please continue there…