How to generate a safe and high-quality path for a moving robot is a classical issue. The relative solution is also suitable for computer games and animation. To make the problem simpler. it is common to discretize the continuous planning space into grids. https://www.uvmebrl.com/product-category/default/