Motion control of mobile robots with Particle Filter Model Predictive Equilibrium Point Control