planning_scene_monitor: fix scope of local vars
planning_scene_monitor: slight code simplification
fix bug in computeCartesianPathPython