Preprocess nodes with arm configurations, c-space and planning by connecting nodes