group/Plane.FormationCreator
1
0
Fork 0
Code Issues 3 Pull Requests Actions Packages Projects Releases Wiki Activity

返回点不再飞往航点位置，飞往起飞坐标

Browse Source
This commit is contained in:
zxd 2019-07-16 18:38:55 +08:00
parent bb911aa840
commit 148ecb410d
1 changed files with 16 additions and 8 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

12
Plane.FormationCreator/Formation/FlightTask_FlyTo.cs
View File

@ -153,8 +153,16 @@ namespace Plane.FormationCreator.Formation
await Task.Delay(10).ConfigureAwait(false); await Task.Delay(10).ConfigureAwait(false);
} }
*/ */
double targetLat = info.TargetLat;
double targetLng = info.TargetLng;
if (info.IsLandWaypoint)
{
targetLat = info.Copter.TakeOffPoint.Latitude;
targetLng = info.Copter.TakeOffPoint.Longitude;
}
//发送目标航点1次 //发送目标航点1次
await info.Copter.FlyToAsync(info.TargetLat, info.TargetLng, info.TargetAlt);
await info.Copter.FlyToAsync(targetLat, targetLng, info.TargetAlt);
await Task.Delay(10).ConfigureAwait(false); await Task.Delay(10).ConfigureAwait(false);
dtNow = DateTime.Now; dtNow = DateTime.Now;
@ -231,7 +239,7 @@ namespace Plane.FormationCreator.Formation
sendFlyToTimes++; sendFlyToTimes++;
for (int i = 0; i < 2; i++) for (int i = 0; i < 2; i++)
{ {
await info.Copter.FlyToAsync(info.TargetLat, info.TargetLng, info.TargetAlt); await info.Copter.FlyToAsync(targetLat, targetLng, info.TargetAlt);
await Task.Delay(10).ConfigureAwait(false); await Task.Delay(10).ConfigureAwait(false);
} }