Main part is in c++ now, missing starting vehicles from lane etc.