Addition of updateCCReachability function to adapt the roadmap to state space planning