Added basic AI planner

Only looks for a single path, no preferences. Babysteps