Made the photogrammetry module work with the simulator sim.

Fix PolygonSurvey comparing height vs alt

The PolygonSurvey function was waiting in Entry mode, for the height of the plane to be close to the point altitude.

Fix the poly_survey_adv waiting in Entry mode

The poly_survey_adv function was waiting for the plain height to be close to the waypoint's altitude.

The PhotogrammetryCalculatorPolygonSurvey function was not calculating well the angles.

There might be a confusion between rad and degree. That fixe doesn't correct that, but with it the function works.

The call to init_poly_survey_adv in PhotogrammetryCalculatorPolygonSurveyADV needs a angle in degree.

The init_poly_survey_adv might be asking for an angle in rad, be it uses it later as an angle in degree. So we send it in degree.