869 | | printf("if taken\n"); |
870 | | for(int k = i + 1; k <= i + miss[activeMission].services[i].num_conds; k++) |
871 | | TransactData(k); |
| 1044 | //printf("L0:if taken\n"); |
| 1045 | |
| 1046 | for(int k = i + 1; k <= i + miss[activeMission].services[i].num_conds; k++){ |
| 1047 | //printf("k=%d\n", k); |
| 1048 | if(miss[activeMission].services[k].name.compare("if")==0) |
| 1049 | { |
| 1050 | //printf("L1:if detected\n"); |
| 1051 | input.clear(); |
| 1052 | check.clear(); |
| 1053 | if(!miss[activeMission].services[k].input[0].empty()){ |
| 1054 | input=miss[activeMission].services[k].input[0]; |
| 1055 | check = "1@true@"; |
| 1056 | } |
| 1057 | else{ |
| 1058 | input=miss[activeMission].services[k].input[1]; |
| 1059 | check = "1@false@"; |
| 1060 | } |
| 1061 | //printf("input=%s\n", input.c_str()); |
| 1062 | |
| 1063 | strcpy(_data_DB->command, "SELECT "); |
| 1064 | strcat(_data_DB->command, _data_DB->tablename); |
| 1065 | strcat(_data_DB->command, ".* from "); |
| 1066 | strcat(_data_DB->command, _data_DB->tablename); |
| 1067 | strcat(_data_DB->command, " where Tag=="); |
| 1068 | sprintf(_data_DB->command, "%s'%s';", _data_DB->command, input.c_str()); |
| 1069 | sqlite3_stmt * pStatement; |
| 1070 | rc = sqlite3_prepare_v2(_data_DB->db, _data_DB->command, -1, &pStatement, NULL); |
| 1071 | if (rc == SQLITE_OK){ |
| 1072 | if (sqlite3_step(pStatement) == SQLITE_ROW) |
| 1073 | data = (const char *) sqlite3_column_text(pStatement, 1); |
| 1074 | else { |
| 1075 | printf("1 data_DB:: Data not yet in DB. %d\n", k); |
| 1076 | rc=31337; |
| 1077 | } |
| 1078 | } else { |
| 1079 | printf("data_DB:: Error executing SQL statement. rc = %i\n%s\n",rc,_data_DB->command); |
| 1080 | } |
| 1081 | |
| 1082 | sqlite3_finalize(pStatement); |
| 1083 | //printf("L1:data=%s, check=%s\n", data.c_str(), check.c_str()); |
| 1084 | //printf("L1:--- %d %d---\n", miss[activeMission].services[i].num_conds, k); |
| 1085 | if(data.compare(check)==0){ |
| 1086 | //printf("L1:if taken\n"); |
| 1087 | for(int j = k + 1; j <= k + miss[activeMission].services[k].num_conds; j++){ |
| 1088 | // printf("j=%d\n", k); |
| 1089 | //printf("name!!!! = %s\n", miss[activeMission].services[j].name.c_str()); |
| 1090 | if(miss[activeMission].services[j].name.compare("if")==0) |
| 1091 | { |
| 1092 | // printf("L2:if detected\n"); |
| 1093 | input.clear(); |
| 1094 | check.clear(); |
| 1095 | if(!miss[activeMission].services[j].input[0].empty()){ |
| 1096 | input=miss[activeMission].services[j].input[0]; |
| 1097 | check = "1@true@"; |
| 1098 | } |
| 1099 | else{ |
| 1100 | input=miss[activeMission].services[j].input[1]; |
| 1101 | check = "1@false@"; |
| 1102 | } |
| 1103 | //printf("L2:input=%s\n", input.c_str()); |
| 1104 | |
| 1105 | strcpy(_data_DB->command, "SELECT "); |
| 1106 | strcat(_data_DB->command, _data_DB->tablename); |
| 1107 | strcat(_data_DB->command, ".* from "); |
| 1108 | strcat(_data_DB->command, _data_DB->tablename); |
| 1109 | strcat(_data_DB->command, " where Tag=="); |
| 1110 | sprintf(_data_DB->command, "%s'%s';", _data_DB->command, input.c_str()); |
| 1111 | sqlite3_stmt * pStatement; |
| 1112 | rc = sqlite3_prepare_v2(_data_DB->db, _data_DB->command, -1, &pStatement, NULL); |
| 1113 | if (rc == SQLITE_OK){ |
| 1114 | if (sqlite3_step(pStatement) == SQLITE_ROW) |
| 1115 | data = (const char *) sqlite3_column_text(pStatement, 1); |
| 1116 | else { |
| 1117 | printf("1 data_DB:: Data not yet in DB. %d\n", k); |
| 1118 | rc=31337; |
| 1119 | } |
| 1120 | } else { |
| 1121 | printf("data_DB:: Error executing SQL statement. rc = %i\n%s\n",rc,_data_DB->command); |
| 1122 | } |
| 1123 | |
| 1124 | sqlite3_finalize(pStatement); |
| 1125 | // printf("L2:data=%s, check=%s\n", data.c_str(), check.c_str()); |
| 1126 | // printf("L2:--- %d %d---\n", miss[activeMission].services[i].num_conds, k); |
| 1127 | if(data.compare(check)==0){ |
| 1128 | //printf("L2:if taken\n"); |
| 1129 | for(int p = j + 1; p <= j + miss[activeMission].services[j].num_conds; p++) |
| 1130 | TransactData(p); |
| 1131 | } |
| 1132 | else{ |
| 1133 | //printf("L2:if not taken %d\n", miss[activeMission].services[j].num_conds); |
| 1134 | } |
| 1135 | j+=miss[activeMission].services[j].num_conds; |
| 1136 | } |
| 1137 | |
| 1138 | else if(miss[activeMission].services[j].name.compare("while")==0) |
| 1139 | { |
| 1140 | //printf("while detected\n"); |
| 1141 | while(true){ |
| 1142 | data.clear(); |
| 1143 | input.clear(); |
| 1144 | check.clear(); |
| 1145 | if(!miss[activeMission].services[j].input[0].empty()){ |
| 1146 | input=miss[activeMission].services[j].input[0]; |
| 1147 | check = "1@true@"; |
| 1148 | } |
| 1149 | else{ |
| 1150 | input=miss[activeMission].services[j].input[1]; |
| 1151 | check = "1@false@"; |
| 1152 | } |
| 1153 | strcpy(_data_DB->command, "select "); |
| 1154 | strcat(_data_DB->command, _data_DB->tablename); |
| 1155 | strcat(_data_DB->command, ".* from "); |
| 1156 | strcat(_data_DB->command, _data_DB->tablename); |
| 1157 | strcat(_data_DB->command, " where Tag=="); |
| 1158 | sprintf(_data_DB->command, "%s'%s';", _data_DB->command, input.c_str()); |
| 1159 | sqlite3_stmt * pStatement; |
| 1160 | rc = sqlite3_prepare_v2(_data_DB->db, _data_DB->command, -1, &pStatement, NULL); |
| 1161 | if (rc == SQLITE_OK){ |
| 1162 | if (sqlite3_step(pStatement) == SQLITE_ROW) |
| 1163 | data = (const char *) sqlite3_column_text(pStatement, 1); |
| 1164 | else |
| 1165 | printf("1 data_DB:: Data not yet in DB. %d\n", i); |
| 1166 | } |
| 1167 | else { |
| 1168 | printf("data_DB:: Error executing SQL statement. rc = %i\n%s\n",rc,_data_DB->command); |
| 1169 | } |
| 1170 | |
| 1171 | sqlite3_finalize(pStatement); |
| 1172 | printf("data=%s, check=%s\n", data.c_str(), check.c_str()); |
| 1173 | if(data.compare(check)==0){ |
| 1174 | printf("while taken\n"); |
| 1175 | for(int p = j + 1; p <= j + miss[activeMission].services[j].num_conds; p++) |
| 1176 | TransactData(p); |
| 1177 | } |
| 1178 | else{ |
| 1179 | printf("while not taken %d\n", miss[activeMission].services[k].num_conds); |
| 1180 | j+=miss[activeMission].services[j].num_conds; |
| 1181 | break; |
| 1182 | } |
| 1183 | } |
| 1184 | } |
| 1185 | else{ |
| 1186 | printf("L2: nocond transact\n"); |
| 1187 | TransactData(j);} |
| 1188 | j++; |
| 1189 | } |
| 1190 | } |
| 1191 | else{ |
| 1192 | //printf("if not taken %d\n", miss[activeMission].services[k].num_conds); |
| 1193 | } |
| 1194 | k+=miss[activeMission].services[k].num_conds; |
| 1195 | } |
| 1196 | else if(miss[activeMission].services[k].name.compare("while")==0) |
| 1197 | { |
| 1198 | //printf("while detected\n"); |
| 1199 | while(true){ |
| 1200 | data.clear(); |
| 1201 | input.clear(); |
| 1202 | check.clear(); |
| 1203 | if(!miss[activeMission].services[k].input[0].empty()){ |
| 1204 | input=miss[activeMission].services[k].input[0]; |
| 1205 | check = "1@true@"; |
| 1206 | } |
| 1207 | else{ |
| 1208 | input=miss[activeMission].services[k].input[1]; |
| 1209 | check = "1@false@"; |
| 1210 | } |
| 1211 | strcpy(_data_DB->command, "select "); |
| 1212 | strcat(_data_DB->command, _data_DB->tablename); |
| 1213 | strcat(_data_DB->command, ".* from "); |
| 1214 | strcat(_data_DB->command, _data_DB->tablename); |
| 1215 | strcat(_data_DB->command, " where Tag=="); |
| 1216 | sprintf(_data_DB->command, "%s'%s';", _data_DB->command, input.c_str()); |
| 1217 | sqlite3_stmt * pStatement; |
| 1218 | rc = sqlite3_prepare_v2(_data_DB->db, _data_DB->command, -1, &pStatement, NULL); |
| 1219 | if (rc == SQLITE_OK){ |
| 1220 | if (sqlite3_step(pStatement) == SQLITE_ROW) |
| 1221 | data = (const char *) sqlite3_column_text(pStatement, 1); |
| 1222 | else |
| 1223 | printf("1 data_DB:: Data not yet in DB. %d\n", i); |
| 1224 | } |
| 1225 | else { |
| 1226 | printf("data_DB:: Error executing SQL statement. rc = %i\n%s\n",rc,_data_DB->command); |
| 1227 | } |
| 1228 | |
| 1229 | sqlite3_finalize(pStatement); |
| 1230 | printf("data=%s, check=%s\n", data.c_str(), check.c_str()); |
| 1231 | if(data.compare(check)==0){ |
| 1232 | printf("while taken\n"); |
| 1233 | for(int k = i + 1; k <= i + miss[activeMission].services[i].num_conds; k++) |
| 1234 | TransactData(k); |
| 1235 | } |
| 1236 | else{ |
| 1237 | printf("while not taken %d\n", miss[activeMission].services[k].num_conds); |
| 1238 | k+=miss[activeMission].services[k].num_conds; |
| 1239 | break; |
| 1240 | } |
| 1241 | } |
| 1242 | } |
| 1243 | else{ |
| 1244 | //printf("L1: nocond transact\n"); |
| 1245 | TransactData(k);} |
| 1246 | k++; |
| 1247 | } |
| 1413 | TiXmlElement *pService; |
| 1414 | TiXmlElement *pChild0, *pChild1, *pChild2, *pChild3, *pChild4; |
| 1415 | TiXmlHandle hRoot(0); |
| 1416 | //printf("ServiceManagementLayer:: Loading Configuration.\n"); |
| 1417 | TiXmlDocument doc("."); |
| 1418 | doc.LoadFile(SML_Config); |
| 1419 | bool loadOkay = doc.LoadFile(); |
| 1420 | if(!loadOkay) |
| 1421 | printf("Loading SML configuration failed: %s\n", SML_Config); |
| 1422 | |
| 1423 | TiXmlHandle hDoc(&doc); |
| 1424 | |
| 1425 | pMission = hDoc.FirstChildElement().Element(); |
| 1426 | |
| 1427 | if(!pMission) |
| 1428 | printf("No valid root!"); |
| 1429 | |
| 1430 | hRoot = TiXmlHandle(pMission); |
| 1431 | pService = pMission->FirstChildElement(); |
| 1432 | int32_t mission_num = 0; |
| 1433 | //Iterate through the missions |
| 1434 | for(pChild0 = pMission->FirstChildElement(); pChild0 ; \ |
| 1435 | pChild0 = pChild0->NextSiblingElement()) |
| 1436 | { |
| 1437 | int32_t service_num = 0; |
| 1438 | uint16_t cond_array[] = {0, 0, 0}; |
| 1439 | //printf("mission_num = %d\n", mission_num); |
| 1440 | //memset(cond_array, 0, 2); |
| 1441 | |
| 1442 | for(pChild1 = pChild0->FirstChildElement(); pChild1; \ |
| 1443 | pChild1 = pChild1->NextSiblingElement()) |
| 1444 | { |
| 1445 | int32_t conditional_0 = service_num; |
| 1446 | for(pChild2 = pChild1->FirstChildElement(); \ |
| 1447 | pChild2; pChild2 = pChild2->NextSiblingElement()) |
| 1448 | { |
| 1449 | service_num++; |
| 1450 | int32_t conditional_1 = service_num; |
| 1451 | for(pChild3 = pChild2->FirstChildElement(); \ |
| 1452 | pChild3; pChild3 = pChild3 ->NextSiblingElement()) |
| 1453 | { |
| 1454 | service_num++; |
| 1455 | int32_t conditional_2 = service_num; |
| 1456 | for(pChild4 = pChild3->FirstChildElement(); \ |
| 1457 | pChild4; pChild4 = pChild4 ->NextSiblingElement()) |
| 1458 | { |
| 1459 | service_num++; |
| 1460 | mList[mission_num].services[service_num].name = pChild4->Attribute("name"); |
| 1461 | if(pChild4->Attribute("input1")) |
| 1462 | mList[mission_num].services[service_num].input[0] = pChild4->Attribute("input1"); |
| 1463 | if(pChild4->Attribute("input2")) |
| 1464 | mList[mission_num].services[service_num].input[1] = pChild4->Attribute("input2"); |
| 1465 | if(pChild4->Attribute("input3")) |
| 1466 | mList[mission_num].services[service_num].input[2] = pChild4->Attribute("input3"); |
| 1467 | if(pChild4->Attribute("input4")) |
| 1468 | mList[mission_num].services[service_num].input[3] = pChild4->Attribute("input4"); |
| 1469 | if(pChild4->Attribute("input5")) |
| 1470 | mList[mission_num].services[service_num].input[4] = pChild4->Attribute("input5"); |
| 1471 | if(pChild4->Attribute("output1")) |
| 1472 | mList[mission_num].services[service_num].output[0] = pChild4->Attribute("output1"); |
| 1473 | if(pChild4->Attribute("output2")) |
| 1474 | mList[mission_num].services[service_num].output[1] = pChild4->Attribute("output2"); |
| 1475 | if(pChild4->Attribute("output3")) |
| 1476 | mList[mission_num].services[service_num].output[2] = pChild4->Attribute("output3"); |
| 1477 | if(pChild4->Attribute("output4")) |
| 1478 | mList[mission_num].services[service_num].output[3] = pChild4->Attribute("output4"); |
| 1479 | if(pChild4->Attribute("output5")) |
| 1480 | mList[mission_num].services[service_num].output[4] = pChild4->Attribute("output5"); |
| 1481 | cond_array[2]++; |
| 1482 | } |
| 1483 | if(!strcmp(pChild3->Value(), "shell")) { |
| 1484 | mList[mission_num].services[conditional_2].name = pChild3->Value(); |
| 1485 | mList[mission_num].services[conditional_2].output[0] = pChild3->Attribute("output1"); |
| 1486 | //printf("2shell detected\n"); |
| 1487 | } |
| 1488 | else if(conditional_2 != service_num){ |
| 1489 | mList[mission_num].services[conditional_2].name = pChild3->Value(); |
| 1490 | if(pChild3->Attribute("input_t")) |
| 1491 | mList[mission_num].services[conditional_2].input[0] = pChild3->Attribute("input_t"); |
| 1492 | if(pChild3->Attribute("input_f")) |
| 1493 | mList[mission_num].services[conditional_2].input[1] = pChild3->Attribute("input_f"); |
| 1494 | } |
| 1495 | else{ |
| 1496 | mList[mission_num].services[service_num].name = pChild3->Attribute("name"); |
| 1497 | if(pChild3->Attribute("input1")) |
| 1498 | mList[mission_num].services[service_num].input[0] = pChild3->Attribute("input1"); |
| 1499 | if(pChild3->Attribute("input2")) |
| 1500 | mList[mission_num].services[service_num].input[1] = pChild3->Attribute("input2"); |
| 1501 | if(pChild3->Attribute("input3")) |
| 1502 | mList[mission_num].services[service_num].input[2] = pChild3->Attribute("input3"); |
| 1503 | if(pChild3->Attribute("input4")) |
| 1504 | mList[mission_num].services[service_num].input[3] = pChild3->Attribute("input4"); |
| 1505 | if(pChild3->Attribute("input5")) |
| 1506 | mList[mission_num].services[service_num].input[4] = pChild3->Attribute("input5"); |
| 1507 | if(pChild3->Attribute("output1")) |
| 1508 | mList[mission_num].services[service_num].output[0] = pChild3->Attribute("output1"); |
| 1509 | if(pChild3->Attribute("output2")) |
| 1510 | mList[mission_num].services[service_num].output[1] = pChild3->Attribute("output2"); |
| 1511 | if(pChild3->Attribute("output3")) |
| 1512 | mList[mission_num].services[service_num].output[2] = pChild3->Attribute("output3"); |
| 1513 | if(pChild3->Attribute("output4")) |
| 1514 | mList[mission_num].services[service_num].output[3] = pChild3->Attribute("output4"); |
| 1515 | if(pChild3->Attribute("output5")) |
| 1516 | mList[mission_num].services[service_num].output[4] = pChild3->Attribute("output5"); |
| 1517 | } |
| 1518 | mList[mission_num].services[conditional_2].num_conds = cond_array[2]; |
| 1519 | cond_array[1]+=cond_array[2]+1; |
| 1520 | //printf("cond_array[2]%d\n", cond_array[2]); |
| 1521 | cond_array[2] = 0; |
| 1522 | |
| 1523 | |
| 1524 | } |
| 1525 | //printf("here\n"); |
| 1526 | if(!strcmp(pChild2->Value(), "shell")) { |
| 1527 | mList[mission_num].services[conditional_1].name = pChild2->Value(); |
| 1528 | mList[mission_num].services[conditional_1].output[0] = pChild2->Attribute("output1"); |
| 1529 | //printf("1shell detected\n"); |
| 1530 | } |
| 1531 | else if(conditional_1 != service_num){ |
| 1532 | mList[mission_num].services[conditional_1].name = pChild2->Value(); |
| 1533 | if(pChild2->Attribute("input_t")) |
| 1534 | mList[mission_num].services[conditional_1].input[0] = pChild2->Attribute("input_t"); |
| 1535 | if(pChild2->Attribute("input_f")) |
| 1536 | mList[mission_num].services[conditional_1].input[1] = pChild2->Attribute("input_f"); |
| 1537 | } |
| 1538 | else{ |
| 1539 | mList[mission_num].services[service_num].name = pChild2->Attribute("name"); |
| 1540 | if(pChild2->Attribute("input1")) |
| 1541 | mList[mission_num].services[service_num].input[0] = pChild2->Attribute("input1"); |
| 1542 | if(pChild2->Attribute("input2")) |
| 1543 | mList[mission_num].services[service_num].input[1] = pChild2->Attribute("input2"); |
| 1544 | if(pChild2->Attribute("input3")) |
| 1545 | mList[mission_num].services[service_num].input[2] = pChild2->Attribute("input3"); |
| 1546 | if(pChild2->Attribute("input4")) |
| 1547 | mList[mission_num].services[service_num].input[3] = pChild2->Attribute("input4"); |
| 1548 | if(pChild2->Attribute("input5")) |
| 1549 | mList[mission_num].services[service_num].input[4] = pChild2->Attribute("input5"); |
| 1550 | if(pChild2->Attribute("output1")) |
| 1551 | mList[mission_num].services[service_num].output[0] = pChild2->Attribute("output1"); |
| 1552 | if(pChild2->Attribute("output2")) |
| 1553 | mList[mission_num].services[service_num].output[1] = pChild2->Attribute("output2"); |
| 1554 | if(pChild2->Attribute("output3")) |
| 1555 | mList[mission_num].services[service_num].output[2] = pChild2->Attribute("output3"); |
| 1556 | if(pChild2->Attribute("output4")) |
| 1557 | mList[mission_num].services[service_num].output[3] = pChild2->Attribute("output4"); |
| 1558 | if(pChild2->Attribute("output5")) |
| 1559 | mList[mission_num].services[service_num].output[4] = pChild2->Attribute("output5"); |
| 1560 | } |
| 1561 | |
| 1562 | mList[mission_num].services[conditional_1].num_conds = cond_array[1]; |
| 1563 | cond_array[0]+=cond_array[1]+1; |
| 1564 | //printf("cond_array[1]%d\n", cond_array[1]); |
| 1565 | cond_array[1] = 0; |
| 1566 | } |
| 1567 | |
| 1568 | if(!strcmp(pChild1->Value(), "shell")) { |
| 1569 | //printf("shell detected\n"); |
| 1570 | mList[mission_num].services[conditional_0].name = pChild1->Value(); |
| 1571 | mList[mission_num].services[conditional_0].output[0] = pChild1->Attribute("output1"); |
| 1572 | } |
| 1573 | else if(conditional_0 != service_num){ |
| 1574 | mList[mission_num].services[conditional_0].name = pChild1->Value(); |
| 1575 | if(pChild1->Attribute("input_t")) |
| 1576 | mList[mission_num].services[conditional_0].input[0] = pChild1->Attribute("input_t"); |
| 1577 | if(pChild1->Attribute("input_f")) |
| 1578 | mList[mission_num].services[conditional_0].input[1] = pChild1->Attribute("input_f"); |
| 1579 | //printf("---input_t=%s\n", mList[mission_num].services[conditional_0].input[0].c_str()); |
| 1580 | } |
| 1581 | else{ |
| 1582 | mList[mission_num].services[conditional_0].name = pChild1->Attribute("name"); |
| 1583 | //printf("name=%s\n", mList[mission_num].services[conditional_0].name.c_str()); |
| 1584 | if(pChild1->Attribute("input1")) |
| 1585 | mList[mission_num].services[service_num].input[0] = pChild1->Attribute("input1"); |
| 1586 | if(pChild1->Attribute("input2")) |
| 1587 | mList[mission_num].services[service_num].input[1] = pChild1->Attribute("input2"); |
| 1588 | if(pChild1->Attribute("input3")) |
| 1589 | mList[mission_num].services[service_num].input[2] = pChild1->Attribute("input3"); |
| 1590 | if(pChild1->Attribute("input4")) |
| 1591 | mList[mission_num].services[service_num].input[3] = pChild1->Attribute("input4"); |
| 1592 | if(pChild1->Attribute("input5")) |
| 1593 | mList[mission_num].services[service_num].input[4] = pChild1->Attribute("input5"); |
| 1594 | if(pChild1->Attribute("output1")) |
| 1595 | mList[mission_num].services[service_num].output[0] = pChild1->Attribute("output1"); |
| 1596 | if(pChild1->Attribute("output2")) |
| 1597 | mList[mission_num].services[service_num].output[1] = pChild1->Attribute("output2"); |
| 1598 | if(pChild1->Attribute("output3")) |
| 1599 | mList[mission_num].services[service_num].output[2] = pChild1->Attribute("output3"); |
| 1600 | if(pChild1->Attribute("output4")) |
| 1601 | mList[mission_num].services[service_num].output[3] = pChild1->Attribute("output4"); |
| 1602 | if(pChild1->Attribute("output5")) |
| 1603 | mList[mission_num].services[service_num].output[4] = pChild1->Attribute("output4"); |
| 1604 | } |
| 1605 | |
| 1606 | mList[mission_num].services[conditional_0].num_conds = cond_array[0]; |
| 1607 | cond_array[0] = 0; |
| 1608 | service_num++; |
| 1609 | } |
| 1610 | //for(int i = 0; i < service_num; i++) |
| 1611 | //printf("ttt%d\n", mList[mission_num].services[i].num_conds); |
| 1612 | |
| 1613 | mList[mission_num].numServices = service_num; |
| 1614 | mList[mission_num].name = pChild0->Attribute("name"); |
| 1615 | mList[mission_num].missionID = atoi(pChild0->Attribute("id")); |
| 1616 | if(pChild0->Attribute("input1")) |
| 1617 | mList[mission_num].input[0] = pChild0->Attribute("input1"); |
| 1618 | if(pChild0->Attribute("input2")) |
| 1619 | mList[mission_num].input[1] = pChild0->Attribute("input2"); |
| 1620 | if(pChild0->Attribute("input3")) |
| 1621 | mList[mission_num].input[2] = pChild0->Attribute("input3"); |
| 1622 | if(pChild0->Attribute("input4")) |
| 1623 | mList[mission_num].input[3] = pChild0->Attribute("input4"); |
| 1624 | if(pChild0->Attribute("input5")) |
| 1625 | mList[mission_num].input[4] = pChild0->Attribute("input4"); |
| 1626 | if(pChild0->Attribute("output1")) |
| 1627 | mList[mission_num].output[0] = pChild0->Attribute("output1"); |
| 1628 | if(pChild0->Attribute("output2")) |
| 1629 | mList[mission_num].output[1] = pChild0->Attribute("output2"); |
| 1630 | if(pChild0->Attribute("output3")) |
| 1631 | mList[mission_num].output[2] = pChild0->Attribute("output3"); |
| 1632 | if(pChild0->Attribute("output4")) |
| 1633 | mList[mission_num].output[3] = pChild0->Attribute("output4"); |
| 1634 | if(pChild0->Attribute("output5")) |
| 1635 | mList[mission_num].output[4] = pChild0->Attribute("output5"); |
| 1636 | //printf("mis, input1=%s, output1=%s\n", mList[mission_num].input[0].c_str(), mList[mission_num].output[0].c_str()); |
| 1637 | //printf("NUMSERVICES = %d\n", mList[mission_num].numServices); |
| 1638 | mission_num++; |
| 1639 | } |
| 1640 | } |
| 1641 | |
| 1642 | /* CALLED BY: MessageHandler |
| 1643 | * INPUTS: |ID| The ID number of the engine to be registered |
| 1644 | * OUTPUTS: <none> |
| 1645 | * |
| 1646 | * DESCRIPTION: Sends a registration message onto the shell and sends the ACK back to the component |
| 1647 | */ |
| 1648 | void |
| 1649 | ServiceManagementLayer::RegisterCognitiveEngine(int32_t ID) |
| 1650 | { |
| 1651 | //LOG("SML::regcogeng"); |
| 1652 | SendMessage(shellSocketFD, "register_engine_cognitive"); |
| 1653 | |
| 1654 | // printf("SSFD = %d\n", shellSocketFD); |
| 1655 | LOG("ServiceManagementLayer:: CE registration message forwarded to shell.\n"); |
| 1656 | char buffer[256]; |
| 1657 | memset(buffer, 0, 256); |
| 1658 | ReadMessage(shellSocketFD, buffer); |
| 1659 | //printf("ServiceManagementLayer::buffer = %s\n", buffer); |
| 1660 | SendMessage(CE_List[ID].FD, buffer); |
| 1661 | |
| 1662 | TransferRadioConfiguration(ID); |
| 1663 | memset(buffer, 0, 256); |
| 1664 | //printf("start trans exp\n"); |
| 1665 | TransferExperience(ID); |
| 1666 | memset(buffer, 0, 256); |
| 1667 | numberOfCognitiveEngines++; |
| 1668 | CE_Present = true; |
| 1669 | //printf("done registering CE!\n"); |
| 1670 | } |
| 1671 | |
| 1672 | /* CALLED BY: MessageHandler |
| 1673 | * INPUTS: |ID| The ID number of the engine to have it's services deregistered |
| 1674 | * OUTPUTS: <none> |
| 1675 | * |
| 1676 | * DESCRIPTION: Deletes individual services from the DB |
| 1677 | * NOTE THAT this function only needs to be called if service deregistration is going |
| 1678 | * to be done at a different time than component deregistration; it is handled |
| 1679 | * more efficiently and directly during that deregistration process. |
| 1680 | */ |
| 1681 | void |
| 1682 | ServiceManagementLayer::DeregisterServices(int32_t ID) |
| 1683 | { |
| 1684 | char buffer[256]; |
| 1685 | memset(buffer, 0, 256); |
| 1686 | ReadMessage(CE_List[ID].FD, buffer); |
| 1687 | strcpy(_services_DB->command, "DELETE FROM "); |
| 1688 | strcat(_services_DB->command, _services_DB->tablename); |
| 1689 | strcat(_services_DB->command, " WHERE ID_Num IN (SELECT"); |
| 1690 | sprintf(_services_DB->command, " %s %d",_services_DB->command, ID); |
| 1691 | strcat(_services_DB->command, " FROM "); |
| 1692 | strcat(_services_DB->command, _services_DB->tablename); |
| 1693 | strcat(_services_DB->command, " WHERE Service_Name"); |
| 1694 | strcat(_services_DB->command, "=="); |
| 1695 | sprintf(_services_DB->command, "%s'%s');", _services_DB->command, buffer); |
| 1696 | char *errorMsg; |
| 1697 | int rc = sqlite3_exec(_services_DB->db, _services_DB->command, callback, 0, &errorMsg); |
| 1698 | if( rc!=SQLITE_OK && rc!=101 ) |
| 1699 | fprintf(stderr, "SQL error: %s\n", errorMsg); |
| 1700 | } |
| 1701 | |
| 1702 | /* CALLED BY: MessageHandler |
| 1703 | * INPUTS: |ID| The ID number of the engine to have it's services deregistered |
| 1704 | * OUTPUTS: <none> |
| 1705 | * |
| 1706 | * DESCRIPTION: Deletes the contact info for the cognitive engine, forwards a deregistration message to the shell |
| 1707 | * Also, deletes the services from the DB |
| 1708 | */ |
| 1709 | void |
| 1710 | ServiceManagementLayer::DeregisterCognitiveEngine(int32_t ID) |
| 1711 | { |
| 1712 | LOG("ServiceManagementLayer:: CE deregistration message forwarded to shell.\n"); |
| 1713 | |
| 1714 | numberOfCognitiveEngines--; |
| 1715 | if(numberOfCognitiveEngines == 0) |
| 1716 | CE_Present = false; |
| 1717 | |
| 1718 | SendMessage(shellSocketFD, "deregister_engine_cognitive"); |
| 1719 | char buffer[256]; |
| 1720 | memset(buffer, 0, 256); |
| 1721 | ReadMessage(shellSocketFD, buffer); |
| 1722 | SendMessage(CE_List[ID].FD, buffer); |
| 1723 | if(strcmp("deregister_ack", buffer) != 0) { |
| 1724 | ERROR(1, "SML:: Failed to close CE socket\n"); |
| 1725 | } |
| 1726 | |
| 1727 | //Deregister the services |
| 1728 | strcpy(_services_DB->command, "DELETE FROM "); |
| 1729 | strcat(_services_DB->command, _services_DB->tablename); |
| 1730 | strcat(_services_DB->command, " WHERE "); |
| 1731 | strcat(_services_DB->command, "ID_Num"); |
| 1732 | strcat(_services_DB->command, "=="); |
| 1733 | sprintf(_services_DB->command, "%s%d;", _services_DB->command, ID); |
| 1734 | char *errorMsg; |
| 1735 | int rc = sqlite3_exec(_services_DB->db, _services_DB->command, callback, 0, &errorMsg); |
| 1736 | if( rc!=SQLITE_OK && rc!=101 ) |
| 1737 | fprintf(stderr, "SQL error: %s\n", errorMsg); |
| 1738 | |
| 1739 | |
| 1740 | CE_List[ID].FD = -1; |
| 1741 | CE_List[ID].ID_num = -1; |
| 1742 | |
| 1743 | LOG("Cognitive Radio Shell:: CE Socket closed for engine #%d.\n", ID); |
| 1744 | } |
| 1745 | |
| 1746 | |
| 1747 | /* CALLED BY: test class |
| 1748 | * INPUTS: <none> |
| 1749 | * OUTPUTS: <none> |
| 1750 | * |
| 1751 | * DESCRIPTION: Sets up a server socket and listens for communication on either that or the shell socket |
| 1752 | */ |
| 1753 | void |
| 1754 | ServiceManagementLayer::StartSMLServer() |
| 1755 | { |
| 1756 | //printf("Ready for CE Signal! (registration done)\n"); |
| 1757 | struct timeval selTimeout; |
| 1758 | int32_t running = 1; |
| 1759 | int32_t port, rc, new_sd = 1; |
| 1760 | int32_t desc_ready = 1; |
| 1761 | //If there is, call the MessageHandler with the Shell_Msg code of -1 |
| 1762 | fd_set sockSet, shellSet; |
| 1763 | |
| 1764 | cogEngSrv = CreateTCPServerSocket(SMLport); |
| 1765 | int32_t maxDescriptor = cogEngSrv; |
| 1766 | |
| 1767 | if(InitializeTCPServerPort(cogEngSrv) == -1) |
| 1768 | ERROR(1,"Error initializing primary port\n"); |
| 1769 | |
| 1770 | int i = 10000000; //TODO change to "running" if endpoint can be reached |
| 1771 | while (running) { |
| 1772 | i--; |
| 1773 | /* Zero socket descriptor vector and set for server sockets */ |
| 1774 | /* This must be reset every time select() is called */ |
| 1775 | FD_ZERO(&sockSet); |
| 1776 | FD_SET(cogEngSrv, &sockSet); |
| 1777 | for(uint16_t k = 0; k < Current_ID; k++){ |
| 1778 | if(CE_List[k].ID_num != -1) |
| 1779 | FD_SET(CE_List[k].FD, &sockSet); |
| 1780 | } |
| 1781 | //printf("k=%d, CID=%d\n", k, CE_List[k].FD); |
| 1782 | |
| 1783 | /* Timeout specification */ |
| 1784 | /* This must be reset every time select() is called */ |
| 1785 | selTimeout.tv_sec = 0; /* timeout (secs.) */ |
| 1786 | selTimeout.tv_usec = 0; /* 0 microseconds */ |
| 1787 | //Changed both to zero so that select will check messages from the shell instead of blocking |
| 1788 | //when there is no command from the CE's to be processed |
| 1789 | |
| 1790 | //Check if there is a message on the socket waiting to be read |
| 1791 | rc = select(maxDescriptor + 1, &sockSet, NULL, NULL, &selTimeout); |
| 1792 | //printf("rc=%d\n", rc); |
| 1793 | if(rc == 0){ |
| 1794 | //LOG("No echo requests for %i secs...Server still alive\n", timeout); |
| 1795 | |
| 1796 | FD_ZERO(&shellSet); |
| 1797 | FD_SET(shellSocketFD, &shellSet); |
| 1798 | selTimeout.tv_sec = 0; |
| 1799 | selTimeout.tv_usec = 0; |
| 1800 | //Check if there is a message on the shell socket ready to be processed |
| 1801 | select(shellSocketFD + 1, &shellSet, NULL, NULL, &selTimeout); |
| 1802 | //printf("rc2=%d\n", rc2); |
| 1803 | //If there is, call the MessageHandler with the Shell_Msg code of -1 |
| 1804 | if(FD_ISSET(shellSocketFD, &shellSet)){ |
| 1805 | //printf("shell_msg, %d\n", rc2); |
| 1806 | MessageHandler(-1);} |
| 1807 | } |
| 1808 | else { |
| 1809 | desc_ready = rc; |
| 1810 | for(port = 0; port <= maxDescriptor && desc_ready > 0; port++) { |
| 1811 | if(FD_ISSET(port, &sockSet)) { |
| 1812 | desc_ready -= 1; |
| 1813 | |
| 1814 | //Check if request is new or on an existing open descriptor |
| 1815 | if(port == cogEngSrv) { |
| 1816 | //If new, assign it a descriptor and give it an ID |
| 1817 | new_sd = AcceptTCPConnection(port); |
| 1818 | |
| 1819 | if(new_sd < 0) |
| 1820 | break; |
| 1821 | |
| 1822 | CE_List[Current_ID].FD = new_sd; |
| 1823 | CE_List[Current_ID].ID_num = Current_ID; |
| 1824 | MessageHandler(Current_ID); |
| 1825 | Current_ID++; |
| 1826 | |
| 1827 | FD_SET(new_sd,&sockSet); |
| 1828 | if(new_sd > maxDescriptor) |
| 1829 | maxDescriptor = new_sd; |
| 1830 | } |
| 1831 | else { |
| 1832 | //If old, figure out which ID it coresponds to and handle it accordingly |
| 1833 | for(uint16_t z = 0; z < Current_ID; z++) |
| 1834 | { |
| 1835 | if(CE_List[z].FD == port){ |
| 1836 | MessageHandler(z);} |
| 1837 | } |
| 1838 | } |
| 1839 | } |
| 1840 | } |
| 1841 | } |
| 1842 | } |
| 1843 | |
| 1844 | /* Close sockets */ |
| 1845 | close(cogEngSrv); |
| 1846 | |
| 1847 | //delete &cogEngSrv; |
| 1848 | return; |
| 1849 | } |
| 1850 | |
| 1851 | |
| 1852 | |
| 1853 | |
| 1854 | /*TiXmlElement *pMission; |
1091 | | mList[mission_num].services[conditional_1].name = pChild2->Attribute("name"); |
1092 | | if(pChild2->Attribute("input1")) |
1093 | | mList[mission_num].services[service_num].input[0] = pChild2->Attribute("input1"); |
1094 | | if(pChild2->Attribute("input2")) |
1095 | | mList[mission_num].services[service_num].input[1] = pChild2->Attribute("input2"); |
1096 | | if(pChild2->Attribute("input3")) |
1097 | | mList[mission_num].services[service_num].input[2] = pChild2->Attribute("input3"); |
1098 | | if(pChild2->Attribute("output1")) |
1099 | | mList[mission_num].services[service_num].output[0] = pChild2->Attribute("output1"); |
1100 | | if(pChild2->Attribute("output2")) |
1101 | | mList[mission_num].services[service_num].output[1] = pChild2->Attribute("output2"); |
1102 | | if(pChild2->Attribute("output3")) |
1103 | | mList[mission_num].services[service_num].output[2] = pChild2->Attribute("output3"); |
1104 | | } |
1105 | | |
1106 | | mList[mission_num].services[conditional_1].num_conds = cond_array[1]; |
1107 | | cond_array[1] = 0; |
1108 | | cond_array[0]++; |
1109 | | } |
1110 | | if(conditional_0 != service_num){ |
1111 | | mList[mission_num].services[conditional_0].name = pChild1->Value(); |
1112 | | if(pChild1->Attribute("input_t")) |
1113 | | mList[mission_num].services[conditional_0].input[0] = pChild1->Attribute("input_t"); |
1114 | | if(pChild1->Attribute("input_f")) |
1115 | | mList[mission_num].services[conditional_0].input[1] = pChild1->Attribute("input_f"); |
1116 | | //printf("---input_t=%s\n", mList[mission_num].services[conditional_0].input[0].c_str()); |
1117 | | } |
1118 | | else{ |
1119 | | mList[mission_num].services[conditional_0].name = pChild1->Attribute("name"); |
1120 | | if(pChild1->Attribute("input1")) |
1121 | | mList[mission_num].services[service_num].input[0] = pChild1->Attribute("input1"); |
1122 | | if(pChild1->Attribute("input2")) |
1123 | | mList[mission_num].services[service_num].input[1] = pChild1->Attribute("input2"); |
1124 | | if(pChild1->Attribute("input3")) |
1125 | | mList[mission_num].services[service_num].input[2] = pChild1->Attribute("input3"); |
1126 | | if(pChild1->Attribute("output1")) |
1127 | | mList[mission_num].services[service_num].output[0] = pChild1->Attribute("output1"); |
1128 | | if(pChild1->Attribute("output2")) |
1129 | | mList[mission_num].services[service_num].output[1] = pChild1->Attribute("output2"); |
1130 | | if(pChild1->Attribute("output3")) |
1131 | | mList[mission_num].services[service_num].output[2] = pChild1->Attribute("output3"); |
1132 | | } |
1133 | | |
1134 | | mList[mission_num].services[conditional_0].num_conds = cond_array[0]; |
1135 | | cond_array[0] = 0; |
1136 | | service_num++; |
1137 | | } |
1138 | | //for(int i = 0; i < service_num; i++) |
1139 | | //printf("%d, input1=%s, output1=%s\n", i, mList[mission_num].services[i].input[0].c_str(), mList[mission_num].services[i].output[0].c_str()); |
1140 | | |
1141 | | mList[mission_num].numServices = service_num; |
1142 | | mList[mission_num].name = pChild0->Attribute("name"); |
1143 | | mList[mission_num].missionID = atoi(pChild0->Attribute("id")); |
1144 | | if(pChild0->Attribute("input1")) |
1145 | | mList[mission_num].input[0] = pChild0->Attribute("input1"); |
1146 | | if(pChild0->Attribute("input2")) |
1147 | | mList[mission_num].input[1] = pChild0->Attribute("input2"); |
1148 | | if(pChild0->Attribute("input3")) |
1149 | | mList[mission_num].input[2] = pChild0->Attribute("input3"); |
1150 | | if(pChild0->Attribute("output1")) |
1151 | | mList[mission_num].output[0] = pChild0->Attribute("output1"); |
1152 | | if(pChild0->Attribute("output2")) |
1153 | | mList[mission_num].output[1] = pChild0->Attribute("output2"); |
1154 | | if(pChild0->Attribute("output3")) |
1155 | | mList[mission_num].output[2] = pChild0->Attribute("output3"); |
1156 | | //printf("mis, input1=%s, output1=%s\n", mList[mission_num].input[0].c_str(), mList[mission_num].output[0].c_str()); |
1157 | | mission_num++; |
1158 | | } |
1159 | | } |
1160 | | |
1161 | | /* CALLED BY: MessageHandler |
1162 | | * INPUTS: |ID| The ID number of the engine to be registered |
1163 | | * OUTPUTS: <none> |
1164 | | * |
1165 | | * DESCRIPTION: Sends a registration message onto the shell and sends the ACK back to the component |
1166 | | */ |
1167 | | void |
1168 | | ServiceManagementLayer::RegisterCognitiveEngine(int32_t ID) |
1169 | | { |
1170 | | //LOG("SML::regcogeng"); |
1171 | | SendMessage(shellSocketFD, "register_engine_cognitive"); |
1172 | | |
1173 | | // printf("SSFD = %d\n", shellSocketFD); |
1174 | | LOG("ServiceManagementLayer:: CE registration message forwarded to shell.\n"); |
1175 | | char buffer[256]; |
1176 | | memset(buffer, 0, 256); |
1177 | | ReadMessage(shellSocketFD, buffer); |
1178 | | //printf("ServiceManagementLayer::buffer = %s\n", buffer); |
1179 | | SendMessage(CE_List[ID].FD, buffer); |
1180 | | |
1181 | | TransferRadioConfiguration(ID); |
1182 | | memset(buffer, 0, 256); |
1183 | | //printf("start trans exp\n"); |
1184 | | TransferExperience(ID); |
1185 | | memset(buffer, 0, 256); |
1186 | | numberOfCognitiveEngines++; |
1187 | | CE_Present = true; |
1188 | | //printf("done registering CE!\n"); |
1189 | | } |
1190 | | |
1191 | | /* CALLED BY: MessageHandler |
1192 | | * INPUTS: |ID| The ID number of the engine to have it's services deregistered |
1193 | | * OUTPUTS: <none> |
1194 | | * |
1195 | | * DESCRIPTION: Deletes individual services from the DB |
1196 | | * NOTE THAT this function only needs to be called if service deregistration is going |
1197 | | * to be done at a different time than component deregistration; it is handled |
1198 | | * more efficiently and directly during that deregistration process. |
1199 | | */ |
1200 | | void |
1201 | | ServiceManagementLayer::DeregisterServices(int32_t ID) |
1202 | | { |
1203 | | char buffer[256]; |
1204 | | memset(buffer, 0, 256); |
1205 | | ReadMessage(CE_List[ID].FD, buffer); |
1206 | | strcpy(_services_DB->command, "DELETE FROM "); |
1207 | | strcat(_services_DB->command, _services_DB->tablename); |
1208 | | strcat(_services_DB->command, " WHERE ID_Num IN (SELECT"); |
1209 | | sprintf(_services_DB->command, " %s %d",_services_DB->command, ID); |
1210 | | strcat(_services_DB->command, " FROM "); |
1211 | | strcat(_services_DB->command, _services_DB->tablename); |
1212 | | strcat(_services_DB->command, " WHERE Service_Name"); |
1213 | | strcat(_services_DB->command, "=="); |
1214 | | sprintf(_services_DB->command, "%s'%s');", _services_DB->command, buffer); |
1215 | | char *errorMsg; |
1216 | | int rc = sqlite3_exec(_services_DB->db, _services_DB->command, callback, 0, &errorMsg); |
1217 | | if( rc!=SQLITE_OK && rc!=101 ) |
1218 | | fprintf(stderr, "SQL error: %s\n", errorMsg); |
1219 | | } |
1220 | | |
1221 | | /* CALLED BY: MessageHandler |
1222 | | * INPUTS: |ID| The ID number of the engine to have it's services deregistered |
1223 | | * OUTPUTS: <none> |
1224 | | * |
1225 | | * DESCRIPTION: Deletes the contact info for the cognitive engine, forwards a deregistration message to the shell |
1226 | | * Also, deletes the services from the DB |
1227 | | */ |
1228 | | void |
1229 | | ServiceManagementLayer::DeregisterCognitiveEngine(int32_t ID) |
1230 | | { |
1231 | | LOG("ServiceManagementLayer:: CE deregistration message forwarded to shell.\n"); |
1232 | | |
1233 | | numberOfCognitiveEngines--; |
1234 | | if(numberOfCognitiveEngines == 0) |
1235 | | CE_Present = false; |
1236 | | |
1237 | | SendMessage(shellSocketFD, "deregister_engine_cognitive"); |
1238 | | char buffer[256]; |
1239 | | memset(buffer, 0, 256); |
1240 | | ReadMessage(shellSocketFD, buffer); |
1241 | | SendMessage(CE_List[ID].FD, buffer); |
1242 | | if(strcmp("deregister_ack", buffer) != 0) { |
1243 | | ERROR(1, "SML:: Failed to close CE socket\n"); |
1244 | | } |
1245 | | |
1246 | | //Deregister the services |
1247 | | strcpy(_services_DB->command, "DELETE FROM "); |
1248 | | strcat(_services_DB->command, _services_DB->tablename); |
1249 | | strcat(_services_DB->command, " WHERE "); |
1250 | | strcat(_services_DB->command, "ID_Num"); |
1251 | | strcat(_services_DB->command, "=="); |
1252 | | sprintf(_services_DB->command, "%s%d;", _services_DB->command, ID); |
1253 | | char *errorMsg; |
1254 | | int rc = sqlite3_exec(_services_DB->db, _services_DB->command, callback, 0, &errorMsg); |
1255 | | if( rc!=SQLITE_OK && rc!=101 ) |
1256 | | fprintf(stderr, "SQL error: %s\n", errorMsg); |
1257 | | |
1258 | | |
1259 | | CE_List[ID].FD = -1; |
1260 | | CE_List[ID].ID_num = -1; |
1261 | | |
1262 | | LOG("Cognitive Radio Shell:: CE Socket closed for engine #%d.\n", ID); |
1263 | | } |
1264 | | |
1265 | | |
1266 | | /* CALLED BY: test class |
1267 | | * INPUTS: <none> |
1268 | | * OUTPUTS: <none> |
1269 | | * |
1270 | | * DESCRIPTION: Sets up a server socket and listens for communication on either that or the shell socket |
1271 | | */ |
1272 | | void |
1273 | | ServiceManagementLayer::StartSMLServer() |
1274 | | { |
1275 | | //printf("Ready for CE Signal! (registration done)\n"); |
1276 | | struct timeval selTimeout; |
1277 | | int32_t running = 1; |
1278 | | int32_t port, rc, new_sd = 1; |
1279 | | int32_t desc_ready = 1; |
1280 | | int32_t timeout = 10; |
1281 | | //If there is, call the MessageHandler with the Shell_Msg code of -1 |
1282 | | fd_set sockSet, shellSet; |
1283 | | |
1284 | | cogEngSrv = CreateTCPServerSocket(SMLport); |
1285 | | int32_t maxDescriptor = cogEngSrv; |
1286 | | |
1287 | | if(InitializeTCPServerPort(cogEngSrv) == -1) |
1288 | | ERROR(1,"Error initializing primary port\n"); |
1289 | | |
1290 | | int i = 10000000; //TODO change to "running" if endpoint can be reached |
1291 | | while (running) { |
1292 | | i--; |
1293 | | /* Zero socket descriptor vector and set for server sockets */ |
1294 | | /* This must be reset every time select() is called */ |
1295 | | FD_ZERO(&sockSet); |
1296 | | FD_SET(cogEngSrv, &sockSet); |
1297 | | for(int k = 0; k < Current_ID; k++){ |
1298 | | if(CE_List[k].ID_num != -1) |
1299 | | FD_SET(CE_List[k].FD, &sockSet); |
1300 | | } |
1301 | | //printf("k=%d, CID=%d\n", k, CE_List[k].FD); |
1302 | | |
1303 | | /* Timeout specification */ |
1304 | | /* This must be reset every time select() is called */ |
1305 | | selTimeout.tv_sec = 0; /* timeout (secs.) */ |
1306 | | selTimeout.tv_usec = 0; /* 0 microseconds */ |
1307 | | //Changed both to zero so that select will check messages from the shell instead of blocking |
1308 | | //when there is no command from the CE's to be processed |
1309 | | |
1310 | | //Check if there is a message on the socket waiting to be read |
1311 | | rc = select(maxDescriptor + 1, &sockSet, NULL, NULL, &selTimeout); |
1312 | | //printf("rc=%d\n", rc); |
1313 | | if(rc == 0){ |
1314 | | //LOG("No echo requests for %i secs...Server still alive\n", timeout); |
1315 | | |
1316 | | FD_ZERO(&shellSet); |
1317 | | FD_SET(shellSocketFD, &shellSet); |
1318 | | selTimeout.tv_sec = 0; |
1319 | | selTimeout.tv_usec = 0; |
1320 | | //Check if there is a message on the shell socket ready to be processed |
1321 | | int rc2 = select(shellSocketFD + 1, &shellSet, NULL, NULL, &selTimeout); |
1322 | | //printf("rc2=%d\n", rc2); |
1323 | | //If there is, call the MessageHandler with the Shell_Msg code of -1 |
1324 | | if(FD_ISSET(shellSocketFD, &shellSet)){ |
1325 | | //printf("shell_msg, %d\n", rc2); |
1326 | | MessageHandler(-1);} |
1327 | | } |
1328 | | else { |
1329 | | desc_ready = rc; |
1330 | | for(port = 0; port <= maxDescriptor && desc_ready > 0; port++) { |
1331 | | if(FD_ISSET(port, &sockSet)) { |
1332 | | desc_ready -= 1; |
1333 | | |
1334 | | //Check if request is new or on an existing open descriptor |
1335 | | if(port == cogEngSrv) { |
1336 | | //If new, assign it a descriptor and give it an ID |
1337 | | new_sd = AcceptTCPConnection(port); |
1338 | | |
1339 | | if(new_sd < 0) |
1340 | | break; |
1341 | | |
1342 | | CE_List[Current_ID].FD = new_sd; |
1343 | | CE_List[Current_ID].ID_num = Current_ID; |
1344 | | MessageHandler(Current_ID); |
1345 | | Current_ID++; |
1346 | | |
1347 | | FD_SET(new_sd,&sockSet); |
1348 | | if(new_sd > maxDescriptor) |
1349 | | maxDescriptor = new_sd; |
1350 | | } |
1351 | | else { |
1352 | | //If old, figure out which ID it coresponds to and handle it accordingly |
1353 | | for(int16_t z = 0; z < Current_ID; z++) |
1354 | | { |
1355 | | if(CE_List[z].FD == port){ |
1356 | | MessageHandler(z);} |
1357 | | } |
1358 | | } |
1359 | | } |
1360 | | } |
1361 | | } |
1362 | | } |
1363 | | |
1364 | | /* Close sockets */ |
1365 | | close(cogEngSrv); |
1366 | | |
1367 | | //delete &cogEngSrv; |
1368 | | return; |
1369 | | } |
1370 | | |
1371 | | |
1372 | | |
1373 | | |
1374 | | /*TiXmlElement *pMission; |
1375 | | TiXmlElement *pService; |
1376 | | TiXmlElement *pChild0, *pChild1, *pChild2, *pChild3; |
1377 | | TiXmlHandle hRoot(0); |
1378 | | //printf("ServiceManagementLayer:: Loading Configuration.\n"); |
1379 | | TiXmlDocument doc("."); |
1380 | | doc.LoadFile(SML_Config); |
1381 | | bool loadOkay = doc.LoadFile(); |
1382 | | if(!loadOkay) |
1383 | | printf("Loading SML configuration failed: %s\n", SML_Config); |
1384 | | |
1385 | | TiXmlHandle hDoc(&doc); |
1386 | | |
1387 | | pMission = hDoc.FirstChildElement().Element(); |
1388 | | |
1389 | | if(!pMission) |
1390 | | printf("No valid root!"); |
1391 | | |
1392 | | hRoot = TiXmlHandle(pMission); |
1393 | | pService = pMission->FirstChildElement(); |
1394 | | int32_t mission_num = 0; |
1395 | | //Iterate through the missions |
1396 | | for(pChild0 = pMission->FirstChildElement(); pChild0 ; \ |
1397 | | pChild0 = pChild0->NextSiblingElement()) |
1398 | | { |
1399 | | int32_t service_num = 0; |
1400 | | uint16_t cond_array[] = {0, 0}; |
1401 | | //printf("mission_num = %d\n", mission_num); |
1402 | | memset(cond_array, 0, 2); |
1403 | | |
1404 | | for(pChild1 = pChild0->FirstChildElement(); pChild1; \ |
1405 | | pChild1 = pChild1->NextSiblingElement()) |
1406 | | { |
1407 | | int32_t conditional_0 = service_num; |
1408 | | for(pChild2 = pChild1->FirstChildElement(); \ |
1409 | | pChild2; pChild2 = pChild2->NextSiblingElement()) |
1410 | | { |
1411 | | service_num++; |
1412 | | int32_t conditional_1 = service_num; |
1413 | | for(pChild3 = pChild2->FirstChildElement(); \ |
1414 | | pChild3; pChild3 = pChild3 ->NextSiblingElement()) |
1415 | | { |
1416 | | service_num++; |
1417 | | mList[mission_num].services[service_num].name = pChild3->Attribute("name"); |
1418 | | if(pChild3->Attribute("input1")) |
1419 | | mList[mission_num].services[service_num].input[0] = pChild3->Attribute("input1"); |
1420 | | if(pChild3->Attribute("input2")) |
1421 | | mList[mission_num].services[service_num].input[1] = pChild3->Attribute("input2"); |
1422 | | if(pChild3->Attribute("input3")) |
1423 | | mList[mission_num].services[service_num].input[2] = pChild3->Attribute("input3"); |
1424 | | if(pChild3->Attribute("output1")) |
1425 | | mList[mission_num].services[service_num].output[0] = pChild3->Attribute("output1"); |
1426 | | if(pChild3->Attribute("output2")) |
1427 | | mList[mission_num].services[service_num].output[1] = pChild3->Attribute("output2"); |
1428 | | if(pChild3->Attribute("output3")) |
1429 | | mList[mission_num].services[service_num].output[2] = pChild3->Attribute("output3"); |
1430 | | cond_array[1]++; |
1431 | | } |
1432 | | |
1433 | | if(conditional_1 != service_num){ |
1434 | | mList[mission_num].services[conditional_1].name = pChild2->Value(); |
1435 | | if(pChild2->Attribute("input_t")) |
1436 | | mList[mission_num].services[conditional_1].input[0] = pChild2->Attribute("input_t"); |
1437 | | if(pChild2->Attribute("input_f")) |
1438 | | mList[mission_num].services[conditional_1].input[1] = pChild2->Attribute("input_f"); |
1439 | | } |
1440 | | else{ |