Initial pathfinding API

Signed-off-by: fullwall <fullwall25@gmail.com>
Merge pull request #485 from fullwall/master

Implement basic pathfinding API