In the last few years, autonomous driving has become a major topic in both car industry and academia. Many challenging problems remain to be solved, however, in order for autonomous cars to be on the market. In this thesis, ...