disenone / aoitesting Goto Github PK

void CrossAoi::AddSensor(Nuid nuid, Nuid sensor_id, float radius) {
            // 找到距离最近的 beacon
           // min_dist 为两点距离的平方值
            auto &best_sensor = best_beacon->sensors[0];
            float dr = best_sensor.radius - radius;
            if (dr * dr + min_dist > radius) {
                return AddSensorNoBeacon(nuid, sensor_id, radius);
            }