QP Receding Horizon Path Planning Problem

Question

I am working on the following QP Receding Horizon Path Planning Problem:

Problem statement

At each time step, a point (simulating a robot) computes its Voron