TEMPO15_project NMPC simulation of environment-aware swingup. Nominal parameters for the floor: K = 5000Nm D = 500Nm/s