2 * Copyright (c) 2003-2004 Benno Rice <benno@eloquent.com.au>
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
8 * 1. Redistributions of source code must retain the above copyright
9 * notice, this list of conditions and the following disclaimer.
10 * 2. Redistributions in binary form must reproduce the above copyright
11 * notice, this list of conditions and the following disclaimer in the
12 * documentation and/or other materials provided with the distribution.
14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND
15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE
18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
29 #include <sys/param.h>
30 #include <sys/systm.h>
31 #include <sys/kernel.h>
32 #include <sys/malloc.h>
34 #include <sys/socket.h>
35 #include <sys/sockio.h>
37 #include <netgraph/ng_message.h>
38 #include <netgraph/netgraph.h>
39 #include <netgraph/ng_atmllc.h>
42 #include <net/ethernet.h> /* for M_HASFCS and ETHER_HDR_LEN */
44 #define NG_ATMLLC_HEADER "\252\252\3\0\200\302"
45 #define NG_ATMLLC_HEADER_LEN (sizeof(struct atmllc))
46 #define NG_ATMLLC_TYPE_ETHERNET_FCS 0x0001
47 #define NG_ATMLLC_TYPE_FDDI_FCS 0x0004
48 #define NG_ATMLLC_TYPE_ETHERNET_NOFCS 0x0007
49 #define NG_ATMLLC_TYPE_FDDI_NOFCS 0x000A
51 struct ng_atmllc_priv {
58 uint8_t llchdr[6]; /* aa.aa.03.00.00.00 */
59 uint8_t type[2]; /* "ethernet" type */
62 /* ATM_LLC macros: note type code in host byte order */
63 #define ATM_LLC_TYPE(X) (((X)->type[0] << 8) | ((X)->type[1]))
64 #define ATM_LLC_SETTYPE(X, V) do { \
65 (X)->type[0] = ((V) >> 8) & 0xff; \
66 (X)->type[1] = ((V) & 0xff); \
69 /* Netgraph methods. */
70 static ng_constructor_t ng_atmllc_constructor;
71 static ng_shutdown_t ng_atmllc_shutdown;
72 static ng_rcvmsg_t ng_atmllc_rcvmsg;
73 static ng_newhook_t ng_atmllc_newhook;
74 static ng_rcvdata_t ng_atmllc_rcvdata;
75 static ng_disconnect_t ng_atmllc_disconnect;
77 static struct ng_type ng_atmllc_typestruct = {
78 .version = NG_ABI_VERSION,
79 .name = NG_ATMLLC_NODE_TYPE,
80 .constructor = ng_atmllc_constructor,
81 .rcvmsg = ng_atmllc_rcvmsg,
82 .shutdown = ng_atmllc_shutdown,
83 .newhook = ng_atmllc_newhook,
84 .rcvdata = ng_atmllc_rcvdata,
85 .disconnect = ng_atmllc_disconnect,
87 NETGRAPH_INIT(atmllc, &ng_atmllc_typestruct);
90 ng_atmllc_constructor(node_p node)
92 struct ng_atmllc_priv *priv;
94 priv = malloc(sizeof(*priv), M_NETGRAPH, M_WAITOK | M_ZERO);
95 NG_NODE_SET_PRIVATE(node, priv);
101 ng_atmllc_rcvmsg(node_p node, item_p item, hook_p lasthook)
107 NGI_GET_MSG(item, msg);
108 msg->header.flags |= NGF_RESP;
109 NG_RESPOND_MSG(error, node, item, msg);
114 ng_atmllc_shutdown(node_p node)
116 struct ng_atmllc_priv *priv;
118 priv = NG_NODE_PRIVATE(node);
120 free(priv, M_NETGRAPH);
128 ng_atmllc_newhook(node_p node, hook_p hook, const char *name)
130 struct ng_atmllc_priv *priv;
132 priv = NG_NODE_PRIVATE(node);
134 if (strcmp(name, NG_ATMLLC_HOOK_ATM) == 0) {
135 if (priv->atm != NULL) {
139 } else if (strcmp(name, NG_ATMLLC_HOOK_ETHER) == 0) {
140 if (priv->ether != NULL) {
144 } else if (strcmp(name, NG_ATMLLC_HOOK_FDDI) == 0) {
145 if (priv->fddi != NULL) {
157 ng_atmllc_rcvdata(hook_p hook, item_p item)
159 struct ng_atmllc_priv *priv;
166 priv = NG_NODE_PRIVATE(NG_HOOK_NODE(hook));
171 if (hook == priv->atm) {
172 /* Ditch the psuedoheader. */
173 hdr = mtod(m, struct atmllc *);
174 /* m_adj(m, sizeof(struct atm_pseudohdr)); */
177 * Make sure we have the LLC and ethernet headers.
178 * The ethernet header size is slightly larger than the FDDI
179 * header, which is convenient.
181 if (m->m_len < sizeof(struct atmllc) + ETHER_HDR_LEN) {
182 m = m_pullup(m, sizeof(struct atmllc) + ETHER_HDR_LEN);
189 /* Decode the LLC header. */
190 hdr = mtod(m, struct atmllc *);
191 if (ATM_LLC_TYPE(hdr) == NG_ATMLLC_TYPE_ETHERNET_NOFCS) {
192 m->m_flags &= ~M_HASFCS;
193 outhook = priv->ether;
195 } else if (ATM_LLC_TYPE(hdr) == NG_ATMLLC_TYPE_ETHERNET_FCS) {
196 m->m_flags |= M_HASFCS;
197 outhook = priv->ether;
199 } else if (ATM_LLC_TYPE(hdr) == NG_ATMLLC_TYPE_FDDI_NOFCS) {
200 m->m_flags &= ~M_HASFCS;
201 outhook = priv->fddi;
203 } else if (ATM_LLC_TYPE(hdr) == NG_ATMLLC_TYPE_FDDI_FCS) {
204 m->m_flags |= M_HASFCS;
205 outhook = priv->fddi;
208 printf("ng_atmllc: unknown type: %x\n",
212 /* Remove the LLC header and any padding*/
213 m_adj(m, sizeof(struct atmllc) + padding);
214 } else if (hook == priv->ether) {
215 /* Add the LLC header */
216 M_PREPEND(m, NG_ATMLLC_HEADER_LEN + 2, M_NOWAIT);
218 printf("ng_atmllc: M_PREPEND failed\n");
222 hdr = mtod(m, struct atmllc *);
223 bzero((void *)hdr, sizeof(struct atmllc) + 2);
224 bcopy(NG_ATMLLC_HEADER, hdr->llchdr, 6);
225 if ((m->m_flags & M_HASFCS) != 0) {
226 ATM_LLC_SETTYPE(hdr, NG_ATMLLC_TYPE_ETHERNET_FCS);
228 ATM_LLC_SETTYPE(hdr, NG_ATMLLC_TYPE_ETHERNET_NOFCS);
231 } else if (hook == priv->fddi) {
232 /* Add the LLC header */
233 M_PREPEND(m, NG_ATMLLC_HEADER_LEN + 3, M_NOWAIT);
235 printf("ng_atmllc: M_PREPEND failed\n");
239 hdr = mtod(m, struct atmllc *);
240 bzero((void *)hdr, sizeof(struct atmllc) + 3);
241 bcopy(NG_ATMLLC_HEADER, hdr->llchdr, 6);
242 if ((m->m_flags & M_HASFCS) != 0) {
243 ATM_LLC_SETTYPE(hdr, NG_ATMLLC_TYPE_FDDI_FCS);
245 ATM_LLC_SETTYPE(hdr, NG_ATMLLC_TYPE_FDDI_NOFCS);
250 if (outhook == NULL) {
256 NG_FWD_NEW_DATA(error, item, outhook, m);
261 ng_atmllc_disconnect(hook_p hook)
264 struct ng_atmllc_priv *priv;
266 node = NG_HOOK_NODE(hook);
267 priv = NG_NODE_PRIVATE(node);
269 if (hook == priv->atm) {
271 } else if (hook == priv->ether) {
273 } else if (hook == priv->fddi) {
277 if (NG_NODE_NUMHOOKS(node) == 0 && NG_NODE_IS_VALID(node)) {
278 ng_rmnode_self(node);