Normal direction filter based on IMU

Normal direction filter based on Imu (or static value):

Red points are filtered pointcloud which have the same direction to imu = ground and table.
![normal_direction_filter](https://cloud.githubusercontent.com/assets/40454/4914412/1323fea4-64c2-11e4-9133-febf309b6b76.png)