Embedded Hierarchical MPC for Autonomous Navigation