Environmental plane modeling

* add new nodelet to model the environment based on plane representation