Instead of using waypoint navigation to a solvepnp gate pose calculation, use visual servoing on the 2 gate poles (with style)