From 4513546845f350a6d0bb3a95524850687dc1a1b9 Mon Sep 17 00:00:00 2001
From: xianglunkai <1322099375@qq.com>
Date: Mon, 28 Mar 2022 22:43:46 +0800
Subject: [PATCH] vector3:return w1 not zero vector

---
 libraries/AP_Math/vector3.cpp | 2 +-
 1 file changed, 1 insertion(+), 1 deletion(-)

diff --git a/libraries/AP_Math/vector3.cpp b/libraries/AP_Math/vector3.cpp
index e13ab69a27..2bbf57790b 100644
--- a/libraries/AP_Math/vector3.cpp
+++ b/libraries/AP_Math/vector3.cpp
@@ -509,7 +509,7 @@ Vector3<T> Vector3<T>::point_on_line_closest_to_other_point(const Vector3<T> &w1
     const T line_vec_len = line_vec.length();
     // protection against divide by zero
     if(::is_zero(line_vec_len)) {
-        return {0.0f, 0.0f, 0.0f};
+        return w1;
     }
 
     const T scale = 1/line_vec_len;