loiter: set loiter position to current position setpoint, if it is a loiter item

This commit is contained in:
Konrad
2023-11-13 12:43:58 +01:00
committed by Thomas Stastny
parent 6800a448b0
commit 32127ca789
2 changed files with 17 additions and 2 deletions
+2 -1
View File
@@ -747,7 +747,8 @@ MissionBlock::setLoiterItemFromCurrentPositionSetpoint(struct mission_item_s *it
item->lat = pos_sp_triplet->current.lat;
item->lon = pos_sp_triplet->current.lon;
item->altitude = pos_sp_triplet->current.alt;
item->loiter_radius = pos_sp_triplet->current.loiter_radius;
item->loiter_radius = pos_sp_triplet->current.loiter_direction_counter_clockwise ?
-pos_sp_triplet->current.loiter_radius : pos_sp_triplet->current.loiter_radius;
}
void