Safe trajectory optimization for whole-body motion of humanoids | IEEE Conference Publication | IEEE Xplore