坐标

fctom1215

2020-08-28 bf8e1f4ef4961b32dfa73a0b898f82c20721bf09

 lib/src/main/cpp/test_items2/through_something.cpp

@@ -14,7 +14,7 @@
#include "road_exam.h"
#include "../utils/xconvert.h"

#define DEBUG(fmt, args...)     LOGD("<through_something> <%s>: " fmt, __func__, ##args)
#define DEBUG(fmt, args...)     LOGD("<road_exam through_something> <%s>: " fmt, __func__, ##args)

using namespace std;

@@ -91,11 +91,13 @@
            }
            // 记录刹车
            if (dobreak && !(rec & REDUCE_SPEED)) {
                DEBUG("检测到路口刹车动作");
                SetTargetReduceRec(TargetReduceRec, key, rec | REDUCE_SPEED);
            }
        } else if (distance > 1e-3 && distance < DISTANCE_STOP_CAR_TO_STOP_LINE) {
            // 路口停车观察
            if (moveDirect == 0 && !(rec & STOP_CAR)) {
                DEBUG("检测到路口停车动作");
                SetTargetReduceRec(TargetReduceRec, key, rec | STOP_CAR);
            }
        } else if (distance > LASTEST_BREAK_POINT + 5 && rec != NOT_ENTER) {
@@ -126,6 +128,7 @@
                }
                // 记录刹车，停车
                if (dobreak && !(rec & REDUCE_SPEED)) {
                    DEBUG("检测到人行道等刹车动作");
                    SetTargetReduceRec(TargetReduceRec2, key, rec | REDUCE_SPEED);
                }
            } else if (distance1 > LASTEST_BREAK_POINT + 5 && rec != NOT_ENTER) {