Fix joint state static filter

Fix JointStateStaticFilter to use absolute difference when calculating nearest timestamp of divergence of joint states.
And add JointStateStaticFilter to organized_multi_plane_segmentation.launch if JOINT_STATIC_FILTER:=true