Integration of iGPMP2 and iSDF for Manipultor Motion Planning in a Partially-Unknown Semi-Dynamic Environment