Good luck! I know how hard a problem this is, as I was part of the team that worked on the driverless taxis now operating at Heathrow airport[1] (and which have safely carried over a million people since launch).
You might also find the company's library of research papers a useful reference [2].
Looking forward to seeing your progress!