Improved MPC expandedpath