00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020
00021
00022
00023
00024
00025
00026
00027
00028
00029
00030
00031
00032
00033
00034
00035
00036
00037
00038
00039
00040
00041
00042
00043
00044
00045
00046
00047
00048
00049
00050
00051
00052
00053
00054 #include "config.h"
00055 #ifdef HAVE_STL
00056 #include "routealgo/bfs.h"
00057 #include "routealgo/routealgo.h"
00058 #include "routealgo/rnode.h"
00059 #include "routealgo/tnode.h"
00060 #include "routealgo/rbitmap.h"
00061 #include <stdio.h>
00062
00063 #ifndef TEST_BFS
00064
00065 void BFS(
00066 RNodeVec_t& N,
00067 nodeid_t root,
00068 RoutingVec_t& NextHop,
00069 RoutingVec_t& Parent)
00070 {
00071 BitMap B(N.size());
00072 RNodeDeq_t Q;
00073 DistVec_t D;
00074
00075
00076 NextHop.erase(NextHop.begin(), NextHop.end());
00077 Parent.erase(Parent.begin(), Parent.end());
00078 for (unsigned int i = 0; i < N.size(); i++)
00079 {
00080 NextHop.push_back(NODE_NONE);
00081 Parent.push_back(NODE_NONE);
00082 D.push_back(INF);
00083
00084 NodeWeight_t v(NODE_NONE, INF);
00085 if(0)printf("Printing adj for node %ld (addr %p)\n", N[i]->m_id, N[i]);
00086 if(0)while(1)
00087 {
00088 v = N[i]->NextAdj(v);
00089 if (v.first == NODE_NONE) break;
00090 if(0)printf("Found adj %ld\n", v.first);
00091 }
00092 }
00093 B.Set(root);
00094 if(0)B.DBPrint();
00095 Q.push_back(N[root]);
00096 D[root] = 0;
00097 while(Q.size() != 0)
00098 {
00099 RNodeDeq_it it = Q.begin();
00100 NodeWeight_t v(NODE_NONE, INF);
00101 RNode* u = *it;
00102 if(0)printf("Working on node %ld addr %p\n", u->m_id, u);
00103 while(1)
00104 {
00105 v = u->NextAdj(v);
00106 if (v.first == NODE_NONE) break;
00107 if(0)printf("Found adj %ld\n", v.first);
00108 if (B.Get(v.first) == 0)
00109 {
00110 Q.push_back(N[v.first]);
00111 B.Set(v.first);
00112 D[v.first] = D[u->m_id] + 1;
00113 Parent[v.first] = u->m_id;
00114 if (u->m_id == root)
00115 {
00116 NextHop[v.first] = v.first;
00117 }
00118 else
00119 {
00120 NextHop[v.first] = NextHop[u->m_id];
00121 }
00122 if(0)printf("Enqueued %ld\n", v.first);
00123 }
00124 }
00125 Q.pop_front();
00126 }
00127 }
00128 #endif
00129
00130 #ifdef TEST_BFS
00131 RNodeVec_t Nodes;
00132
00133 int main()
00134 {
00135
00136 Node N0(0);
00137 Node N1(1);
00138 Node N2(2);
00139 Node N3(3);
00140 Node N4(4);
00141 Node N5(5);
00142 Node N6(6);
00143 Node N7(7);
00144 RoutingVec_t NextHop;
00145 RoutingVec_t Parent;
00146
00147 N0.AddAdj(1);
00148 N0.AddAdj(2);
00149
00150 N1.AddAdj(0);
00151
00152 N2.AddAdj(0);
00153 N2.AddAdj(3);
00154
00155 N3.AddAdj(2);
00156 N3.AddAdj(4);
00157 N3.AddAdj(5);
00158
00159 N4.AddAdj(3);
00160 N4.AddAdj(5);
00161 N4.AddAdj(6);
00162
00163 N5.AddAdj(4);
00164 N5.AddAdj(7);
00165
00166 N6.AddAdj(4);
00167 N6.AddAdj(7);
00168
00169 N7.AddAdj(5);
00170 N7.AddAdj(6);
00171
00172 Nodes.push_back(&N0);
00173 Nodes.push_back(&N1);
00174 Nodes.push_back(&N2);
00175 Nodes.push_back(&N3);
00176 Nodes.push_back(&N4);
00177 Nodes.push_back(&N5);
00178 Nodes.push_back(&N6);
00179 Nodes.push_back(&N7);
00180
00181 for (nodeid_t i = 0; i < Nodes.size(); i++)
00182 {
00183 printf("\nFrom root %ld\n", i);
00184 BFS(Nodes, i, NextHop, Parent);
00185 PrintParents(Parent);
00186 for (unsigned int k = 0; k < Nodes.size(); k++)
00187 printf("Next hop for node %d is %ld\n", k, NextHop[k]);
00188 printf("Printing paths\n");
00189 for (nodeid_t j = 0; j < Nodes.size(); j++)
00190 {
00191 PrintRoute(i, j, Parent);
00192 }
00193 }
00194 return(0);
00195 }
00196 #endif
00197
00198 #endif //HAVE_STL