Integrate Basic Pathfinding Algorithms for navigation

[erematorg]

Enable entities to navigate the environment efficiently.

• Implement basic pathfinding algorithms such as A* or Dijkstra’s to find optimal paths.
• Ensure entities can avoid obstacles and reach their goals effectively.