+ if ((lead_distance > (3*turn_radius)) && (current->on_ground == false)) {
+ // cerr << "Warning: Lead-in distance is large. Inbound = " << inbound
+ // << ". Outbound = " << outbound << ". Lead in angle = " << leadInAngle << ". Turn radius = " << turn_radius << endl;
+ lead_distance = 3 * turn_radius;
+ return;
+ }
+ if ((leadInAngle > 90) && (current->on_ground == true)) {
+ lead_distance = turn_radius * tan((90 * SG_DEGREES_TO_RADIANS)/2);
+ return;
+ }