diff --git a/libraries/SITL/SIM_Aircraft.cpp b/libraries/SITL/SIM_Aircraft.cpp index 4b7f832b4d..e9ab93c73e 100644 --- a/libraries/SITL/SIM_Aircraft.cpp +++ b/libraries/SITL/SIM_Aircraft.cpp @@ -831,11 +831,17 @@ float Aircraft::get_local_updraft(Vector3f currentPos) break; } + // Wind drift at this altitude + float driftX = sitl->wind_speed * currentPos.z * cosf(sitl->wind_direction * DEG_TO_RAD); + float driftY = sitl->wind_speed * currentPos.z * sinf(sitl->wind_direction * DEG_TO_RAD); + int iThermal; float w = 0.0f; float r2; for (iThermal=0;iThermal