Lattice Planner EM-planner based on python Dynamic programming for back-trace Cubic spline for generating slide trajectory lattice state for limiting searching area