feat(intersection): check path margin for overshoot vehicles on red light (#5394)

feat(intersection): check path margin for overshoot vehicles on red light (#5394) #2156