Method EvaluateFitness

src/RaceNet/TrainingGround.cpp:46–66

Move this to agent class?

// Move this to agent class?
float TrainingGround::EvaluateFitness(shared_ptr<Car> &car_agent) {
    uint32_t nVroad = boost::get<shared_ptr<NFS3_4_DATA::TRACK>>(training_track->trackData)->col.vroadHead.nrec;

    int closestVroadID = 0;
    float lowestDistanceSqr = FLT_MAX;
    for (uint32_t vroad_Idx = 0; vroad_Idx < nVroad; ++vroad_Idx) {
        INTPT refPt = boost::get<shared_ptr<NFS3_4_DATA::TRACK>>(training_track->trackData)->col.vroad[vroad_Idx].refPt;
        glm::vec3 vroadPoint = glm::normalize(glm::quat(glm::vec3(-SIMD_PI / 2, 0, 0))) *
                               glm::vec3((refPt.x / 65536.0f) / 10.f, ((refPt.y / 65536.0f) / 10.f),
                                         (refPt.z / 65536.0f) / 10.f);

        float distanceSqr = glm::length2(glm::distance(car_agent->car_body_model.position, vroadPoint));
        if (distanceSqr < lowestDistanceSqr) {
            closestVroadID = vroad_Idx;
            lowestDistanceSqr = distanceSqr;
        }
    }

    // Return a number corresponding to the distance driven
    return (float) closestVroadID;
}

void TrainingGround::InitialiseAgents(uint16_t populationSize) {
    // Create new cars from models loaded in training_car to avoid VIV extract again, each with new RaceNetworks