Add planner super class
Set as "public" only the "plan" method
Set some methods to "private"
New Tests
Up to parent PathPlanner class some common methods
Full Planning 3D
- A*
- RRT