source: tmcsimulator/branches/FEPSimulator/FEPSim.cpp @ 217

#include "FEPSim.h"

#include <time.h>



FEPSim::FEPSim(char * ATMShost, int FEP_PROG, int FEP_REV, int SOCK_PORT) {

    this->ATMSHost = ATMShost;

    this->FEP_PROG = FEP_PROG;

    this->FEP_REV = FEP_REV;

    this->SOCK_PORT = SOCK_PORT;

    

    // clear log file

    FEPLogFile.open(FEPLogFileName, ios::trunc);

    FEPLogFile.close();

}



FEPSim::~FEPSim() {

    FEPLogFile.close();

}



void FEPSim::handleCallResponse(void *response) {

    // Failed RPC Call 

    if (response == NULL) { 

        clnt_perror(clnt, "RPC call failed");

    }

    // Successful RPC Call

    else { 

        FEPLogFile << "Successful RPC call to ATMS..." << endl;

    }

}



void FEPSim::sendReplys(char * buffer) {

    HighwaysParser highwaysParser = HighwaysParser(buffer);

    vector<FEP_LINE*> lines = highwaysParser.lines;

    vector<STATION*> ldsMap = highwaysParser.stations;



    

    // Send one reply for every FEPLine

    for (int i = 0; i < lines.size(); i++) {

        fep_reply fepReply;

        

        // populate reply

        fepReply.reply = SHORTPOLL;

        fepReply.schedule = lines.at(i)->schedule;

        fepReply.lineinfo = lines.at(i)->lineInfo;

        fepReply.kind = (enum polltype) 0;

        fepReply.flag = (enum replykind) 0;



        fepReply.schedule_sequence = lines.at(i)->schedleSeq;

        fepReply.global_sequence = lines.at(i)->globalSeq;



        // using current unix time, may need to look at later

        fepReply.schedule_time = time(NULL);



        fepReply.user_info1 = lines.at(i)->lineNum;

        fepReply.user_info2 = lines.at(i)->lineNum;

        fepReply.system_key = lines.at(i)->systemKey;



        fepReply.answers.size = 1;

        fepReply.answers.fep_answer_list_u.shortp.count = 1;

        

        // construct a shortanswer for each station in line

        for (int j = 0; j < lines.at(i)->lds.size(); j++) {

            fep_shortanswer fsa;

            int index = lines.at(i)->ldsIndex.at(j);



            // msg: oa, od, ldsMap.at(index).dataPack, od, ff

            fsa.msg.message_len = ldsMap.at(index)->length + 2;

            fsa.msg.message[0] = 0x0d;

            fsa.msg.message[1] = 0x0a;

            for (int k = 0; k < ldsMap.at(index)->length; k++) {

                //printf("Adding: %d %02X\n", k, ldsMap.at(index)->dataPack[k]);        

                fsa.msg.message[2 + k] = ldsMap.at(index)->dataPack[k];

            }

            int aa = ldsMap.at(index)->length;

            fsa.msg.message[2 + aa] = 0x0d;

            fsa.msg.message[3 + aa] = 0xff;

            

            /*for(int l = 0; l < fsa.msg.message_len + 2; l++)

            {

                printf("%02X", (unsigned char) fsa.msg.message[l]);

            }

            printf("\n");*/

            

            // info

            fsa.info.poll_error_count = 0;

            fsa.info.poll_user_info1 = ldsMap.at(index)->drop; // drop number

            fsa.info.poll_user_info2 = 1; //always 1

            fsa.info.retries = 0;

            fsa.info.status = (enum replystatus) 1;



            fepReply.answers.fep_answer_list_u.shortp.answers[0] = fsa;

            // send out data

            

            FEPLogFile << "Sending fepReply for line #" << lines.at(i)->lineNum 

                    << " station number #" 

                    << ldsMap.at(lines.at(i)->ldsIndex.at(j)) << endl;

            

            // Transfer the station data to ATMS and listen for response

            handleCallResponse(fep_reply_xfer_32(&fepReply, clnt));

        }

    }

}



void FEPSim::manageClientConnection(char * buffer) 

{

    // Attempt to create RPC client

    if (createClient()) 

    {

        // Prepare and send the highway status as FEP replies

        sendReplys(buffer);

        FEPLogFile << "Destroying client..." << endl;

        clnt_destroy(clnt);

        int startTime = time(NULL);

        FEPLogFile << "time is: " << startTime << endl;

    }

}





bool FEPSim::createClient() {

    /* Create RPC Client to communicate with ATMS */

    bool success = true;



    clnt = clnt_create(this->ATMSHost, FEP_PROG, FEP_REV, "tcp");

    /* Check if client creation failed */

    if (clnt == (CLIENT *) NULL) {

        cerr << "Can't create client to " << this->ATMSHost << endl;

        cerr << "Verify you are connected to ATL network." << endl;

        success = false;

    } else {

        FEPLogFile << "Client created" << endl;

    }

    return success;

}



void FEPSim::runSockServer() {

    int sockfd, newsockfd, portno, clilen;

    char buffer[BUFF_SIZE];

    struct sockaddr_in serv_addr, cli_addr;

    int n;

    portno = this->SOCK_PORT;



    /* First call to socket() function */

    sockfd = socket(AF_INET, SOCK_STREAM, 0);



    if (sockfd < 0) {

        perror("ERROR opening socket");

        exit(1);

    }



    /* Initialize socket structure */

    bzero((char *) &serv_addr, sizeof (serv_addr));



    serv_addr.sin_family = AF_INET;

    serv_addr.sin_addr.s_addr = INADDR_ANY;

    serv_addr.sin_port = htons(portno);



    /* Now bind the host address using bind() call.*/

    if (bind(sockfd, (struct sockaddr *) &serv_addr, sizeof (serv_addr)) < 0) {

        perror("ERROR on binding");

        exit(1);

    }



    /* Now start listening for the clients, here process will

     * go in sleep mode and will wait for the incoming connection

     */



    listen(sockfd, 5);

    clilen = sizeof (cli_addr);



    /* Accept actual connections from the client */

    while (1) {

        newsockfd = accept(sockfd, (struct sockaddr *) &cli_addr, (socklen_t *) & clilen);



        if (newsockfd < 0) {

            perror("ERROR on accept");

            exit(1);

        }



        /* If connection is established then start communicating */

        // zero out buffer

        bzero(buffer, BUFF_SIZE);

        

        // read XML from socket

        int totBytes = 0;

        while ((n = recv(newsockfd, &buffer[totBytes], sizeof (buffer), 0)) > 0) {

            totBytes += n;

        }



        if (n < 0) {

            perror("ERROR reading from socket");

            exit(1);

        }

        

        FEPLogFile.open(FEPLogFileName, ios::app);

        // send data to atms

        manageClientConnection(buffer);

        FEPLogFile << "attempt" << endl;

        FEPLogFile.close();

    }

}