mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-22 05:33:34 +08:00
UT: added method to test float values
MC pos control tests: added tests to all configs that include them
This commit is contained in:
committed by
Lorenz Meier
parent
9a219da9c2
commit
f3b5c243e5
@@ -976,9 +976,7 @@ MulticopterPositionControl::cross_sphere_line(const math::Vector<3> &sphere_c, f
|
||||
|
||||
if ((sphere_c - line_b) * ab_norm > 0.0f) {
|
||||
/* target waypoint is already behind us */
|
||||
math::Vector<3> ba_norm = line_a - line_b;
|
||||
ba_norm.normalize();
|
||||
res = d + ba_norm * dx_len; // vector B->A on line
|
||||
res = line_b;
|
||||
|
||||
} else {
|
||||
/* target is in front of us */
|
||||
|
||||
Reference in New Issue
Block a user