Contact and dive in Optimisation Eric Bernier