+
+// Finally, add two more waypoints, so that aircraft will remain under
+ // Tower control until they have reached the 3000 ft climb point
+
+
+ geo_direct_wgs_84 ( 0, rwy._lat, rwy._lon, heading,
+ 5000,
+ &lat2, &lon2, &az2 );
+
+
+ wpt = new waypoint;
+ wpt->name = "5000 ft";
+ wpt->latitude = lat2;
+ wpt->longitude = lon2;
+ wpt->altitude = apt->getElevation()+5000;
+ wpt->speed = speed;
+ wpt->crossat = -10000;
+ wpt->gear_down = true;
+ wpt->flaps_down= true;
+ wpt->finished = false;
+ wpt->on_ground = false;
+ wpt->routeIndex = 0;
+ waypoints.push_back(wpt);
+
+ // geo_direct_wgs_84 ( 0, rwy._lat, rwy._lon, heading,
+// 100000,
+// &lat2, &lon2, &az2 );
+// wpt = new waypoint;
+// wpt->name = "5100 ft";
+// wpt->latitude = lat2;
+// wpt->longitude = lon2;
+// wpt->altitude = apt->getElevation()+5100;
+// wpt->speed = speed;
+// wpt->crossat = -10000;
+// wpt->gear_down = true;
+// wpt->flaps_down= true;
+// wpt->finished = false;
+// wpt->on_ground = false;
+// wpt->routeIndex = 0;
+// waypoints.push_back(wpt);