root/vtcross/branches/trnewman/CR_shell/src/main_cognitive_radio.cpp @ 86

Revision 86, 13.3 KB (checked in by trnewman, 16 years ago)

fixed some error handling issues
Line 
1#include <iostream>
2#include <sys/types.h>
3#include <sys/wait.h>
4#include "tinyxml.h"
5#include "tinystr.h"
6#include "socket/ServerSocket.h"
7#include "socket/SocketException.h"
8
9using namespace std;
10
11#define SERVER_PORT 30000
12
13struct CE_Info {
14        int numUtilities;
15        int numParameters;
16        int numObservables;
17};
18
19struct Utility {
20        string name;
21        string units;
22        string goal;
23        float target;
24    float value;
25};
26struct Affect {
27        Utility * u;
28        string relation;
29};
30struct Parameter {
31        string name;
32        string units;
33        float min;
34        int numAffects;
35        Affect affection_list[10];
36        float max;
37        float step;
38    float value;
39};
40
41struct Observable {
42        string name;
43        Affect affection_list[10];
44        int numAffects;
45    float value;
46};
47
48void print_current_config(Utility * uList[], Parameter * pList[], Observable * oList[], CE_Info * ce_info) {
49        int i = 0;
50        int j = 0;
51
52        for(i = 0; i < ce_info->numUtilities ; i++) {
53                cout << "Utility:  " << uList[i]->name << endl;
54                cout << "     Units:  " << uList[i]->units << endl;
55                cout << "     Goal:   " << uList[i]->goal << endl;
56                cout << "     Target: " << uList[i]->target << endl;
57        }
58
59        for(i = 0; i < ce_info->numParameters; i++) {
60                cout << "Parameter:  " << pList[i]->name << endl;
61                cout << "       Units:   " << pList[i]->units << endl;
62                cout << "       Min:     " << pList[i]->min << endl;
63                cout << "       Max:     " << pList[i]->max << endl;
64                cout << "       Step:    " << pList[i]->step << endl;
65                for(j = 0; j < pList[i]->numAffects; j++) {
66                        cout << "       Affect: " << pList[i]->affection_list[j].u->name << " -> " << pList[i]->affection_list[j].relation << endl;
67                }
68        }
69       
70    for(i = 0; i < ce_info->numObservables; i++) {
71                cout << "Observable:  " << oList[i]->name << endl;
72                for(j = 0; j < oList[i]->numAffects; j++) {
73                        cout << "       Affect: " << oList[i]->affection_list[j].u->name << " -> " << oList[i]->affection_list[j].relation << endl;
74                }
75        }
76}
77
78
79int parse_ce_config( TiXmlDocument * doc , Utility * u[], Parameter * p[], Observable * o[], CE_Info * ce_info) {
80
81        TiXmlElement* pElem;    //!current element
82        TiXmlElement* pChild;   //!current child of pElem
83        TiXmlElement* pChild1;  //!current child of pElem
84        TiXmlElement* pSecondChild;     //!current child of pElem
85        TiXmlHandle hDoc(doc);  //!handle to xml document
86        TiXmlHandle hRoot(0); //! handle to root element
87
88        int count = 0;
89        int i = 0;
90        int j = 0;
91        int k = 0;
92        int match_found = 0;
93
94        pElem = hDoc.FirstChildElement().Element();
95        if(!pElem) { cout << "no valid root! quit-ing function!" << endl; return 0; }
96        hRoot = TiXmlHandle(pElem);
97
98        // Pull utility information from XML file.
99
100        pElem = hRoot.FirstChild("utilities").Element();
101        pChild1 = hRoot.Child("utilities",count).Element();
102
103
104        for(pChild = pChild1->FirstChildElement("utility"); pChild; pChild = pChild->NextSiblingElement())
105        {
106                u[i] = new Utility;
107                const char *uName = pChild->Attribute("name");
108                if(uName) u[i]->name = uName;   
109                const char *uUnits = pChild->Attribute("units");
110                if(uUnits) u[i]->units = uUnits;
111                const char *uGoal = pChild->Attribute("goal");
112                if(uGoal) u[i]->goal = uGoal;
113                if(pChild->QueryFloatAttribute("target",&u[i]->target) != TIXML_SUCCESS) u[i]->target = -1;
114                i++;
115        }
116        ce_info->numUtilities = i;     
117        cout << "Parsed " << ce_info->numUtilities << " utilities." << endl;
118
119        // Pull observable information from XML file.
120        i = 0;
121        pElem = hRoot.FirstChild("observables").Element();
122        pChild1 = hRoot.Child("observables",count).Element();
123       
124        for(pChild = pChild1->FirstChildElement("observable"); pChild; pChild = pChild->NextSiblingElement())
125        {
126
127                const char *oName = pChild->Attribute("name");
128                o[i] = new Observable;
129
130                if(oName) o[i]->name = oName;
131               
132                j = 0;
133                for(pSecondChild = pChild->FirstChildElement("affect"); pSecondChild; pSecondChild = pSecondChild->NextSiblingElement())
134                {
135                        const char *oUtilName = pSecondChild->Attribute("utility");
136
137                        // If a utility affects this parameter find the utility object and assign it
138                        if(oUtilName) {
139                                // Search for correct utility
140                                for( k=0 ; u[k]!=NULL ; k++ ){
141                                        if(u[k]->name == oUtilName) {
142                                                o[i]->affection_list[j].u = u[k];
143                                                // Set relationship
144                                                const char *oRelate = pSecondChild->Attribute("relationship");
145                                                if(oRelate) o[i]->affection_list[j].relation = oRelate;
146                                                j++;
147                                                match_found = 1;
148                                                break;
149                                        }
150                                }
151                        }
152                        if(!match_found) cout << "Error: " << o[i]->name << ": " << oUtilName << " not a valid utility: Affect not added." << endl;     
153                        match_found = 0;       
154                }
155                o[i]->numAffects = j;
156                i++;
157        }
158        ce_info->numObservables = i;   
159        cout << "Parsed " << ce_info->numObservables << " observables." << endl;
160       
161
162        // Pull parameter information from XML file.
163        pElem = hRoot.FirstChild("parameters").Element();
164        pChild1 = hRoot.Child("parameters",count).Element();
165       
166        i = 0;
167        for(pChild = pChild1->FirstChildElement("parameter"); pChild; pChild = pChild->NextSiblingElement())
168        {
169                p[i] = new Parameter;
170
171                const char *pName = pChild->Attribute("name");
172                if(pName) p[i]->name = pName;   
173                const char *pUnits = pChild->Attribute("units");
174                if(pUnits) p[i]->units = pUnits;
175
176                if(pChild->QueryFloatAttribute("min",&p[i]->min) != TIXML_SUCCESS) p[i]->min = -1;
177                if(pChild->QueryFloatAttribute("max",&p[i]->max) != TIXML_SUCCESS) p[i]->max = -1;
178                if(pChild->QueryFloatAttribute("step",&p[i]->step) != TIXML_SUCCESS) p[i]->step = -1;
179               
180                j = 0;
181                for(pSecondChild = pChild->FirstChildElement("affect"); pSecondChild; pSecondChild = pSecondChild->NextSiblingElement())
182                {
183                        const char *pUtilName = pSecondChild->Attribute("utility");
184                       
185                        // If a utility affects this parameter find the utility object and assign it
186                        if(pUtilName) {
187                                // Search for correct utility
188                                for( k=0 ; u[k]!=NULL ; k++ ){
189                                        if(u[k]->name == pUtilName) {
190                                                // If match found, assign it to this index
191                                                p[i]->affection_list[j].u = u[k];       
192                                                const char *pRelate = pSecondChild->Attribute("relationship");
193                                                if(pRelate) {
194                                                        p[i]->affection_list[j].relation = pRelate;
195                                                } else {
196                                                        cout << "Error: No relation found." << endl;
197                                                }
198                                                match_found = 1;
199                                                j++;
200                                                break;
201                                        }
202                                }
203                        }
204                        if(!match_found) cout << "Error: " << p[i]->name << ": " << pUtilName << " not a valid utility: Affect not added." << endl;     
205                        match_found = 0;       
206                }
207                p[i]->numAffects = j;
208                i++;
209
210        }
211        ce_info->numParameters = i;     
212        cout << "Parsed " << ce_info->numParameters << " parameters." << endl;
213        return 1;
214}
215
216
217void error(char *msg)
218{
219    perror(msg);
220    exit(1);
221}
222
223
224int ReceiveMessage(int socket,char * buffer)
225{
226    int i,n;
227   
228    n = recv(socket,buffer,256,MSG_PEEK);
229    for(i=0;i<256;i++){
230        if(strcmp(&buffer[i],"\0") == 0) break;
231    }
232    n = recv(socket,buffer,i+1,0);
233    if (n < 0)
234        error("ERROR reading from socket");
235    //    printf("ReadMessage:%s %d\n",buffer,n);
236
237    return n;
238}
239
240
241int SendMessage(int socketfd, string message) {
242        int n;
243
244        message.append("\0");   
245        // Write message back to client
246        n = write(socketfd,message.c_str(),(message.size()+1));
247        if (n<0)
248                error("Error sending to client\n");
249        if(n == 0)
250                printf("Client closed the socket.\n");
251
252        printf("SendMessage:%s %d\n",message.c_str(),n);       
253        return n;
254}
255
256void GetEnvironment() {
257
258}
259
260void Policy_ValidateSettings() {
261
262}
263
264
265void LoadCEConfiguration(int socketfd,Utility * uList[], Parameter * pList[], Observable * oList[], CE_Info * ce_info){
266        int n,i,j;
267        char counter[55];
268        char var[50];
269        //int total_bytes;   
270
271        printf("Sending configuration to CE.\n");
272 
273        // utilities
274        // Send number of utilities
275        sprintf(counter,"%d",ce_info->numUtilities);
276        SendMessage(socketfd,counter);
277        // send utility
278    for(i = 0; i < ce_info->numUtilities; i++) {
279                SendMessage(socketfd,uList[i]->name);
280                SendMessage(socketfd,uList[i]->units);
281                SendMessage(socketfd,uList[i]->goal);
282                sprintf(var,"%f",uList[i]->target);
283                SendMessage(socketfd,var);
284        }
285
286        // parameters
287    sprintf(counter,"%i",ce_info->numParameters);
288        SendMessage(socketfd,counter);
289        for(i = 0; i < ce_info->numParameters; i++) {
290                SendMessage(socketfd,pList[i]->name);
291                SendMessage(socketfd,pList[i]->units);
292                sprintf(var,"%f",pList[i]->min);
293                SendMessage(socketfd,var);
294                sprintf(var,"%f",pList[i]->max);
295                SendMessage(socketfd,var);
296                sprintf(var,"%f",pList[i]->step);
297                SendMessage(socketfd,var);
298               
299                sprintf(counter,"%i",pList[i]->numAffects);
300                SendMessage(socketfd,counter);
301                for(j = 0; j < pList[i]->numAffects; j++) {
302                        SendMessage(socketfd,pList[i]->affection_list[j].u->name);
303                        SendMessage(socketfd,pList[i]->affection_list[j].relation);
304                }
305        }
306
307    // observables
308        sprintf(counter,"%i",ce_info->numObservables);
309        SendMessage(socketfd,counter);
310        for(i = 0; i < ce_info->numObservables; i++) {
311                SendMessage(socketfd,oList[i]->name);
312               
313                sprintf(counter,"%i",oList[i]->numAffects);
314                SendMessage(socketfd,counter);
315                for(j = 0; j < oList[i]->numAffects; j++) {
316                        SendMessage(socketfd,oList[i]->affection_list[j].u->name);
317                        SendMessage(socketfd,oList[i]->affection_list[j].relation);
318                }
319        }
320       
321        printf("Configuration sent, waiting for ACK...\n");
322        // Receive ACK for utils
323    char buffer[256];
324        string message;
325        n = ReceiveMessage(socketfd, buffer);
326    printf("%s\n", buffer);
327        //cout << message << endl;
328        printf("ACK received.\n");
329
330}
331
332void UpdateCEConfiguration() {
333
334}
335
336void ResetCEConfiguration(){
337
338}
339
340void UpdateCEExperience(float * exp[]) {
341
342}
343
344void ResetCEExperience() {
345
346}
347
348// Update operating settings
349// This function will interact with the hardware "drivers"
350void UpdateRadioSettings() {
351
352}
353
354int RequestCEOptimization(int sockfd, Utility *uList[],
355        Parameter *pList[], Observable *oList[],
356        CE_Info *ce_info)
357{
358    string message;
359    char buffer[256];
360    int i;
361    float var;
362
363    /*// utility
364    for (i = 0; i < ce_info->numUtilities; i++){
365        bzero(buffer,256);
366        ReceiveMessage(sockfd,buffer);
367        var = atof(buffer);
368        uList[i]->value = var;
369        printf("utility %s, value %f\n"
370                , uList[i]->name.c_str(), uList[i]->value);
371    }*/
372   
373    // paramter
374    for (i = 0; i < ce_info->numParameters; i++){
375        bzero(buffer,256);
376        ReceiveMessage(sockfd,buffer);
377        var = atof(buffer);
378        pList[i]->value = var;
379        printf("parameter %s, value %f\n"
380                , pList[i]->name.c_str(), pList[i]->value);
381    }
382
383    /*// observable
384    for (i = 0; i < ce_info->numObservables; i++){
385        bzero(buffer,256);
386        ReceiveMessage(sockfd,buffer);
387        var = atof(buffer);
388        oList[i]->value = var;
389        printf("observable %s, value %f\n"
390                , oList[i]->name.c_str(), oList[i]->value);
391    }*/
392
393    return 1;
394}
395
396void RunSimulator(int socketfd, Utility * uList[],
397        Parameter * pList[], Observable * oList[],
398        CE_Info * ce_info) {
399       
400        float **past_exp;
401
402        // Set fake current environment params = current environment
403        //RequestCEOptimization();
404        RequestCEOptimization(socketfd, uList, pList, oList, ce_info);
405
406        // Act like we are updating the hardware tranmission settings
407        //UpdateRadioSettings(socketfd, uList, pList, oList, ce_info);
408        UpdateRadioSettings();
409
410        // Send back fake utility values
411        UpdateCEExperience(past_exp);   
412}
413
414void StartMessaging(int socketfd, Utility * uList[], Parameter * pList[], Observable * oList[], CE_Info * ce_info) {
415
416        float **past_exp;
417
418        LoadCEConfiguration(socketfd, uList, pList, oList, ce_info);
419       
420        UpdateCEExperience(past_exp);   
421
422        RunSimulator(socketfd, uList, pList, oList, ce_info);
423}
424
425int StartShell(int port,Utility * uList[], Parameter * pList[], Observable * oList[], CE_Info * ce_info) {
426        // Start socket server
427        int sockfd, newsockfd, clilen;
428        struct sockaddr_in serv_addr, cli_addr;
429
430        // Setup server socket connection
431        sockfd = socket(AF_INET, SOCK_STREAM, 0);
432        if (sockfd < 0)
433                error("ERROR opening socket");
434        bzero((char *) &serv_addr, sizeof(serv_addr));
435        serv_addr.sin_family = AF_INET;
436        serv_addr.sin_port = htons(port);
437        serv_addr.sin_addr.s_addr = INADDR_ANY;
438        if (bind(sockfd, (struct sockaddr *) &serv_addr,
439                sizeof(serv_addr)) < 0)
440                error("ERROR on binding");
441        listen(sockfd,5);
442        clilen = sizeof(cli_addr);
443
444        //while(1) {
445                newsockfd = accept(sockfd,
446                        (struct sockaddr *) &cli_addr,
447                        (socklen_t*)&clilen);
448                if (newsockfd < 0)
449                        error("ERROR on accept");
450
451                // Begin parsing the messages
452                StartMessaging(newsockfd, uList, pList, oList, ce_info);
453        //}
454        return 0;
455}
456
457int main(int argc, char* argv[]) {
458
459
460        // CognitiveEngine CE;
461        // CognitiveEngineShell Shell;
462        string pFilename;
463        int pid;
464
465        Utility * uList[10];
466        Parameter * pList[10];
467        Observable * oList[10];
468        CE_Info ce_info;
469
470        if(argc < 2) {
471                cout << "Warning no XML file specific using default: example.xml" << endl;
472                pFilename = "example.xml";
473        } else { 
474                pFilename = argv[1];
475        }
476
477        TiXmlDocument doc( pFilename.c_str() );
478        bool loadOkay = doc.LoadFile();
479        if (!loadOkay)
480        {
481                cout << "Loading " << pFilename << " failed." << endl;
482                return 0;
483        }
484
485        cout << "Attemping to parse " << pFilename << "." << endl;
486        parse_ce_config( &doc , uList, pList, oList, &ce_info);
487        cout << "Configuration file parsing completed." << endl;
488
489    //print_current_config(uList, pList, oList, &ce_info);
490       
491    pid = fork();
492        if(pid == 0) {
493                // In child process - open policy engine port.
494        //      StartShell(30000,uList, pList, oList, &ce_info);
495        } else {
496                // In parent process - open cognitive engine port.
497                StartShell(30001,uList, pList, oList, &ce_info);
498        }
499       
500
501   return 1;
502}
Note: See TracBrowser for help on using the browser.