Annotation of embedaddon/quagga/isisd/isis_pfpacket.c, revision 1.1.1.1
1.1 misho 1: /*
2: * IS-IS Rout(e)ing protocol - isis_pfpacket.c
3: *
4: * Copyright (C) 2001,2002 Sampo Saaristo
5: * Tampere University of Technology
6: * Institute of Communications Engineering
7: *
8: * This program is free software; you can redistribute it and/or modify it
9: * under the terms of the GNU General Public Licenseas published by the Free
10: * Software Foundation; either version 2 of the License, or (at your option)
11: * any later version.
12: *
13: * This program is distributed in the hope that it will be useful,but WITHOUT
14: * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
15: * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
16: * more details.
17:
18: * You should have received a copy of the GNU General Public License along
19: * with this program; if not, write to the Free Software Foundation, Inc.,
20: * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
21: */
22:
23: #include <zebra.h>
24: #if ISIS_METHOD == ISIS_METHOD_PFPACKET
25: #include <net/ethernet.h> /* the L2 protocols */
26: #include <netpacket/packet.h>
27:
28: #include "log.h"
29: #include "stream.h"
30: #include "if.h"
31:
32: #include "isisd/dict.h"
33: #include "isisd/include-netbsd/iso.h"
34: #include "isisd/isis_constants.h"
35: #include "isisd/isis_common.h"
36: #include "isisd/isis_circuit.h"
37: #include "isisd/isis_flags.h"
38: #include "isisd/isisd.h"
39: #include "isisd/isis_constants.h"
40: #include "isisd/isis_circuit.h"
41: #include "isisd/isis_network.h"
42:
43: #include "privs.h"
44:
45: extern struct zebra_privs_t isisd_privs;
46:
47: /*
48: * Table 9 - Architectural constants for use with ISO 8802 subnetworks
49: * ISO 10589 - 8.4.8
50: */
51:
52: u_char ALL_L1_ISS[6] = { 0x01, 0x80, 0xC2, 0x00, 0x00, 0x14 };
53: u_char ALL_L2_ISS[6] = { 0x01, 0x80, 0xC2, 0x00, 0x00, 0x15 };
54: u_char ALL_ISS[6] = { 0x09, 0x00, 0x2B, 0x00, 0x00, 0x05 };
55: u_char ALL_ESS[6] = { 0x09, 0x00, 0x2B, 0x00, 0x00, 0x04 };
56:
57: static char discard_buff[8192];
58: static char sock_buff[8192];
59:
60: /*
61: * if level is 0 we are joining p2p multicast
62: * FIXME: and the p2p multicast being ???
63: */
64: static int
65: isis_multicast_join (int fd, int registerto, int if_num)
66: {
67: struct packet_mreq mreq;
68:
69: memset (&mreq, 0, sizeof (mreq));
70: mreq.mr_ifindex = if_num;
71: if (registerto)
72: {
73: mreq.mr_type = PACKET_MR_MULTICAST;
74: mreq.mr_alen = ETH_ALEN;
75: if (registerto == 1)
76: memcpy (&mreq.mr_address, ALL_L1_ISS, ETH_ALEN);
77: else if (registerto == 2)
78: memcpy (&mreq.mr_address, ALL_L2_ISS, ETH_ALEN);
79: else if (registerto == 3)
80: memcpy (&mreq.mr_address, ALL_ISS, ETH_ALEN);
81: else
82: memcpy (&mreq.mr_address, ALL_ESS, ETH_ALEN);
83:
84: }
85: else
86: {
87: mreq.mr_type = PACKET_MR_ALLMULTI;
88: }
89: #ifdef EXTREME_DEBUG
90: zlog_debug ("isis_multicast_join(): fd=%d, reg_to=%d, if_num=%d, "
91: "address = %02x:%02x:%02x:%02x:%02x:%02x",
92: fd, registerto, if_num, mreq.mr_address[0], mreq.mr_address[1],
93: mreq.mr_address[2], mreq.mr_address[3], mreq.mr_address[4],
94: mreq.mr_address[5]);
95: #endif /* EXTREME_DEBUG */
96: if (setsockopt (fd, SOL_PACKET, PACKET_ADD_MEMBERSHIP, &mreq,
97: sizeof (struct packet_mreq)))
98: {
99: zlog_warn ("isis_multicast_join(): setsockopt(): %s", safe_strerror (errno));
100: return ISIS_WARNING;
101: }
102:
103: return ISIS_OK;
104: }
105:
106: static int
107: open_packet_socket (struct isis_circuit *circuit)
108: {
109: struct sockaddr_ll s_addr;
110: int fd, retval = ISIS_OK;
111:
112: fd = socket (PF_PACKET, SOCK_DGRAM, htons (ETH_P_ALL));
113: if (fd < 0)
114: {
115: zlog_warn ("open_packet_socket(): socket() failed %s",
116: safe_strerror (errno));
117: return ISIS_WARNING;
118: }
119:
120: /*
121: * Bind to the physical interface
122: */
123: memset (&s_addr, 0, sizeof (struct sockaddr_ll));
124: s_addr.sll_family = AF_PACKET;
125: s_addr.sll_protocol = htons (ETH_P_ALL);
126: s_addr.sll_ifindex = circuit->interface->ifindex;
127:
128: if (bind (fd, (struct sockaddr *) (&s_addr),
129: sizeof (struct sockaddr_ll)) < 0)
130: {
131: zlog_warn ("open_packet_socket(): bind() failed: %s", safe_strerror (errno));
132: return ISIS_WARNING;
133: }
134:
135: circuit->fd = fd;
136:
137: if (circuit->circ_type == CIRCUIT_T_BROADCAST)
138: {
139: /*
140: * Join to multicast groups
141: * according to
142: * 8.4.2 - Broadcast subnetwork IIH PDUs
143: * FIXME: is there a case only one will fail??
144: */
145: if (circuit->circuit_is_type & IS_LEVEL_1)
146: {
147: /* joining ALL_L1_ISS */
148: retval = isis_multicast_join (circuit->fd, 1,
149: circuit->interface->ifindex);
150: /* joining ALL_ISS */
151: retval = isis_multicast_join (circuit->fd, 3,
152: circuit->interface->ifindex);
153: }
154: if (circuit->circuit_is_type & IS_LEVEL_2)
155: /* joining ALL_L2_ISS */
156: retval = isis_multicast_join (circuit->fd, 2,
157: circuit->interface->ifindex);
158: }
159: else
160: {
161: retval =
162: isis_multicast_join (circuit->fd, 0, circuit->interface->ifindex);
163: }
164:
165: return retval;
166: }
167:
168: /*
169: * Create the socket and set the tx/rx funcs
170: */
171: int
172: isis_sock_init (struct isis_circuit *circuit)
173: {
174: int retval = ISIS_OK;
175:
176: if (isisd_privs.change (ZPRIVS_RAISE))
177: zlog_err ("%s: could not raise privs, %s", __func__, safe_strerror (errno));
178:
179: retval = open_packet_socket (circuit);
180:
181: if (retval != ISIS_OK)
182: {
183: zlog_warn ("%s: could not initialize the socket", __func__);
184: goto end;
185: }
186:
187: if (circuit->circ_type == CIRCUIT_T_BROADCAST)
188: {
189: circuit->tx = isis_send_pdu_bcast;
190: circuit->rx = isis_recv_pdu_bcast;
191: }
192: else if (circuit->circ_type == CIRCUIT_T_P2P)
193: {
194: circuit->tx = isis_send_pdu_p2p;
195: circuit->rx = isis_recv_pdu_p2p;
196: }
197: else
198: {
199: zlog_warn ("isis_sock_init(): unknown circuit type");
200: retval = ISIS_WARNING;
201: goto end;
202: }
203:
204: end:
205: if (isisd_privs.change (ZPRIVS_LOWER))
206: zlog_err ("%s: could not lower privs, %s", __func__, safe_strerror (errno));
207:
208: return retval;
209: }
210:
211: static inline int
212: llc_check (u_char * llc)
213: {
214: if (*llc != ISO_SAP || *(llc + 1) != ISO_SAP || *(llc + 2) != 3)
215: return 0;
216:
217: return 1;
218: }
219:
220: int
221: isis_recv_pdu_bcast (struct isis_circuit *circuit, u_char * ssnpa)
222: {
223: int bytesread, addr_len;
224: struct sockaddr_ll s_addr;
225: u_char llc[LLC_LEN];
226:
227: addr_len = sizeof (s_addr);
228:
229: memset (&s_addr, 0, sizeof (struct sockaddr_ll));
230:
231: bytesread = recvfrom (circuit->fd, (void *) &llc,
232: LLC_LEN, MSG_PEEK,
233: (struct sockaddr *) &s_addr, (socklen_t *) &addr_len);
234:
235: if (!circuit->area) {
236: return ISIS_OK;
237: }
238:
239: if (bytesread < 0)
240: {
241: zlog_warn ("isis_recv_packet_bcast(): fd %d, recvfrom (): %s",
242: circuit->fd, safe_strerror (errno));
243: zlog_warn ("circuit is %s", circuit->interface->name);
244: zlog_warn ("circuit fd %d", circuit->fd);
245: zlog_warn ("bytesread %d", bytesread);
246: /* get rid of the packet */
247: bytesread = read (circuit->fd, discard_buff, sizeof (discard_buff));
248: return ISIS_WARNING;
249: }
250: /*
251: * Filtering by llc field, discard packets sent by this host (other circuit)
252: */
253: if (!llc_check (llc) || s_addr.sll_pkttype == PACKET_OUTGOING)
254: {
255: /* Read the packet into discard buff */
256: bytesread = read (circuit->fd, discard_buff, sizeof (discard_buff));
257: if (bytesread < 0)
258: zlog_warn ("isis_recv_pdu_bcast(): read() failed");
259: return ISIS_WARNING;
260: }
261:
262: /* on lan we have to read to the static buff first */
263: bytesread = recvfrom (circuit->fd, sock_buff, circuit->interface->mtu, 0,
264: (struct sockaddr *) &s_addr, (socklen_t *) &addr_len);
265:
266: /* then we lose the LLC */
267: stream_write (circuit->rcv_stream, sock_buff + LLC_LEN, bytesread - LLC_LEN);
268:
269: memcpy (ssnpa, &s_addr.sll_addr, s_addr.sll_halen);
270:
271: return ISIS_OK;
272: }
273:
274: int
275: isis_recv_pdu_p2p (struct isis_circuit *circuit, u_char * ssnpa)
276: {
277: int bytesread, addr_len;
278: struct sockaddr_ll s_addr;
279:
280: memset (&s_addr, 0, sizeof (struct sockaddr_ll));
281: addr_len = sizeof (s_addr);
282:
283: /* we can read directly to the stream */
284: bytesread = stream_recvfrom (circuit->rcv_stream, circuit->fd,
285: circuit->interface->mtu, 0,
286: (struct sockaddr *) &s_addr,
287: (socklen_t *) &addr_len);
288:
289: if (s_addr.sll_pkttype == PACKET_OUTGOING)
290: {
291: /* Read the packet into discard buff */
292: bytesread = read (circuit->fd, discard_buff, sizeof (discard_buff));
293: if (bytesread < 0)
294: zlog_warn ("isis_recv_pdu_p2p(): read() failed");
295: return ISIS_WARNING;
296: }
297:
298: /* If we don't have protocol type 0x00FE which is
299: * ISO over GRE we exit with pain :)
300: */
301: if (ntohs (s_addr.sll_protocol) != 0x00FE)
302: {
303: zlog_warn ("isis_recv_pdu_p2p(): protocol mismatch(): %X",
304: ntohs (s_addr.sll_protocol));
305: return ISIS_WARNING;
306: }
307:
308: memcpy (ssnpa, &s_addr.sll_addr, s_addr.sll_halen);
309:
310: return ISIS_OK;
311: }
312:
313: int
314: isis_send_pdu_bcast (struct isis_circuit *circuit, int level)
315: {
316: /* we need to do the LLC in here because of P2P circuits, which will
317: * not need it
318: */
319: int written = 1;
320: struct sockaddr_ll sa;
321:
322: stream_set_getp (circuit->snd_stream, 0);
323: memset (&sa, 0, sizeof (struct sockaddr_ll));
324: sa.sll_family = AF_PACKET;
325: sa.sll_protocol = htons (stream_get_endp (circuit->snd_stream) + LLC_LEN);
326: sa.sll_ifindex = circuit->interface->ifindex;
327: sa.sll_halen = ETH_ALEN;
328: if (level == 1)
329: memcpy (&sa.sll_addr, ALL_L1_ISS, ETH_ALEN);
330: else
331: memcpy (&sa.sll_addr, ALL_L2_ISS, ETH_ALEN);
332:
333: /* on a broadcast circuit */
334: /* first we put the LLC in */
335: sock_buff[0] = 0xFE;
336: sock_buff[1] = 0xFE;
337: sock_buff[2] = 0x03;
338:
339: /* then we copy the data */
340: memcpy (sock_buff + LLC_LEN, circuit->snd_stream->data,
341: stream_get_endp (circuit->snd_stream));
342:
343: /* now we can send this */
344: written = sendto (circuit->fd, sock_buff,
345: stream_get_endp(circuit->snd_stream) + LLC_LEN, 0,
346: (struct sockaddr *) &sa, sizeof (struct sockaddr_ll));
347:
348: return ISIS_OK;
349: }
350:
351: int
352: isis_send_pdu_p2p (struct isis_circuit *circuit, int level)
353: {
354:
355: int written = 1;
356: struct sockaddr_ll sa;
357:
358: stream_set_getp (circuit->snd_stream, 0);
359: memset (&sa, 0, sizeof (struct sockaddr_ll));
360: sa.sll_family = AF_PACKET;
361: sa.sll_protocol = htons (stream_get_endp (circuit->snd_stream) + LLC_LEN);
362: sa.sll_ifindex = circuit->interface->ifindex;
363: sa.sll_halen = ETH_ALEN;
364: if (level == 1)
365: memcpy (&sa.sll_addr, ALL_L1_ISS, ETH_ALEN);
366: else
367: memcpy (&sa.sll_addr, ALL_L2_ISS, ETH_ALEN);
368:
369:
370: /* lets try correcting the protocol */
371: sa.sll_protocol = htons (0x00FE);
372: written = sendto (circuit->fd, circuit->snd_stream->data,
373: stream_get_endp (circuit->snd_stream), 0,
374: (struct sockaddr *) &sa,
375: sizeof (struct sockaddr_ll));
376:
377: return ISIS_OK;
378: }
379:
380: #endif /* ISIS_METHOD == ISIS_METHOD_PFPACKET */
FreeBSD-CVSweb <freebsd-cvsweb@FreeBSD.org>
![[BACK]](/icons/cvsweb/back.gif){kind=icon}
Return to isis_pfpacket.c CVS log ![[TXT]](/icons/cvsweb/text.gif){kind=icon}
![[DIR]](/icons/cvsweb/dir.gif){kind=icon}
Up to [ELWIX - Embedded LightWeight unIX -] / embedaddon / quagga / isisd