NMPC test environment, moving from bottom left to the goal at top right. The circle indicates the size of the TVQuad.