计算当前车辆与前车的距离

Question

我需要计算当前车辆和前面车辆之间的距离，对于流中的每辆车，在边缘上运行。

在通过 TraCI 时，我遇到了 getLeader 方法，该方法应该返回领导者的 ID 和我需要的距离。

但我找不到使用此名称的已实现方法，或 Overview Extended Variables Retrieval 下列出的任何其他方法，该方法用 TraCI 中的 C++ 编写。

如果有人可以帮助我，我真的很感激。

---

按照here 的建议，我成功地实现了getLastStepVehicleIDs 从感应循环中检索值。我遵循了已经实现的相同类型的方法（例如getJunctionIds），但是在这种情况下找不到这样的已经实现的方法。

Answer 1

TraCICommandInterface.cc 中有很多函数可以借鉴。如果不进行测试，实现可能看起来像这样

std::pair<std:string, double> TraCICommandInterface::getLeader(const double lookahead) {
    TraCIBuffer request;
    request << static_cast<uint8_t>(VAR_LEADER) << nodeId
                    << static_cast<uint8_t>(TYPE_DOUBLE) << lookahead;
    TraCIBuffer response = connection.query(CMD_GET_VEHICLE_VARIABLE, request);

    uint8_t cmdLength; response >> cmdLength;
    if (cmdLength == 0) {
            uint32_t cmdLengthX;
            response >> cmdLengthX;
    }
    uint8_t responseId; response >> responseId;
    ASSERT(responseId == RESPONSE_GET_VEHICLE_VARIABLE);
    uint8_t variable; response >> variable;
    ASSERT(variable == VAR_LEADER);
    std::string id; response >> id;
    uint8_t typeId_r; response >> typeId_r; ASSERT(typeId_r == TYPE_COMPOUND);
    uint32_t compoundLength; response >> compoundLength; ASSERT(compoundLength == 2);
    uint8_t typeId_resp; response >> typeId_resp; ASSERT(typeId_resp == TYPE_STRING);
    std::string leader; response >> leader;
    uint8_t typeId_resp2; response >> typeId_resp2; ASSERT(typeId_resp2 == TYPE_DOUBLE);
    double dist; response >> dist;

    return std::make_pair(leader, dist);
}