planning_scene_monitor: fix state update bug

The rate of state updates is limited to dt_state_update_ per second.
When an update arrived it was not processed if another was recently
processed.  This meant that if a quick sequence of state updates
arrived and then no updates arrive for a while that the last update(s)
were not seen until another arrives (which may be much later or
never). This fixes the bug by periodically checking for pending
updates and running them if they have been pending longer than
dt_state_update_.
planning_scene_monitor: fix race condition
planning_scene_monitor: add requestPlanningSceneState()
planning_scene_display: use requestPlanningSceneState()

Get current planning scene state when planning scene display is
enabled and/or model is loaded.
remove debug printfs
Merge pull request #409 from ros-planning/fix_rviz_initial_scene_state

Fix planning scene display initial state