UT: added method to test float values

MC pos control tests: added tests to all configs that include them
This commit is contained in:
Andreas Antener
2016-10-10 23:05:44 +02:00
committed by Lorenz Meier
parent 9a219da9c2
commit f3b5c243e5
6 changed files with 59 additions and 30 deletions
@@ -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 */