Related recent research that handles decoy waypoints [1][2]. They use imitation learning for path planning directly from sensor data, instead of just using machine learning for perception, tracking, prediction and doing MPC/LQR for the planner. This allows inferring weird paths, perhaps, like "run into this narrow pit stop" :)
[1] https://arxiv.org/abs/1810.06544
[2] https://sites.google.com/view/imitativeforecastingcontrol