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
00055
00056
00057
00058
00059 #include "ping.h"
00060
00061 int hdr_ping::offset_;
00062 static class PingHeaderClass : public PacketHeaderClass {
00063 public:
00064 PingHeaderClass() : PacketHeaderClass("PacketHeader/Ping",
00065 sizeof(hdr_ping)) {
00066 bind_offset(&hdr_ping::offset_);
00067 }
00068 } class_pinghdr;
00069
00070
00071 static class PingClass : public TclClass {
00072 public:
00073 PingClass() : TclClass("Agent/Ping") {}
00074 TclObject* create(int, const char*const*) {
00075 return (new PingAgent());
00076 }
00077 } class_ping;
00078
00079
00080 PingAgent::PingAgent() : Agent(PT_PING), seq(0), oneway(0)
00081 {
00082 bind("packetSize_", &size_);
00083 }
00084
00085 int PingAgent::command(int argc, const char*const* argv)
00086 {
00087 if (argc == 2) {
00088 if (strcmp(argv[1], "send") == 0) {
00089
00090 Packet* pkt = allocpkt();
00091
00092 hdr_ping* hdr = hdr_ping::access(pkt);
00093
00094
00095 hdr->ret = 0;
00096 hdr->seq = seq++;
00097
00098 hdr->send_time = Scheduler::instance().clock();
00099
00100 send(pkt, 0);
00101
00102
00103 return (TCL_OK);
00104
00105 }
00106
00107 else if (strcmp(argv[1], "start-WL-brdcast") == 0) {
00108 Packet* pkt = allocpkt();
00109
00110 hdr_ip* iph = HDR_IP(pkt);
00111 hdr_ping* ph = hdr_ping::access(pkt);
00112
00113 iph->daddr() = IP_BROADCAST;
00114 iph->dport() = iph->sport();
00115 ph->ret = 0;
00116 send(pkt, (Handler*) 0);
00117 return (TCL_OK);
00118 }
00119
00120 else if (strcmp(argv[1], "oneway") == 0) {
00121 oneway=1;
00122 return (TCL_OK);
00123 }
00124 }
00125
00126
00127
00128 return (Agent::command(argc, argv));
00129 }
00130
00131
00132 void PingAgent::recv(Packet* pkt, Handler*)
00133 {
00134
00135 hdr_ip* hdrip = hdr_ip::access(pkt);
00136
00137
00138 hdr_ping* hdr = hdr_ping::access(pkt);
00139
00140
00141
00142 if ((u_int32_t)hdrip->daddr() == IP_BROADCAST) {
00143 if (hdr->ret == 0) {
00144
00145 printf("Recv BRDCAST Ping REQ : at %d.%d from %d.%d\n", here_.addr_, here_.port_, hdrip->saddr(), hdrip->sport());
00146 Packet::free(pkt);
00147
00148
00149 Packet* pktret = allocpkt();
00150
00151 hdr_ping* hdrret = hdr_ping::access(pktret);
00152 hdr_ip* ipret = hdr_ip::access(pktret);
00153
00154 hdrret->ret = 1;
00155
00156
00157 ipret->daddr() = IP_BROADCAST;
00158 ipret->dport() = ipret->sport();
00159
00160 send(pktret, 0);
00161
00162 } else {
00163 printf("Recv BRDCAST Ping REPLY : at %d.%d from %d.%d\n", here_.addr_, here_.port_, hdrip->saddr(), hdrip->sport());
00164 Packet::free(pkt);
00165 }
00166 return;
00167 }
00168
00169 if (hdr->ret == 0) {
00170
00171 double stime = hdr->send_time;
00172 int rcv_seq = hdr->seq;
00173
00174 Packet::free(pkt);
00175
00176 Packet* pktret = allocpkt();
00177
00178 hdr_ping* hdrret = hdr_ping::access(pktret);
00179
00180
00181 hdrret->ret = 1;
00182
00183 hdrret->send_time = stime;
00184
00185 hdrret->rcv_time = Scheduler::instance().clock();
00186 hdrret->seq = rcv_seq;
00187
00188 send(pktret, 0);
00189 } else {
00190
00191
00192
00193
00194
00195 char out[100];
00196
00197
00198 if (oneway)
00199 sprintf(out, "%s recv %d %d %3.1f %3.1f", name(),
00200 hdrip->src_.addr_ >> Address::instance().NodeShift_[1],
00201 hdr->seq, (hdr->rcv_time - hdr->send_time) * 1000,
00202 (Scheduler::instance().clock()-hdr->rcv_time) * 1000);
00203 else sprintf(out, "%s recv %d %3.1f", name(),
00204 hdrip->src_.addr_ >> Address::instance().NodeShift_[1],
00205 (Scheduler::instance().clock()-hdr->send_time) * 1000);
00206 Tcl& tcl = Tcl::instance();
00207 tcl.eval(out);
00208
00209 Packet::free(pkt);
00210 }
00211 }
00212
00213