Step planning

Warning

The step planning is currently under development and will be redesigned by Narcha.

At the time of writing, only individual steps are planned, but not the whole step sequence, which could lead to various improvements, such as an increase in speed when planning around obstacles.