- better handle the dense cloud and its ringbuffer
- more verbose log output for pathplanning
- less waypoint traffic (needs testing)