RRT-CBF Based Motion Planning