Added some more functions to the CC interface.
Fixed the occupancy grid. Other small changes too.