Agreed. Raquel Urtasan's research is the cutting edge in this area: https://www.cs.toronto.edu/~urtasun/. And she was recently hired/retained by Uber to lead their robot car efforts in Canada. Here's a recent video of her research from the National Academy of Sciences: https://www.youtube.com/watch?v=sW4M7-xcseI