|
|
|
@ -160,13 +160,13 @@ static void update_loiter()
@@ -160,13 +160,13 @@ static void update_loiter()
|
|
|
|
|
|
|
|
|
|
} |
|
|
|
|
/* |
|
|
|
|
if (wp_distance < g.loiter_radius){ |
|
|
|
|
nav_bearing += 9000; |
|
|
|
|
}else{ |
|
|
|
|
nav_bearing -= 100 * M_PI / 180 * asin(g.loiter_radius / wp_distance); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
update_crosstrack(); |
|
|
|
|
* if (wp_distance < g.loiter_radius){ |
|
|
|
|
* nav_bearing += 9000; |
|
|
|
|
* }else{ |
|
|
|
|
* nav_bearing -= 100 * M_PI / 180 * asin(g.loiter_radius / wp_distance); |
|
|
|
|
* } |
|
|
|
|
* |
|
|
|
|
* update_crosstrack(); |
|
|
|
|
*/ |
|
|
|
|
nav_bearing_cd = wrap_360_cd(nav_bearing_cd); |
|
|
|
|
} |
|
|
|
|