1 | #define _POSIX_C_SOURCE 199309 |
1 | #if defined(__linux) || defined(__FreeBSD__) || defined(__OpenBSD__) || defined(__NetBSD__) || defined(__CYGWIN__) |
2 | #define _GNU_SOURCE 1 |
|
|
3 | |
|
|
4 | #define IPV6 1 // if you get compilation problems try to disable IPv6 |
2 | # define ENABLE_IPV6 1 // if you get compilation problems try to disable IPv6 |
|
|
3 | #else |
|
|
4 | # define ENABLE_IPV6 0 |
|
|
5 | #endif |
5 | |
6 | |
6 | #include "EXTERN.h" |
7 | #include "EXTERN.h" |
7 | #include "perl.h" |
8 | #include "perl.h" |
8 | #include "XSUB.h" |
9 | #include "XSUB.h" |
9 | |
10 | |
10 | #include <pthread.h> |
11 | #include <pthread.h> |
11 | |
12 | |
12 | #include <math.h> |
|
|
13 | #include <stdio.h> |
13 | #include <stdio.h> |
14 | #include <stdlib.h> |
14 | #include <stdlib.h> |
15 | #include <string.h> |
15 | #include <string.h> |
16 | |
16 | |
17 | #include <time.h> |
17 | #include <time.h> |
18 | #include <poll.h> |
18 | #include <poll.h> |
19 | #include <unistd.h> |
19 | #include <unistd.h> |
20 | #include <inttypes.h> |
20 | #include <inttypes.h> |
21 | #include <fcntl.h> |
21 | #include <fcntl.h> |
22 | #include <errno.h> |
22 | #include <errno.h> |
|
|
23 | #include <limits.h> |
23 | |
24 | |
24 | #include <sys/types.h> |
25 | #include <sys/types.h> |
25 | #include <sys/time.h> |
26 | #include <sys/time.h> |
26 | #include <sys/socket.h> |
27 | #include <sys/socket.h> |
27 | |
28 | |
… | |
… | |
29 | #include <arpa/inet.h> |
30 | #include <arpa/inet.h> |
30 | |
31 | |
31 | #ifdef __linux |
32 | #ifdef __linux |
32 | # include <linux/icmp.h> |
33 | # include <linux/icmp.h> |
33 | #endif |
34 | #endif |
34 | #if IPV6 |
35 | #if ENABLE_IPV6 && !defined (__CYGWIN__) |
35 | # include <netinet/icmp6.h> |
36 | # include <netinet/icmp6.h> |
36 | #endif |
37 | #endif |
37 | |
38 | |
38 | #define ICMP4_ECHO 8 |
39 | #define ICMP4_ECHO 8 |
39 | #define ICMP4_ECHO_REPLY 0 |
40 | #define ICMP4_ECHO_REPLY 0 |
40 | #define ICMP6_ECHO 128 |
41 | #define ICMP6_ECHO 128 |
41 | #define ICMP6_ECHO_REPLY 129 |
42 | #define ICMP6_ECHO_REPLY 129 |
42 | |
43 | |
43 | #define DRAIN_INTERVAL .000001 // how long to wait when sendto returns ENOBUFS, in seconds |
44 | #define DRAIN_INTERVAL 1e-6 // how long to wait when sendto returns ENOBUFS, in seconds |
44 | #define MIN_INTERVAL .000001 // minimum packet send interval, in seconds |
45 | #define MIN_INTERVAL 1e-6 // minimum packet send interval, in seconds |
45 | |
46 | |
46 | #define HDR_SIZE_IP4 20 |
47 | #define HDR_SIZE_IP4 20 |
47 | #define HDR_SIZE_IP6 48 |
48 | #define HDR_SIZE_IP6 48 |
48 | |
49 | |
49 | //TODO: xread/xwrite for atomicity? we currently rely on the fact that the pip biffersize divides exactly by pointer sizes |
50 | static int thr_res[2]; // worker thread finished status |
|
|
51 | static int icmp4_fd = -1; |
|
|
52 | static int icmp6_fd = -1; |
50 | |
53 | |
51 | typedef uint8_t addr_t[16]; |
54 | /*****************************************************************************/ |
52 | |
55 | |
53 | typedef double tstamp; |
56 | typedef double tstamp; |
54 | |
57 | |
55 | tstamp |
58 | static tstamp |
56 | NOW () |
59 | NOW (void) |
57 | { |
60 | { |
58 | struct timeval tv; |
61 | struct timeval tv; |
|
|
62 | |
59 | gettimeofday (&tv, 0); |
63 | gettimeofday (&tv, 0); |
|
|
64 | |
60 | return tv.tv_sec + tv.tv_usec * 0.000001; |
65 | return tv.tv_sec + tv.tv_usec * 1e-6; |
61 | } |
66 | } |
62 | |
67 | |
|
|
68 | static void |
|
|
69 | ssleep (tstamp wait) |
|
|
70 | { |
|
|
71 | #if defined (__SVR4) && defined (__sun) |
|
|
72 | struct timeval tv; |
|
|
73 | |
|
|
74 | tv.tv_sec = wait; |
|
|
75 | tv.tv_usec = (wait - tv.tv_sec) * 1e6; |
|
|
76 | |
|
|
77 | select (0, 0, 0, 0, &tv); |
|
|
78 | #elif defined(_WIN32) |
|
|
79 | Sleep ((unsigned long)(delay * 1e3)); |
|
|
80 | #else |
|
|
81 | struct timespec ts; |
|
|
82 | |
|
|
83 | ts.tv_sec = wait; |
|
|
84 | ts.tv_nsec = (wait - ts.tv_sec) * 1e9; |
|
|
85 | |
|
|
86 | nanosleep (&ts, 0); |
|
|
87 | #endif |
|
|
88 | } |
|
|
89 | |
|
|
90 | /*****************************************************************************/ |
|
|
91 | |
63 | typedef struct { |
92 | typedef struct |
64 | int family; |
93 | { |
65 | addr_t lo, hi; |
|
|
66 | double interval; |
|
|
67 | tstamp next; |
|
|
68 | } RANGE; |
|
|
69 | |
|
|
70 | typedef struct { |
|
|
71 | SV *id; |
|
|
72 | double interval; |
|
|
73 | int nranges; |
|
|
74 | RANGE *ranges; |
|
|
75 | uint32_t payload; |
|
|
76 | } REQ; |
|
|
77 | |
|
|
78 | typedef struct { |
|
|
79 | uint8_t version_ihl; |
94 | uint8_t version_ihl; |
80 | uint8_t tos; |
95 | uint8_t tos; |
81 | uint16_t tot_len; |
96 | uint16_t tot_len; |
82 | |
97 | |
83 | uint16_t id; |
98 | uint16_t id; |
… | |
… | |
89 | |
104 | |
90 | uint32_t src; |
105 | uint32_t src; |
91 | uint32_t dst; |
106 | uint32_t dst; |
92 | } IP4HDR; |
107 | } IP4HDR; |
93 | |
108 | |
|
|
109 | /*****************************************************************************/ |
|
|
110 | |
|
|
111 | typedef uint8_t addr_tt[16]; |
|
|
112 | |
94 | typedef struct { |
113 | typedef struct |
95 | uint8_t version; |
114 | { |
96 | uint8_t x1, x2, x3; |
115 | tstamp next; |
|
|
116 | tstamp interval; |
|
|
117 | int addrlen; |
97 | |
118 | |
98 | uint16_t payload_len; |
119 | addr_tt lo, hi; /* only if !addrcnt */ |
99 | uint8_t nxt_hdr; |
|
|
100 | uint8_t hop_limit; |
|
|
101 | |
120 | |
102 | uint8_t src[16]; |
121 | int addrcnt; |
103 | uint8_t dst[16]; |
122 | /* addrcnt addresses follow */ |
104 | } IP6HDR; |
123 | } RANGE; |
105 | |
124 | |
106 | #define MAGIC 0xca4c |
|
|
107 | |
|
|
108 | static uint16_t magic; |
|
|
109 | |
|
|
110 | typedef struct { |
125 | typedef struct |
|
|
126 | { |
|
|
127 | RANGE **ranges; |
|
|
128 | int rangecnt, rangemax; |
|
|
129 | |
|
|
130 | tstamp next; |
|
|
131 | tstamp interval; |
|
|
132 | |
|
|
133 | tstamp maxrtt; |
|
|
134 | |
|
|
135 | uint16_t magic1; |
|
|
136 | uint16_t magic2; |
|
|
137 | uint16_t magic3; |
|
|
138 | |
|
|
139 | int id; |
|
|
140 | |
|
|
141 | AV *recvq; /* receive queue */ |
|
|
142 | int nextrecv; |
|
|
143 | SV *recvcb; |
|
|
144 | |
|
|
145 | pthread_t thrid; |
|
|
146 | int running; |
|
|
147 | } PINGER; |
|
|
148 | |
|
|
149 | static PINGER **pingers; |
|
|
150 | static int *pingerfree; /* freelist next */ |
|
|
151 | static int pingercnt; |
|
|
152 | static int pingermax; |
|
|
153 | static int firstfree = -1; |
|
|
154 | static int firstrecv = -1; |
|
|
155 | |
|
|
156 | /*****************************************************************************/ |
|
|
157 | |
|
|
158 | typedef struct |
|
|
159 | { |
111 | uint8_t type, code; |
160 | uint8_t type, code; |
112 | uint16_t cksum; |
161 | uint16_t cksum; |
|
|
162 | |
113 | uint16_t id, seq; |
163 | uint16_t id, seq; |
|
|
164 | |
|
|
165 | uint16_t pinger; |
|
|
166 | uint16_t magic; |
|
|
167 | |
|
|
168 | uint32_t stamp_hi; |
114 | uint32_t payload; |
169 | uint32_t stamp_lo; |
115 | tstamp stamp; // be careful when accessing this |
|
|
116 | } PKT; |
170 | } PKT; |
117 | |
171 | |
118 | static pthread_t pthrid; |
|
|
119 | static int thr_send[2]; // send to worker |
|
|
120 | static int thr_recv[2]; // receive from worker |
|
|
121 | |
|
|
122 | static int icmp4_fd, icmp6_fd; |
|
|
123 | |
|
|
124 | static AV *cbs; |
|
|
125 | |
|
|
126 | static uint16_t |
172 | static int |
127 | icmp_cksum (void *data, unsigned int len) |
173 | pkt_is_valid_for (PKT *pkt, PINGER *pinger) |
128 | { |
174 | { |
129 | register int sum = 0; |
175 | return pkt->id == pinger->magic1 |
130 | uint16_t *wp; |
176 | && pkt->seq == pinger->magic2 |
|
|
177 | && pkt->magic == pinger->magic3; |
|
|
178 | } |
131 | |
179 | |
132 | assert (~len & 1); |
180 | static void |
|
|
181 | ts_to_pkt (PKT *pkt, tstamp ts) |
|
|
182 | { |
|
|
183 | /* move 12 bits of seconds into the 32 bit fractional part */ |
|
|
184 | /* leaving 20 bits subsecond resolution and 44 bits of integers */ |
|
|
185 | /* (of which 32 are typically usable) */ |
|
|
186 | ts *= 1. / 4096.; |
133 | |
187 | |
134 | for (wp = (uint16_t *)data; len; wp++, len -= 2) |
188 | pkt->stamp_hi = ts; |
135 | sum += *wp; |
189 | pkt->stamp_lo = (ts - pkt->stamp_hi) * 4294967296.; |
|
|
190 | } |
|
|
191 | |
|
|
192 | static tstamp |
|
|
193 | pkt_to_ts (PKT *pkt) |
|
|
194 | { |
|
|
195 | return pkt->stamp_hi * 4096. |
|
|
196 | + pkt->stamp_lo * (4096. / 4294967296.); |
|
|
197 | } |
|
|
198 | |
|
|
199 | static void |
|
|
200 | pkt_cksum (PKT *pkt) |
|
|
201 | { |
|
|
202 | uint_fast32_t sum = 0; |
|
|
203 | uint32_t *wp = (uint32_t *)pkt; |
|
|
204 | int len = sizeof (*pkt) / 4; |
|
|
205 | |
|
|
206 | do |
|
|
207 | { |
|
|
208 | uint_fast32_t w = *(volatile uint32_t *)wp++; |
|
|
209 | sum += (w & 0xffff) + (w >> 16); |
|
|
210 | } |
|
|
211 | while (--len); |
136 | |
212 | |
137 | sum = (sum >> 16) + (sum & 0xffff); /* add high 16 to low 16 */ |
213 | sum = (sum >> 16) + (sum & 0xffff); /* add high 16 to low 16 */ |
138 | sum += sum >> 16; /* add carry */ |
214 | sum += sum >> 16; /* add carry */ |
139 | |
215 | |
|
|
216 | pkt->cksum = ~sum; |
|
|
217 | } |
|
|
218 | |
|
|
219 | /*****************************************************************************/ |
|
|
220 | |
|
|
221 | static void |
|
|
222 | range_free (RANGE *self) |
|
|
223 | { |
|
|
224 | free (self); |
|
|
225 | } |
|
|
226 | |
|
|
227 | /* like sendto, but retries on failure */ |
|
|
228 | static void |
|
|
229 | xsendto (int fd, void *buf, size_t len, int flags, void *sa, int salen) |
|
|
230 | { |
|
|
231 | tstamp wait = DRAIN_INTERVAL / 2.; |
|
|
232 | |
|
|
233 | while (sendto (fd, buf, len, flags, sa, salen) < 0 && errno == ENOBUFS) |
|
|
234 | ssleep (wait *= 2.); |
|
|
235 | } |
|
|
236 | |
|
|
237 | // ping current address, return true and increment if more to ping |
|
|
238 | static int |
|
|
239 | range_send_ping (RANGE *self, PKT *pkt) |
|
|
240 | { |
|
|
241 | // send ping |
|
|
242 | uint8_t *addr; |
|
|
243 | int addrlen; |
|
|
244 | |
|
|
245 | if (self->addrcnt) |
|
|
246 | addr = (self->addrcnt - 1) * self->addrlen + (uint8_t *)(self + 1); |
|
|
247 | else |
|
|
248 | addr = sizeof (addr_tt) - self->addrlen + self->lo; |
|
|
249 | |
|
|
250 | addrlen = self->addrlen; |
|
|
251 | |
|
|
252 | /* convert ipv4 mapped addresses - this only works for host lists */ |
|
|
253 | /* this tries to match 0000:0000:0000:0000:0000:ffff:a.b.c.d */ |
|
|
254 | /* efficiently but also with few insns */ |
|
|
255 | if (addrlen == 16 && !addr [0] && icmp4_fd >= 0 |
|
|
256 | && !( addr [ 1] |
|
|
257 | | addr [ 2] | addr [ 3] |
|
|
258 | | addr [ 4] | addr [ 5] |
|
|
259 | | addr [ 6] | addr [ 7] |
|
|
260 | | addr [ 8] | addr [ 9] |
|
|
261 | | (255-addr [10]) | (255-addr [11]))) |
|
|
262 | { |
|
|
263 | addr += 12; |
|
|
264 | addrlen -= 12; |
|
|
265 | } |
|
|
266 | |
|
|
267 | pkt->cksum = 0; |
|
|
268 | |
|
|
269 | if (addrlen == 4) |
|
|
270 | { |
|
|
271 | struct sockaddr_in sa; |
|
|
272 | |
|
|
273 | pkt->type = ICMP4_ECHO; |
|
|
274 | pkt_cksum (pkt); |
|
|
275 | |
|
|
276 | sa.sin_family = AF_INET; |
|
|
277 | sa.sin_port = 0; |
|
|
278 | |
|
|
279 | memcpy (&sa.sin_addr, addr, sizeof (sa.sin_addr)); |
|
|
280 | |
|
|
281 | xsendto (icmp4_fd, pkt, sizeof (*pkt), 0, &sa, sizeof (sa)); |
|
|
282 | } |
|
|
283 | else |
|
|
284 | { |
|
|
285 | #if ENABLE_IPV6 |
|
|
286 | struct sockaddr_in6 sa; |
|
|
287 | |
|
|
288 | pkt->type = ICMP6_ECHO; |
|
|
289 | |
|
|
290 | sa.sin6_family = AF_INET6; |
|
|
291 | sa.sin6_port = 0; |
|
|
292 | sa.sin6_flowinfo = 0; |
|
|
293 | sa.sin6_scope_id = 0; |
|
|
294 | |
|
|
295 | memcpy (&sa.sin6_addr, addr, sizeof (sa.sin6_addr)); |
|
|
296 | |
|
|
297 | xsendto (icmp6_fd, pkt, sizeof (*pkt), 0, &sa, sizeof (sa)); |
|
|
298 | #endif |
|
|
299 | } |
|
|
300 | |
|
|
301 | // see if we have any more addresses |
|
|
302 | if (self->addrcnt) |
|
|
303 | { |
|
|
304 | if (!--self->addrcnt) |
|
|
305 | return 0; |
|
|
306 | } |
|
|
307 | else |
|
|
308 | { |
|
|
309 | if (!memcmp (&self->lo, &self->hi, sizeof (addr_tt))) |
|
|
310 | return 0; |
|
|
311 | |
|
|
312 | // increment self->lo |
|
|
313 | { |
|
|
314 | int len = sizeof (addr_tt) - 1; |
|
|
315 | |
|
|
316 | while (!++self->lo [len]) |
|
|
317 | --len; |
|
|
318 | } |
|
|
319 | } |
|
|
320 | |
140 | return ~sum; |
321 | return 1; |
141 | } |
322 | } |
142 | |
323 | |
|
|
324 | /*****************************************************************************/ |
|
|
325 | |
|
|
326 | static void |
|
|
327 | downheap (PINGER *self) |
|
|
328 | { |
|
|
329 | RANGE *elem = self->ranges [0]; /* always exists */ |
|
|
330 | int Nm1 = self->rangecnt - 1; |
|
|
331 | int j; |
|
|
332 | int k; |
|
|
333 | |
|
|
334 | for (k = 0; ; ) |
|
|
335 | { |
|
|
336 | int j = k * 2 + 1; |
|
|
337 | |
|
|
338 | if (j > Nm1) |
|
|
339 | break; |
|
|
340 | |
|
|
341 | if (j < Nm1 |
|
|
342 | && self->ranges [j]->next > self->ranges [j + 1]->next) |
|
|
343 | ++j; |
|
|
344 | |
|
|
345 | if (self->ranges [j]->next >= elem->next) |
|
|
346 | break; |
|
|
347 | |
|
|
348 | self->ranges [k] = self->ranges [j]; |
|
|
349 | |
|
|
350 | k = j; |
|
|
351 | } |
|
|
352 | |
|
|
353 | self->ranges [k] = elem; |
|
|
354 | } |
|
|
355 | |
|
|
356 | static void |
|
|
357 | upheap (PINGER *self, int k) |
|
|
358 | { |
|
|
359 | RANGE *elem = self->ranges [k]; |
|
|
360 | |
|
|
361 | while (k) |
|
|
362 | { |
|
|
363 | int j = (k - 1) >> 1; |
|
|
364 | |
|
|
365 | if (self->ranges [j]->next <= elem->next) |
|
|
366 | break; |
|
|
367 | |
|
|
368 | self->ranges [k] = self->ranges [j]; |
|
|
369 | |
|
|
370 | k = j; |
|
|
371 | } |
|
|
372 | |
|
|
373 | self->ranges [k] = elem; |
|
|
374 | } |
|
|
375 | |
143 | static void |
376 | static void * |
144 | inc_addr (addr_t *addr) |
377 | ping_proc (void *self_) |
145 | { |
378 | { |
146 | int len = sizeof (addr_t) - 1; |
379 | PINGER *self = (PINGER *)self_; |
|
|
380 | PKT pkt; |
|
|
381 | |
|
|
382 | memset (&pkt, 0, sizeof (pkt)); |
|
|
383 | |
|
|
384 | tstamp now = NOW (); |
|
|
385 | |
|
|
386 | pkt.code = 0; |
|
|
387 | pkt.id = self->magic1; |
|
|
388 | pkt.seq = self->magic2; |
|
|
389 | pkt.magic = self->magic3; |
|
|
390 | pkt.pinger = self->id; |
|
|
391 | |
|
|
392 | if (self->next < now) |
|
|
393 | self->next = now; |
|
|
394 | |
|
|
395 | while (self->rangecnt) |
|
|
396 | { |
|
|
397 | RANGE *range = self->ranges [0]; |
|
|
398 | |
|
|
399 | // ranges [0] is always the next range to ping |
|
|
400 | tstamp wait = range->next - now; |
|
|
401 | |
|
|
402 | // compare with the global frequency limit |
|
|
403 | { |
|
|
404 | tstamp diff = self->next - now; |
|
|
405 | |
|
|
406 | if (wait < diff) |
|
|
407 | wait = diff; // global rate limit overrides |
|
|
408 | else |
|
|
409 | self->next = range->next; // fast forward |
|
|
410 | } |
|
|
411 | |
|
|
412 | if (wait > 0.) |
|
|
413 | ssleep (wait); |
|
|
414 | |
|
|
415 | now = NOW (); |
|
|
416 | |
|
|
417 | ts_to_pkt (&pkt, now); |
|
|
418 | |
|
|
419 | if (!range_send_ping (range, &pkt)) |
|
|
420 | { |
|
|
421 | self->ranges [0] = self->ranges [--self->rangecnt]; |
|
|
422 | range_free (range); |
|
|
423 | } |
|
|
424 | else |
|
|
425 | range->next = self->next + range->interval; |
|
|
426 | |
|
|
427 | downheap (self); |
|
|
428 | |
|
|
429 | self->next += self->interval; |
|
|
430 | now = NOW (); |
|
|
431 | } |
|
|
432 | |
|
|
433 | ssleep (self->maxrtt); |
|
|
434 | |
|
|
435 | { |
|
|
436 | uint16_t id = self->id; |
|
|
437 | |
|
|
438 | write (thr_res [1], &id, sizeof (id)); |
|
|
439 | } |
|
|
440 | |
|
|
441 | return 0; |
|
|
442 | } |
|
|
443 | |
|
|
444 | /*****************************************************************************/ |
|
|
445 | |
|
|
446 | /* NetBSD, Solaris... */ |
|
|
447 | #ifndef PTHREAD_STACK_MIN |
|
|
448 | # define PTHREAD_STACK_MIN 0 |
|
|
449 | #endif |
|
|
450 | |
|
|
451 | static void |
|
|
452 | pinger_start (PINGER *self) |
|
|
453 | { |
|
|
454 | sigset_t fullsigset, oldsigset; |
|
|
455 | pthread_attr_t attr; |
|
|
456 | |
|
|
457 | if (self->running) |
|
|
458 | return; |
|
|
459 | |
|
|
460 | sigfillset (&fullsigset); |
|
|
461 | |
|
|
462 | pthread_attr_init (&attr); |
|
|
463 | pthread_attr_setstacksize (&attr, PTHREAD_STACK_MIN < sizeof (long) * 2048 ? sizeof (long) * 2048 : PTHREAD_STACK_MIN); |
|
|
464 | |
|
|
465 | pthread_sigmask (SIG_SETMASK, &fullsigset, &oldsigset); |
|
|
466 | |
|
|
467 | if (pthread_create (&self->thrid, &attr, ping_proc, (void *)self)) |
|
|
468 | croak ("AnyEvent::FastPing: unable to create pinger thread"); |
|
|
469 | |
|
|
470 | pthread_sigmask (SIG_SETMASK, &oldsigset, 0); |
|
|
471 | |
|
|
472 | self->running = 1; |
|
|
473 | } |
|
|
474 | |
|
|
475 | static void |
|
|
476 | pinger_stop (PINGER *self) |
|
|
477 | { |
|
|
478 | if (!self->running) |
|
|
479 | return; |
|
|
480 | |
|
|
481 | self->running = 0; |
|
|
482 | pthread_cancel (self->thrid); |
|
|
483 | pthread_join (self->thrid, 0); |
|
|
484 | } |
|
|
485 | |
|
|
486 | static void |
|
|
487 | pinger_init (PINGER *self) |
|
|
488 | { |
|
|
489 | memset (self, 0, sizeof (PINGER)); |
|
|
490 | |
|
|
491 | if (firstfree >= 0) |
|
|
492 | { |
|
|
493 | self->id = firstfree; |
|
|
494 | firstfree = pingerfree [firstfree]; |
|
|
495 | } |
|
|
496 | else if (pingercnt == 0xffff) |
|
|
497 | croak ("unable to create more than 65536 AnyEvent::FastPing objects"); |
|
|
498 | else |
|
|
499 | { |
|
|
500 | if (pingercnt == pingermax) |
|
|
501 | { |
|
|
502 | pingermax = pingermax * 2 + 16; |
|
|
503 | pingers = realloc (pingers , sizeof (pingers [0]) * pingermax); |
|
|
504 | pingerfree = realloc (pingerfree, sizeof (pingerfree [0]) * pingermax); |
|
|
505 | } |
|
|
506 | |
|
|
507 | self->id = pingercnt++; |
|
|
508 | } |
|
|
509 | |
|
|
510 | pingers [self->id] = self; |
|
|
511 | |
|
|
512 | self->recvcb = &PL_sv_undef; |
|
|
513 | self->next = 0.; |
|
|
514 | self->interval = MIN_INTERVAL; |
|
|
515 | self->maxrtt = 0.5; |
|
|
516 | self->rangemax = 16; |
|
|
517 | self->ranges = malloc (sizeof (self->ranges [0]) * self->rangemax); |
|
|
518 | } |
|
|
519 | |
|
|
520 | static void |
|
|
521 | pinger_free (PINGER *self) |
|
|
522 | { |
|
|
523 | pinger_stop (self); |
|
|
524 | |
|
|
525 | pingers [self->id] = 0; |
|
|
526 | |
|
|
527 | SvREFCNT_dec (self->recvq); |
|
|
528 | SvREFCNT_dec (self->recvcb); |
|
|
529 | |
|
|
530 | pingerfree [self->id] = firstfree; |
|
|
531 | firstfree = self->id; |
|
|
532 | |
|
|
533 | while (self->rangecnt) |
|
|
534 | range_free (self->ranges [--self->rangecnt]); |
|
|
535 | |
|
|
536 | free (self->ranges); |
|
|
537 | } |
|
|
538 | |
|
|
539 | static void |
|
|
540 | pinger_add_range (PINGER *self, RANGE *range) |
|
|
541 | { |
|
|
542 | if (self->rangecnt == self->rangemax) |
|
|
543 | self->ranges = realloc (self->ranges, sizeof (self->ranges [0]) * (self->rangemax <<= 1)); |
|
|
544 | |
|
|
545 | self->ranges [self->rangecnt] = range; |
|
|
546 | upheap (self, self->rangecnt); |
|
|
547 | ++self->rangecnt; |
|
|
548 | } |
|
|
549 | |
|
|
550 | /*****************************************************************************/ |
|
|
551 | |
|
|
552 | static void |
|
|
553 | recv_feed (PINGER *self, void *addr, int addrlen, tstamp rtt) |
|
|
554 | { |
|
|
555 | if (!self->recvq) |
|
|
556 | { |
|
|
557 | /* first seen this round */ |
|
|
558 | if (!SvOK (self->recvcb)) |
|
|
559 | return; |
|
|
560 | |
|
|
561 | self->recvq = newAV (); |
|
|
562 | |
|
|
563 | self->nextrecv = firstrecv; |
|
|
564 | firstrecv = self->id; |
|
|
565 | } |
|
|
566 | |
|
|
567 | { |
|
|
568 | AV *pkt = newAV (); |
|
|
569 | |
|
|
570 | av_extend (pkt, 2-1); |
|
|
571 | |
|
|
572 | AvARRAY (pkt)[0] = newSVpvn (addr, addrlen); |
|
|
573 | AvARRAY (pkt)[1] = newSVnv (rtt); |
|
|
574 | AvFILLp (pkt) = 2-1; |
|
|
575 | |
|
|
576 | av_push (self->recvq, newRV_noinc ((SV *)pkt)); |
|
|
577 | } |
|
|
578 | } |
|
|
579 | |
|
|
580 | static void |
|
|
581 | recv_flush (void) |
|
|
582 | { |
|
|
583 | if (firstrecv < 0) |
|
|
584 | return; |
|
|
585 | |
|
|
586 | ENTER; |
|
|
587 | SAVETMPS; |
147 | |
588 | |
148 | do |
589 | do |
149 | { |
590 | { |
150 | if ((*addr)[len] != 0xff) |
591 | dSP; |
151 | { |
592 | PINGER *self = pingers [firstrecv]; |
152 | ++(*addr)[len]; |
593 | firstrecv = self->nextrecv; |
153 | break; |
|
|
154 | } |
|
|
155 | |
594 | |
156 | (*addr)[len] = 0; |
595 | self->nextrecv = -1; |
157 | } |
|
|
158 | while (len--); |
|
|
159 | } |
|
|
160 | |
596 | |
161 | static void * |
597 | PUSHMARK (SP); |
162 | ping_proc (void *unused) |
598 | XPUSHs (sv_2mortal (newRV_noinc ((SV *)self->recvq))); |
163 | { |
599 | self->recvq = 0; |
164 | PKT pkt; |
600 | PUTBACK; |
165 | struct sockaddr_in sa4; |
601 | call_sv (self->recvcb, G_DISCARD | G_VOID); |
166 | #if IPV6 |
|
|
167 | struct sockaddr_in6 sa6; |
|
|
168 | #endif |
|
|
169 | |
|
|
170 | memset (&pkt, 0, sizeof (pkt)); |
|
|
171 | |
|
|
172 | memset (&sa4, 0, sizeof (sa4)); |
|
|
173 | sa4.sin_family = AF_INET; |
|
|
174 | sa4.sin_port = 0; |
|
|
175 | #if IPV6 |
|
|
176 | memset (&sa6, 0, sizeof (sa6)); |
|
|
177 | sa6.sin6_family = AF_INET6; |
|
|
178 | sa6.sin6_port = 0; |
|
|
179 | #endif |
|
|
180 | |
|
|
181 | for (;;) |
|
|
182 | { |
|
|
183 | REQ *req; |
|
|
184 | int len = read (thr_send [0], &req, sizeof (req)); |
|
|
185 | |
|
|
186 | if (!len) |
|
|
187 | pthread_exit (0); |
|
|
188 | else if (len != sizeof (req)) |
|
|
189 | { |
|
|
190 | perror ("AnyEvent::FastPing: short reead or read error"); |
|
|
191 | pthread_exit ((void *)-1); |
|
|
192 | } |
|
|
193 | |
|
|
194 | //TODO: bind to source address |
|
|
195 | |
|
|
196 | pkt.code = 0; |
|
|
197 | pkt.id = (uint16_t)magic; |
|
|
198 | pkt.seq = (uint16_t)~magic; |
|
|
199 | pkt.payload = req->payload; |
|
|
200 | |
|
|
201 | tstamp now = NOW (); |
|
|
202 | tstamp next = now; |
|
|
203 | |
|
|
204 | { |
|
|
205 | int r; |
|
|
206 | for (r = req->nranges; r--; ) |
|
|
207 | inc_addr (&req->ranges [r].hi); |
|
|
208 | } |
602 | } |
|
|
603 | while (firstrecv >= 0); |
209 | |
604 | |
210 | while (req->nranges) |
605 | FREETMPS; |
211 | { |
606 | LEAVE; |
212 | RANGE *range = req->ranges; |
|
|
213 | |
|
|
214 | if (!memcmp (&range->lo, &range->hi, sizeof (addr_t))) |
|
|
215 | req->ranges [0] = req->ranges [--req->nranges]; |
|
|
216 | else |
|
|
217 | { |
|
|
218 | // ranges [0] is always the next range to ping |
|
|
219 | tstamp wait = range->next - now; |
|
|
220 | |
|
|
221 | // compare with the global frequency limit |
|
|
222 | { |
|
|
223 | tstamp diff = next - now; |
|
|
224 | |
|
|
225 | if (wait < diff) |
|
|
226 | wait = diff; |
|
|
227 | else if (range) |
|
|
228 | next = range->next; |
|
|
229 | } |
|
|
230 | |
|
|
231 | if (wait > 0.) |
|
|
232 | { |
|
|
233 | struct timespec ts; |
|
|
234 | |
|
|
235 | ts.tv_sec = wait; |
|
|
236 | ts.tv_nsec = (wait - ts.tv_sec) * 1000000000.; |
|
|
237 | |
|
|
238 | nanosleep (&ts, 0); |
|
|
239 | } |
|
|
240 | |
|
|
241 | now = NOW (); |
|
|
242 | |
|
|
243 | pkt.stamp = now; |
|
|
244 | pkt.cksum = 0; |
|
|
245 | |
|
|
246 | if (range->family == AF_INET) |
|
|
247 | { |
|
|
248 | pkt.type = ICMP4_ECHO; |
|
|
249 | pkt.cksum = icmp_cksum (&pkt, sizeof (pkt)); |
|
|
250 | |
|
|
251 | memcpy (&sa4.sin_addr, |
|
|
252 | sizeof (addr_t) - sizeof (sa4.sin_addr) + (char *)&range->lo, |
|
|
253 | sizeof (sa4.sin_addr)); |
|
|
254 | |
|
|
255 | if (sendto (icmp4_fd, &pkt, sizeof (pkt), 0, (struct sockaddr *)&sa4, sizeof (sa4)) > 0) |
|
|
256 | errno = 0; |
|
|
257 | } |
|
|
258 | else |
|
|
259 | { |
|
|
260 | #if IPV6 |
|
|
261 | pkt.type = ICMP6_ECHO; |
|
|
262 | |
|
|
263 | memcpy (&sa6.sin6_addr, |
|
|
264 | sizeof (addr_t) - sizeof (sa6.sin6_addr) + (char *)&range->lo, |
|
|
265 | sizeof (sa6.sin6_addr)); |
|
|
266 | |
|
|
267 | if (sendto (icmp6_fd, &pkt, sizeof (pkt), 0, (struct sockaddr *)&sa6, sizeof (sa6)) > 0) |
|
|
268 | errno = 0; |
|
|
269 | #endif |
|
|
270 | } |
|
|
271 | |
|
|
272 | if (errno == ENOBUFS) |
|
|
273 | { |
|
|
274 | struct timespec ts; |
|
|
275 | |
|
|
276 | ts.tv_sec = 0; |
|
|
277 | ts.tv_nsec = DRAIN_INTERVAL * 1000000000; |
|
|
278 | |
|
|
279 | nanosleep (&ts, 0); |
|
|
280 | } |
|
|
281 | else |
|
|
282 | { |
|
|
283 | inc_addr (&range->lo); |
|
|
284 | |
|
|
285 | range->next = next; |
|
|
286 | range->next += range->interval; |
|
|
287 | } |
|
|
288 | |
|
|
289 | next += req->interval; |
|
|
290 | } |
|
|
291 | |
|
|
292 | // make a downheap operation |
|
|
293 | int k = 0; |
|
|
294 | int n = 0; |
|
|
295 | for (;;) |
|
|
296 | { |
|
|
297 | ++n; |
|
|
298 | int j = k * 2 + 1; |
|
|
299 | |
|
|
300 | if (j >= req->nranges) |
|
|
301 | break; |
|
|
302 | else if (j < req->nranges - 1) |
|
|
303 | if (req->ranges [j].next > req->ranges [j + 1].next) |
|
|
304 | ++j; |
|
|
305 | |
|
|
306 | if (req->ranges [j].next >= req->ranges [k].next) |
|
|
307 | break; |
|
|
308 | |
|
|
309 | RANGE temp = req->ranges [k]; |
|
|
310 | req->ranges [k] = req->ranges [j]; |
|
|
311 | req->ranges [j] = temp; |
|
|
312 | |
|
|
313 | k = j; |
|
|
314 | } |
|
|
315 | } |
|
|
316 | |
|
|
317 | write (thr_recv [1], &req, sizeof (req)); |
|
|
318 | } |
|
|
319 | |
|
|
320 | return 0; |
|
|
321 | } |
607 | } |
322 | |
608 | |
|
|
609 | /*****************************************************************************/ |
|
|
610 | |
|
|
611 | #if 0 |
323 | static void |
612 | static void |
324 | feed_reply (AV *res_av) |
613 | feed_reply (AV *res_av) |
325 | { |
614 | { |
326 | if (av_len (res_av) < 0) |
|
|
327 | return; |
|
|
328 | |
|
|
329 | dSP; |
615 | dSP; |
330 | SV *res = sv_2mortal (newRV_inc ((SV *)res_av)); |
616 | SV *res = sv_2mortal (newRV_inc ((SV *)res_av)); |
331 | int i; |
617 | int i; |
|
|
618 | |
|
|
619 | if (av_len (res_av) < 0) |
|
|
620 | return; |
332 | |
621 | |
333 | ENTER; |
622 | ENTER; |
334 | SAVETMPS; |
623 | SAVETMPS; |
335 | |
624 | |
336 | for (i = av_len (cbs) + 1; i--; ) |
625 | for (i = av_len (cbs) + 1; i--; ) |
… | |
… | |
344 | } |
633 | } |
345 | |
634 | |
346 | FREETMPS; |
635 | FREETMPS; |
347 | LEAVE; |
636 | LEAVE; |
348 | } |
637 | } |
|
|
638 | #endif |
349 | |
639 | |
350 | static void |
640 | static void |
351 | boot () |
641 | boot () |
352 | { |
642 | { |
353 | sigset_t fullsigset, oldsigset; |
|
|
354 | pthread_attr_t attr; |
|
|
355 | |
|
|
356 | if (pipe (thr_send) < 0) |
|
|
357 | croak ("AnyEvent::FastPing: unable to create send pipe"); |
|
|
358 | |
|
|
359 | if (pipe (thr_recv) < 0) |
643 | if (pipe (thr_res) < 0) |
360 | croak ("AnyEvent::FastPing: unable to create receive pipe"); |
644 | croak ("AnyEvent::FastPing: unable to create receive pipe"); |
361 | |
645 | |
|
|
646 | sv_setiv (get_sv ("AnyEvent::FastPing::THR_RES_FD", 1), thr_res [0]); |
|
|
647 | |
362 | icmp4_fd = socket (AF_INET, SOCK_RAW, IPPROTO_ICMP); |
648 | icmp4_fd = socket (AF_INET, SOCK_RAW, IPPROTO_ICMP); |
|
|
649 | fcntl (icmp4_fd, F_SETFL, O_NONBLOCK); |
363 | #ifdef ICMP_FILTER |
650 | #ifdef ICMP_FILTER |
364 | { |
651 | { |
365 | struct icmp_filter oval; |
652 | struct icmp_filter oval; |
366 | oval.data = 0xffffffff & ~(1 << ICMP4_ECHO_REPLY); |
653 | oval.data = 0xffffffff & ~(1 << ICMP4_ECHO_REPLY); |
367 | setsockopt (icmp4_fd, SOL_RAW, ICMP_FILTER, &oval, sizeof oval); |
654 | setsockopt (icmp4_fd, SOL_RAW, ICMP_FILTER, &oval, sizeof oval); |
368 | } |
655 | } |
369 | #endif |
656 | #endif |
370 | |
657 | |
371 | #if IPV6 |
658 | #if ENABLE_IPV6 |
372 | icmp6_fd = socket (AF_INET6, SOCK_RAW, IPPROTO_ICMPV6); |
659 | icmp6_fd = socket (AF_INET6, SOCK_RAW, IPPROTO_ICMPV6); |
|
|
660 | fcntl (icmp6_fd, F_SETFL, O_NONBLOCK); |
373 | # ifdef ICMP6_FILTER |
661 | # ifdef ICMP6_FILTER |
374 | { |
662 | { |
375 | struct icmp6_filter oval; |
663 | struct icmp6_filter oval; |
376 | ICMP6_FILTER_SETBLOCKALL (&oval); |
664 | ICMP6_FILTER_SETBLOCKALL (&oval); |
377 | ICMP6_FILTER_SETPASS (ICMP6_ECHO_REPLY, &oval); |
665 | ICMP6_FILTER_SETPASS (ICMP6_ECHO_REPLY, &oval); |
378 | setsockopt (icmp6_fd, IPPROTO_ICMPV6, ICMP6_FILTER, &oval, sizeof oval); |
666 | setsockopt (icmp6_fd, IPPROTO_ICMPV6, ICMP6_FILTER, &oval, sizeof oval); |
379 | } |
667 | } |
380 | # endif |
668 | # endif |
381 | #endif |
669 | #endif |
382 | |
670 | |
383 | pthread_attr_init (&attr); |
|
|
384 | pthread_attr_setdetachstate (&attr, PTHREAD_CREATE_DETACHED); |
|
|
385 | #ifdef PTHREAD_SCOPE_PROCESS |
|
|
386 | pthread_attr_setscope (&attr, PTHREAD_SCOPE_PROCESS); |
|
|
387 | #endif |
|
|
388 | |
|
|
389 | sigfillset (&fullsigset); |
|
|
390 | |
|
|
391 | pthread_sigmask (SIG_SETMASK, &fullsigset, &oldsigset); |
|
|
392 | |
|
|
393 | if (pthread_create (&pthrid, &attr, ping_proc, 0)) |
|
|
394 | croak ("AnyEvent::FastPing: unable to create pinger thread"); |
|
|
395 | |
|
|
396 | pthread_sigmask (SIG_SETMASK, &oldsigset, 0); |
|
|
397 | |
|
|
398 | sv_setiv (get_sv ("AnyEvent::FastPing::THR_REQ_FD", 1), thr_send [1]); |
|
|
399 | sv_setiv (get_sv ("AnyEvent::FastPing::THR_RES_FD", 1), thr_recv [0]); |
|
|
400 | |
|
|
401 | sv_setiv (get_sv ("AnyEvent::FastPing::ICMP4_FD", 1), icmp4_fd); |
671 | sv_setiv (get_sv ("AnyEvent::FastPing::ICMP4_FD", 1), icmp4_fd); |
402 | sv_setiv (get_sv ("AnyEvent::FastPing::ICMP6_FD", 1), icmp6_fd); |
672 | sv_setiv (get_sv ("AnyEvent::FastPing::ICMP6_FD", 1), icmp6_fd); |
403 | } |
673 | } |
404 | |
674 | |
|
|
675 | #define NOT_RUNNING \ |
|
|
676 | if (self->running) \ |
|
|
677 | croak ("AnyEvent::FastPing object has been started - you have to sotp t first before calling this method, caught"); |
|
|
678 | |
405 | MODULE = AnyEvent::FastPing PACKAGE = AnyEvent::FastPing |
679 | MODULE = AnyEvent::FastPing PACKAGE = AnyEvent::FastPing PREFIX = pinger_ |
406 | |
680 | |
407 | BOOT: |
681 | BOOT: |
408 | { |
682 | { |
409 | HV *stash = gv_stashpv ("AnyEvent::FastPing", 1); |
683 | HV *stash = gv_stashpv ("AnyEvent::FastPing", 1); |
410 | |
684 | |
411 | cbs = get_av ("AnyEvent::FastPing::CB", 1); |
685 | if (sizeof (PKT) & 3) |
412 | magic = getpid () ^ MAGIC; |
686 | croak ("size of PKT structure is not a multiple of 4"); |
413 | |
687 | |
414 | boot (); |
688 | boot (); |
415 | |
689 | |
416 | newCONSTSUB (stash, "ipv4_supported", newSViv (icmp4_fd >= 0)); |
690 | newCONSTSUB (stash, "ipv4_supported", newSViv (icmp4_fd >= 0)); |
417 | newCONSTSUB (stash, "ipv6_supported", newSViv (icmp6_fd >= 0)); |
691 | newCONSTSUB (stash, "ipv6_supported", newSViv (icmp6_fd >= 0)); |
… | |
… | |
419 | newCONSTSUB (stash, "icmp4_pktsize", newSViv (HDR_SIZE_IP4 + sizeof (PKT))); |
693 | newCONSTSUB (stash, "icmp4_pktsize", newSViv (HDR_SIZE_IP4 + sizeof (PKT))); |
420 | newCONSTSUB (stash, "icmp6_pktsize", newSViv (HDR_SIZE_IP6 + sizeof (PKT))); |
694 | newCONSTSUB (stash, "icmp6_pktsize", newSViv (HDR_SIZE_IP6 + sizeof (PKT))); |
421 | } |
695 | } |
422 | |
696 | |
423 | PROTOTYPES: DISABLE |
697 | PROTOTYPES: DISABLE |
424 | |
|
|
425 | SV * |
|
|
426 | _req_icmp_ping (SV *ranges, NV interval, U32 payload, SV *id) |
|
|
427 | CODE: |
|
|
428 | { |
|
|
429 | if (!SvROK (ranges) || SvTYPE (SvRV (ranges)) != SVt_PVAV) |
|
|
430 | croak ("address ranges must be given as arrayref with lo, hi pairs"); |
|
|
431 | |
|
|
432 | AV *rav = (AV *)SvRV (ranges); |
|
|
433 | int nranges = av_len (rav) + 1; |
|
|
434 | |
|
|
435 | REQ *req = malloc (sizeof (REQ)); |
|
|
436 | int i; |
|
|
437 | |
|
|
438 | if (interval < MIN_INTERVAL) |
|
|
439 | interval = MIN_INTERVAL; |
|
|
440 | |
|
|
441 | req->id = newSVsv (id); |
|
|
442 | req->interval = interval; |
|
|
443 | req->payload = payload; |
|
|
444 | req->nranges = nranges; |
|
|
445 | req->ranges = (RANGE *)malloc (nranges * sizeof (RANGE)); |
|
|
446 | |
|
|
447 | while (nranges--) |
|
|
448 | { |
|
|
449 | SV *sv = *av_fetch (rav, nranges, 1); |
|
|
450 | |
|
|
451 | if (!SvROK (sv) || SvTYPE (SvRV (sv)) != SVt_PVAV) |
|
|
452 | croak ("address range must be given as arrayref with lo, hi, interval arrayrefs"); |
|
|
453 | |
|
|
454 | AV *av = (AV *)SvRV (sv); |
|
|
455 | RANGE *r = req->ranges + nranges; |
|
|
456 | |
|
|
457 | SV *lo = *av_fetch (av, 0, 1); |
|
|
458 | SV *hi = *av_fetch (av, 1, 1); |
|
|
459 | |
|
|
460 | sv_utf8_downgrade (lo, 0); |
|
|
461 | sv_utf8_downgrade (hi, 0); |
|
|
462 | |
|
|
463 | memset (&r->lo, 0, sizeof (addr_t)); |
|
|
464 | memset (&r->hi, 0, sizeof (addr_t)); |
|
|
465 | |
|
|
466 | if (SvPOKp (lo) && SvPOKp (hi)) |
|
|
467 | { |
|
|
468 | if (SvCUR (lo) != SvCUR (hi)) |
|
|
469 | croak ("addresses in range must be of the same size (either 4 or 16 bytes)"); |
|
|
470 | |
|
|
471 | if (SvCUR (lo) == 4) |
|
|
472 | { |
|
|
473 | r->family = AF_INET; |
|
|
474 | memcpy (sizeof (addr_t) - 4 + (char *)&r->lo, SvPVX (lo), 4); |
|
|
475 | memcpy (sizeof (addr_t) - 4 + (char *)&r->hi, SvPVX (hi), 4); |
|
|
476 | } |
|
|
477 | else if (SvCUR (lo) == 16) |
|
|
478 | { |
|
|
479 | #if IPV6 |
|
|
480 | r->family = AF_INET6; |
|
|
481 | memcpy (&r->lo, SvPVX (lo), sizeof (addr_t)); |
|
|
482 | memcpy (&r->hi, SvPVX (hi), sizeof (addr_t)); |
|
|
483 | #else |
|
|
484 | croak ("IPv6 not supported in this configuration"); |
|
|
485 | #endif |
|
|
486 | } |
|
|
487 | else |
|
|
488 | croak ("addresses in range must be either 4 (IPv4) or 16 (IPV6) bytes in length"); |
|
|
489 | } |
|
|
490 | else if (SvIOK (lo) && SvIOK (hi)) |
|
|
491 | { |
|
|
492 | r->family = AF_INET; |
|
|
493 | |
|
|
494 | uint32_t addr; |
|
|
495 | addr = htonl (SvUV (lo)); memcpy (sizeof (addr_t) - 4 + (char *)&r->lo, &addr, 4); |
|
|
496 | addr = htonl (SvUV (hi)); memcpy (sizeof (addr_t) - 4 + (char *)&r->hi, &addr, 4); |
|
|
497 | } |
|
|
498 | else |
|
|
499 | croak ("addresses in range must be strings with either 4 (IPv4) or 16 (IPv6) octets"); |
|
|
500 | |
|
|
501 | if (r->family == AF_INET) |
|
|
502 | { |
|
|
503 | if (icmp4_fd < 0) |
|
|
504 | croak ("AnyEvent::FastPing: IPv4 ping support not available on this system"); |
|
|
505 | } |
|
|
506 | else |
|
|
507 | { |
|
|
508 | if (icmp6_fd < 0) |
|
|
509 | croak ("AnyEvent::FastPing: IPv6 ping support not available on this system"); |
|
|
510 | } |
|
|
511 | |
|
|
512 | r->interval = SvNV (*av_fetch (av, 2, 1)); |
|
|
513 | |
|
|
514 | if (r->interval < req->interval) |
|
|
515 | r->interval = req->interval; |
|
|
516 | |
|
|
517 | r->next = 0.; |
|
|
518 | } |
|
|
519 | |
|
|
520 | RETVAL = newSVpvn ((char *)&req, sizeof (req)); |
|
|
521 | } |
|
|
522 | OUTPUT: |
|
|
523 | RETVAL |
|
|
524 | |
|
|
525 | SV * |
|
|
526 | _read_res () |
|
|
527 | CODE: |
|
|
528 | { |
|
|
529 | REQ *req; |
|
|
530 | |
|
|
531 | if (read (thr_recv [0], &req, sizeof (req)) != sizeof (req)) |
|
|
532 | RETVAL = &PL_sv_undef; |
|
|
533 | |
|
|
534 | RETVAL = req->id; |
|
|
535 | free (req->ranges); |
|
|
536 | free (req); |
|
|
537 | } |
|
|
538 | OUTPUT: |
|
|
539 | RETVAL |
|
|
540 | |
698 | |
541 | void |
699 | void |
542 | _recv_icmp4 (...) |
700 | _recv_icmp4 (...) |
543 | CODE: |
701 | CODE: |
544 | { |
702 | { |
545 | char buf [512]; |
703 | char buf [512]; |
546 | struct sockaddr_in sa; |
704 | struct sockaddr_in sa; |
547 | socklen_t sl = sizeof (sa); |
705 | int maxrecv; |
548 | AV *res_av = av_len (cbs) < 0 ? 0 : (AV *)sv_2mortal ((SV *)newAV ()); |
|
|
549 | tstamp now = NOW (); |
|
|
550 | |
706 | |
551 | for (;;) |
707 | for (maxrecv = 256+1; --maxrecv; ) |
552 | { |
708 | { |
|
|
709 | PINGER *pinger; |
|
|
710 | IP4HDR *iphdr = (IP4HDR *)buf; |
|
|
711 | socklen_t sl = sizeof (sa); |
553 | int len = recvfrom (icmp4_fd, buf, sizeof (buf), MSG_DONTWAIT | MSG_TRUNC, &sa, &sl); |
712 | int len = recvfrom (icmp4_fd, buf, sizeof (buf), MSG_TRUNC, (struct sockaddr *)&sa, &sl); |
|
|
713 | int hdrlen, totlen; |
|
|
714 | PKT *pkt; |
554 | |
715 | |
555 | if (len <= HDR_SIZE_IP4) |
716 | if (len <= HDR_SIZE_IP4) |
556 | break; |
717 | break; |
557 | |
718 | |
558 | IP4HDR *iphdr = (IP4HDR *)buf; |
|
|
559 | |
|
|
560 | int hdrlen = (iphdr->version_ihl & 15) * 4; |
719 | hdrlen = (iphdr->version_ihl & 15) * 4; |
561 | int totlen = ntohs (iphdr->tot_len); |
720 | totlen = ntohs (iphdr->tot_len); |
562 | |
721 | |
563 | // packet corrupt? |
|
|
564 | if (!res_av |
|
|
565 | || totlen > len |
722 | if (totlen > len |
566 | || iphdr->protocol != IPPROTO_ICMP |
723 | || iphdr->protocol != IPPROTO_ICMP |
567 | || hdrlen < HDR_SIZE_IP4 || hdrlen + sizeof (PKT) != totlen) |
724 | || hdrlen < HDR_SIZE_IP4 || hdrlen + sizeof (PKT) != totlen) |
568 | continue; |
725 | continue; |
569 | |
726 | |
570 | PKT *pkt = (PKT *)(buf + hdrlen); |
727 | pkt = (PKT *)(buf + hdrlen); |
571 | |
728 | |
572 | if (pkt->type != ICMP4_ECHO_REPLY |
729 | if (pkt->type != ICMP4_ECHO_REPLY |
573 | || pkt->id != (uint16_t) magic |
730 | || pkt->pinger >= pingercnt |
574 | || pkt->seq != (uint16_t)~magic |
731 | || !pingers [pkt->pinger]) |
575 | || !isnormal (pkt->stamp)) |
|
|
576 | continue; |
732 | continue; |
577 | |
733 | |
578 | AV *av = newAV (); |
734 | pinger = pingers [pkt->pinger]; |
579 | av_push (av, newSVpvn ((char *)&sa.sin_addr, 4)); |
|
|
580 | av_push (av, newSVnv (now - pkt->stamp)); |
|
|
581 | av_push (av, newSVuv (pkt->payload)); |
|
|
582 | |
735 | |
583 | av_push (res_av, newRV_noinc ((SV *)av)); |
736 | if (!pkt_is_valid_for (pkt, pinger)) |
|
|
737 | continue; |
|
|
738 | |
|
|
739 | recv_feed (pinger, &sa.sin_addr, 4, NOW () - pkt_to_ts (pkt)); |
584 | } |
740 | } |
585 | |
741 | |
586 | if (res_av) |
742 | recv_flush (); |
587 | feed_reply (res_av); |
|
|
588 | } |
743 | } |
589 | |
744 | |
590 | void |
745 | void |
591 | _recv_icmp6 (...) |
746 | _recv_icmp6 (...) |
592 | CODE: |
747 | CODE: |
593 | { |
748 | { |
594 | struct sockaddr_in6 sa; |
749 | struct sockaddr_in6 sa; |
595 | socklen_t sl = sizeof (sa); |
|
|
596 | AV *res_av = av_len (cbs) < 0 ? 0 : (AV *)sv_2mortal ((SV *)newAV ()); |
|
|
597 | PKT pkt; |
750 | PKT pkt; |
598 | tstamp now = NOW (); |
751 | int maxrecv; |
599 | |
752 | |
600 | for (;;) |
753 | for (maxrecv = 256+1; --maxrecv; ) |
601 | { |
754 | { |
|
|
755 | PINGER *pinger; |
|
|
756 | socklen_t sl = sizeof (sa); |
602 | int len = recvfrom (icmp6_fd, &pkt, sizeof (pkt), MSG_DONTWAIT | MSG_TRUNC, &sa, &sl); |
757 | int len = recvfrom (icmp6_fd, &pkt, sizeof (pkt), MSG_TRUNC, (struct sockaddr *)&sa, &sl); |
603 | |
758 | |
604 | if (len != sizeof (PKT)) |
759 | if (len != sizeof (PKT)) |
605 | break; |
760 | break; |
606 | |
761 | |
607 | if (!res_av |
|
|
608 | || pkt.type != ICMP6_ECHO_REPLY |
762 | if (pkt.type != ICMP6_ECHO_REPLY |
609 | || pkt.id != (uint16_t) magic |
763 | || pkt.pinger >= pingercnt |
610 | || pkt.seq != (uint16_t)~magic |
764 | || !pingers [pkt.pinger]) |
611 | || !isnormal (pkt.stamp)) |
|
|
612 | continue; |
765 | continue; |
613 | |
766 | |
614 | AV *av = newAV (); |
767 | pinger = pingers [pkt.pinger]; |
615 | av_push (av, newSVpvn ((char *)&sa.sin6_addr, 16)); |
|
|
616 | av_push (av, newSVnv (now - pkt.stamp)); |
|
|
617 | av_push (av, newSVuv (pkt.payload)); |
|
|
618 | |
768 | |
619 | av_push (res_av, newRV_noinc ((SV *)av)); |
769 | if (!pkt_is_valid_for (&pkt, pinger)) |
|
|
770 | continue; |
|
|
771 | |
|
|
772 | recv_feed (pinger, &sa.sin6_addr, 16, NOW () - pkt_to_ts (&pkt)); |
620 | } |
773 | } |
621 | |
774 | |
622 | if (res_av) |
775 | recv_flush (); |
623 | feed_reply (res_av); |
|
|
624 | } |
776 | } |
625 | |
777 | |
|
|
778 | void |
|
|
779 | _new (SV *klass, UV magic1, UV magic2, UV magic3) |
|
|
780 | PPCODE: |
|
|
781 | { |
|
|
782 | SV *pv = NEWSV (0, sizeof (PINGER)); |
|
|
783 | PINGER *self = (PINGER *)SvPVX (pv); |
|
|
784 | |
|
|
785 | SvPOK_only (pv); |
|
|
786 | XPUSHs (sv_2mortal (sv_bless (newRV_noinc (pv), gv_stashpv (SvPVutf8_nolen (klass), 1)))); |
|
|
787 | pinger_init (self); |
|
|
788 | self->magic1 = magic1; |
|
|
789 | self->magic2 = magic2; |
|
|
790 | self->magic3 = magic3; |
|
|
791 | } |
|
|
792 | |
|
|
793 | void |
|
|
794 | _free (PINGER *self) |
|
|
795 | CODE: |
|
|
796 | pinger_free (self); |
|
|
797 | |
|
|
798 | IV |
|
|
799 | id (PINGER *self, ...) |
|
|
800 | CODE: |
|
|
801 | RETVAL = self->id; |
|
|
802 | OUTPUT: |
|
|
803 | RETVAL |
|
|
804 | |
|
|
805 | void pinger_start (PINGER *self) |
|
|
806 | |
|
|
807 | void pinger_stop (PINGER *self) |
|
|
808 | |
|
|
809 | void |
|
|
810 | _stop_id (UV id) |
|
|
811 | CODE: |
|
|
812 | if (id < pingercnt && pingers [id]) |
|
|
813 | pinger_stop (pingers [id]); |
|
|
814 | |
|
|
815 | void |
|
|
816 | interval (PINGER *self, NV interval) |
|
|
817 | CODE: |
|
|
818 | NOT_RUNNING; |
|
|
819 | self->interval = interval > MIN_INTERVAL ? interval : MIN_INTERVAL; |
|
|
820 | |
|
|
821 | void |
|
|
822 | max_rtt (PINGER *self, NV maxrtt) |
|
|
823 | CODE: |
|
|
824 | NOT_RUNNING; |
|
|
825 | self->maxrtt = maxrtt; |
|
|
826 | |
|
|
827 | void |
|
|
828 | on_recv (PINGER *self, SV *cb) |
|
|
829 | CODE: |
|
|
830 | SvREFCNT_dec (self->recvcb); |
|
|
831 | self->recvcb = newSVsv (cb); |
|
|
832 | |
|
|
833 | void |
|
|
834 | add_range (PINGER *self, SV *lo_, SV *hi_, NV interval = 0) |
|
|
835 | CODE: |
|
|
836 | { |
|
|
837 | STRLEN lo_len, hi_len; |
|
|
838 | char *lo = SvPVbyte (lo_, lo_len); |
|
|
839 | char *hi = SvPVbyte (hi_, hi_len); |
|
|
840 | RANGE *range; |
|
|
841 | NOT_RUNNING; |
|
|
842 | |
|
|
843 | if (lo_len != hi_len || (lo_len != 4 && lo_len != 16)) |
|
|
844 | croak ("AnyEvent::FastPing::add_range address range must be specified as two binary IPv4 or IPv6 addresses"); |
|
|
845 | |
|
|
846 | if (lo_len == 4 && icmp4_fd < 0) croak ("IPv4 support unavailable"); |
|
|
847 | if (lo_len == 16 && icmp6_fd < 0) croak ("IPv6 support unavailable"); |
|
|
848 | |
|
|
849 | if (memcmp (lo, hi, lo_len) > 0) |
|
|
850 | croak ("AnyEvent::FastPing::add_range called with lo > hi"); |
|
|
851 | |
|
|
852 | range = calloc (1, sizeof (RANGE)); |
|
|
853 | |
|
|
854 | range->next = 0; |
|
|
855 | range->interval = interval > MIN_INTERVAL ? interval : MIN_INTERVAL; |
|
|
856 | range->addrlen = lo_len; |
|
|
857 | |
|
|
858 | memcpy (sizeof (addr_tt) - lo_len + (char *)&range->lo, lo, lo_len); |
|
|
859 | memcpy (sizeof (addr_tt) - lo_len + (char *)&range->hi, hi, lo_len); |
|
|
860 | |
|
|
861 | pinger_add_range (self, range); |
|
|
862 | } |
|
|
863 | |
|
|
864 | void |
|
|
865 | add_hosts (PINGER *self, SV *addrs, NV interval = 0, UV interleave = 1) |
|
|
866 | CODE: |
|
|
867 | { |
|
|
868 | AV *av; |
|
|
869 | int i, j, k; |
|
|
870 | int cnt; |
|
|
871 | int addrlen = 0; |
|
|
872 | RANGE *range; |
|
|
873 | NOT_RUNNING; |
|
|
874 | |
|
|
875 | if (!SvROK (addrs) || SvTYPE (SvRV (addrs)) != SVt_PVAV) |
|
|
876 | croak ("AnyEvent::FastPing::add_hosts expects an arrayref with binary IPv4 or IPv6 addresses"); |
|
|
877 | |
|
|
878 | av = (AV *)SvRV (addrs); |
|
|
879 | cnt = av_len (av) + 1; |
|
|
880 | |
|
|
881 | for (i = 0; i < cnt; ++i) |
|
|
882 | { |
|
|
883 | SV *sv = *av_fetch (av, i, 1); |
|
|
884 | sv_utf8_downgrade (sv, 0); |
|
|
885 | |
|
|
886 | j = SvCUR (sv); |
|
|
887 | |
|
|
888 | if (j != 4 && j != 16) |
|
|
889 | croak ("AnyEvent::FastPing::add_hosts addresses must be specified as binary IPv4 or IPv6 addresses"); |
|
|
890 | |
|
|
891 | if (j > addrlen) |
|
|
892 | addrlen = j; |
|
|
893 | } |
|
|
894 | |
|
|
895 | if (!cnt) |
|
|
896 | XSRETURN_EMPTY; |
|
|
897 | |
|
|
898 | range = calloc (1, sizeof (RANGE) + cnt * addrlen); |
|
|
899 | |
|
|
900 | range->next = 0; |
|
|
901 | range->interval = interval > MIN_INTERVAL ? interval : MIN_INTERVAL; |
|
|
902 | range->addrlen = addrlen; |
|
|
903 | range->addrcnt = cnt; |
|
|
904 | |
|
|
905 | if (interleave == 0) |
|
|
906 | interleave = cnt <= 256 * 256 ? 256 : (int)sqrtf (cnt); |
|
|
907 | |
|
|
908 | k = cnt; |
|
|
909 | for (j = 0; j < interleave; ++j) |
|
|
910 | for (i = j; i < cnt; i += interleave) |
|
|
911 | { |
|
|
912 | uint8_t *dst = (uint8_t *)(range + 1) + --k * addrlen; |
|
|
913 | char *pv; |
|
|
914 | STRLEN pvlen; |
|
|
915 | SV *sv = *av_fetch (av, i, 1); |
|
|
916 | sv_utf8_downgrade (sv, 0); |
|
|
917 | |
|
|
918 | pv = SvPVbyte (sv, pvlen); |
|
|
919 | |
|
|
920 | if (pvlen != addrlen) |
|
|
921 | { |
|
|
922 | dst [ 0] = 0x00; dst [ 1] = 0x00; dst [ 2] = 0x00; dst [ 3] = 0x00; |
|
|
923 | dst [ 4] = 0x00; dst [ 5] = 0x00; dst [ 6] = 0x00; dst [ 7] = 0x00; |
|
|
924 | dst [ 8] = 0x00; dst [ 9] = 0x00; dst [10] = 0xff; dst [11] = 0xff; |
|
|
925 | dst [12] = pv [0]; dst [13] = pv [1]; dst [14] = pv [2]; dst [15] = pv [3]; |
|
|
926 | } |
|
|
927 | else |
|
|
928 | memcpy (dst, pv, addrlen); |
|
|
929 | } |
|
|
930 | |
|
|
931 | pinger_add_range (self, range); |
|
|
932 | } |
|
|
933 | |