Delete the old code that was solving motion planning problems to do conflict resolution instead of just doing path tracking

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