fix variable name in debug mode
pack planes and send them as markers to rviz
add according dependencies to Cmakelists and package.cml
Merge pull request #13 from mlosch/master

Pack planes and send them as markers to rviz