vehicle.cpp

//
// Created by cyx02 on 2022/6/27.
//

#include "vehicle.h"
#include "math.h"
#include <cstdio>
#include <stddef.h>
#include <iostream>

using namespace  std;
double distance_between_vehicle(const struct vehicle* aCar, const struct vehicle* bCar){
    return sqrt((aCar->x - bCar->x)*(aCar->x - bCar->x) + (aCar->y - bCar->y)*(aCar->y - bCar->y));
}


void printVehilces(struct Duallist *ALL_Vehicles){
    struct Item *aItem;
    struct vehicle* aCar;

    aItem =ALL_Vehicles-> head;
    while(aItem != NULL){
        aCar = (struct vehicle*)aItem->datap;
        cout<<"handled="<<aCar->handled<<" ,id="<<aCar->id<<" ,x="<<aCar->x <<" ,y="<<aCar->y <<" ,CommRange="<<aCar->commRadius <<" ,slot_occupied="<< aCar->slot_occupied <<" ,slot_condition="<<aCar->slot_condition<<" ,pos="<<aCar->pos<<", speed="<<aCar->speed<<", decel="<<aCar->acc<<", resource_pool="<<aCar->resource_pool<<", angle="<<aCar->angle<<endl;

        aItem = aItem->next;

       // (aCar->queue_Vehicles)[aCar]++;
        //(aCar->queue_Vehicles).clear();
    }
}

void logVehilcesInfo(struct Duallist *ALL_Vehicles, ofstream & logfile){
    struct Item *aItem;
    struct vehicle* aCar;

    aItem =ALL_Vehicles-> head;
    while(aItem != NULL){
        aCar = (struct vehicle*)aItem->datap;
        logfile<<"handled="<<aCar->handled<<" ,id="<<aCar->id<<", lane="<<aCar->lane<<" ,x="<<aCar->x <<" ,y="<<aCar->y <<" ,CommRange="<<aCar->commRadius <<" ,slot_occupied="<< aCar->slot_occupied <<" ,slot_condition="<<aCar->slot_condition<<" ,pos="<<aCar->pos<<", speed="<<aCar->speed<<", decel="<<aCar->acc<<", slot_resource="<<aCar->resource_pool<<", angle="<<aCar->angle<<", Role_condition="<<aCar->role_condition<<", slot_appeared="<<aCar->slot_appeared<<endl;

        aItem = aItem->next;

        // (aCar->queue_Vehicles)[aCar]++;
        //(aCar->queue_Vehicles).clear();
    }
}

void logACar(struct vehicle* aCar){
    log_process_file << "id=" <<aCar->id<<", x="<<aCar->x<<", y="<<aCar->y<<", CommR="<<aCar->commRadius<<", Slot_Occupied="<<aCar->slot_occupied<<", Role_condition="<<aCar->role_condition<<", slot_appeared:"<<aCar->slot_appeared<<endl;
    log_process_file << "   counter_tx="<<aCar->counter_tx<<", counter_rx_TxCollision="<<aCar->counter_rx_TxCollision<<", counter_rx_RxCollision="<<aCar->counter_rx_RxCollision<<", counter_rx_normal="<<aCar->counter_rx_normal<<endl;

    log_process_file <<"   OHN:"<<endl;
    for(int i = 0; i <SlotPerFrame; i++)
        if(aCar->OHN[i] != nullptr)
            log_process_file<<i<<" : "<<aCar->OHN[i]->id<<"   ";
    log_process_file<<endl;

    log_process_file <<"   THN:"<<endl;
    for(int i = 0; i < SlotPerFrame; i++)
        if(aCar->THN[i] != nullptr)
            log_process_file<<i<<" : "<<aCar->THN[i]->id<<" ";
    log_process_file<<endl;

    //logfile<<"    Neighbors in CommRange"<<endl;

}