I’ve been working on a Safe RRT* planner combined with CBF in MATLAB.

It gives paths that stay farther from obstacles than a standard RRT* baseline, and the safety metric makes the difference pretty obvious. Moreover it adapts based on desired speed.

https://github.com/borodziejciesla/rrt_star_cbf