statical voting and rejection to the grid map to remove unstable recognition result

remove unstable recognition result based on simple voting strategy

![screenshot_from_2014-07-03 11 59 55](https://cloud.githubusercontent.com/assets/40454/3465180/76580076-025f-11e4-84bb-199a92fe87c4.png)