Servo shaking when LIDAR added

One issue is that software serial does not work at 115200 which is the TFMini's xmission rate. Software serial works up to 38400. You can see if that will work.