Always estimate grid in EnvironmentPlaneModeling

Always estimate grid in EnvironmentPlaneModeling.

Pink points are the visualization of OccupancyGrid generated by EnvironmentPlaneModeling.
![hoge](https://cloud.githubusercontent.com/assets/40454/3440752/5db4244c-00fb-11e4-9a15-3f7aa029faaa.png)