Added code from other repo to find and resolve discrete subproblems. Added place grid and get starts and goals to traj opt db resolver