added occupancygrid.cpp. but it's still not working. Kein lust weiter zu
machen........