An MPC Framework For Planning Safe & Trustworthy Robot Motions | IEEE Conference Publication | IEEE Xplore