From bd353db8ab4e25219006757b05f2dce5b09b8cc2 Mon Sep 17 00:00:00 2001
From: JIMWAR <1107971742@qq.com>
Date: Mon, 2 Jul 2018 10:37:43 +0800
Subject: [PATCH] AC_Avoid:  fix adjust_velocity_polygon

adjust_velocity_polygon function ignoring boundary[0]
---
 libraries/AC_Avoidance/AC_Avoid.cpp | 2 +-
 1 file changed, 1 insertion(+), 1 deletion(-)

diff --git a/libraries/AC_Avoidance/AC_Avoid.cpp b/libraries/AC_Avoidance/AC_Avoid.cpp
index ef781d8f75..e97412bebf 100644
--- a/libraries/AC_Avoidance/AC_Avoid.cpp
+++ b/libraries/AC_Avoidance/AC_Avoid.cpp
@@ -438,7 +438,7 @@ void AC_Avoid::adjust_velocity_polygon(float kP, float accel_cmss, Vector2f &des
     Vector2f stopping_point = position_xy + safe_vel*((2.0f + get_stopping_distance(kP, accel_cmss, speed))/speed);
 
     uint16_t i, j;
-    for (i = 1, j = num_points-1; i < num_points; j = i++) {
+    for (i = 0, j = num_points-1; i < num_points; j = i++) {
         // end points of current edge
         Vector2f start = boundary[j];
         Vector2f end = boundary[i];