Contact optimization for non-prehensile loco-manipulation via hierarchical model predictive control May 29, 2023