[StatesPathFinder] Refactor

  - Use parent implementation for method solve,
  - reimplement tryToConnectInitAndGoals,
  - remove InStatePath class and call core::DiffusingPlanner instead.
  - optimize paths on sub-manifolds with random shortcut and insert path
    in roadmap.