Added OcupancyGrid.cs
Initial commit of OccupancyGrid.cs