Added error handling in FGWaypoint in case a supplied or calculated latitude exceeds 90 degrees prior (JSBSim-Team#536)

Co-authored-by: Sean McLeod <sean@seanmcleod.com>

Author: 2 people

src/models/flight_control/FGWaypoint.cpp

@@ -182,19 +182,37 @@ bool FGWaypoint::Run(void )
   double target_longitude_rad = target_longitude->GetValue() * target_longitude_unit;
   source.SetPosition(source_longitude_rad, source_latitude_rad, radius);
 
+  if (fabs(target_latitude_rad) > M_PI/2.0) {
+    cerr << endl;
+    cerr << "Target latitude in waypoint \"" << Name << "\" must be less than or equal to 90 degrees." << endl;
+    cerr << "(is longitude being mistakenly supplied?)" << endl;
+    cerr << endl;
+    throw("Waypoint target latitude exceeded 90 degrees.");
+  }
+
+  if (fabs(source_latitude_rad) > M_PI/2.0) {
+    cerr << endl;
+    cerr << "Source latitude in waypoint \"" << Name << "\" must be less than or equal to 90 degrees." << endl;
+    cerr << "(is longitude being mistakenly supplied?)" << endl;
+    cerr << endl;
+    throw("Source latitude exceeded 90 degrees.");
+  }
+
   if (WaypointType == eHeading) {     // Calculate Heading
+
     double heading_to_waypoint_rad = source.GetHeadingTo(target_longitude_rad,
                                                          target_latitude_rad);
 
     if (eUnit == eDeg) Output = heading_to_waypoint_rad * radtodeg;
     else               Output = heading_to_waypoint_rad;
 
   } else {                            // Calculate Distance
+
     double wp_distance = source.GetDistanceTo(target_longitude_rad,
                                               target_latitude_rad);
-
     if (eUnit == eMeters) Output = FeetToMeters(wp_distance);
     else                  Output = wp_distance;
+
   }
 
   Clip();