Moved stuff around. Added equalsExact method to Entity. Planner now works for the given example cases.