added working pathfinding and a test project for it...

Signed-off-by: Daniel Dahlkvist <messer_@hotmail.com>
Added pathfinding to project

Signed-off-by: Daniel Dahlkvist <messer_@hotmail.com>
missed file

Signed-off-by: Daniel Dahlkvist <messer_@hotmail.com>