Safety Planning Using Control Barrier Function: A Model Predictive Control Scheme | IEEE Conference Publication | IEEE Xplore