for demo check planner_demo.py it is work withous ROS2 infra Also have integration test with visualization in rviz2