Support ~keep_organized parameter to fill filtered point with NaN
support ~use_rgb parameter to filter points with RGB color
Merge pull request #12 from garaemon/support-rgb

[pr2_navigation_self_filter] Support filtering PointXYZRGB