For kmalloc(), MALLOC() and contigmalloc(), use M_ZERO instead of
[dragonfly.git] / sys / netgraph / socket / ng_socket.c
1
2 /*
3  * ng_socket.c
4  *
5  * Copyright (c) 1996-1999 Whistle Communications, Inc.
6  * All rights reserved.
7  * 
8  * Subject to the following obligations and disclaimer of warranty, use and
9  * redistribution of this software, in source or object code forms, with or
10  * without modifications are expressly permitted by Whistle Communications;
11  * provided, however, that:
12  * 1. Any and all reproductions of the source or object code must include the
13  *    copyright notice above and the following disclaimer of warranties; and
14  * 2. No rights are granted, in any manner or form, to use Whistle
15  *    Communications, Inc. trademarks, including the mark "WHISTLE
16  *    COMMUNICATIONS" on advertising, endorsements, or otherwise except as
17  *    such appears in the above copyright notice or in the software.
18  * 
19  * THIS SOFTWARE IS BEING PROVIDED BY WHISTLE COMMUNICATIONS "AS IS", AND
20  * TO THE MAXIMUM EXTENT PERMITTED BY LAW, WHISTLE COMMUNICATIONS MAKES NO
21  * REPRESENTATIONS OR WARRANTIES, EXPRESS OR IMPLIED, REGARDING THIS SOFTWARE,
22  * INCLUDING WITHOUT LIMITATION, ANY AND ALL IMPLIED WARRANTIES OF
23  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE, OR NON-INFRINGEMENT.
24  * WHISTLE COMMUNICATIONS DOES NOT WARRANT, GUARANTEE, OR MAKE ANY
25  * REPRESENTATIONS REGARDING THE USE OF, OR THE RESULTS OF THE USE OF THIS
26  * SOFTWARE IN TERMS OF ITS CORRECTNESS, ACCURACY, RELIABILITY OR OTHERWISE.
27  * IN NO EVENT SHALL WHISTLE COMMUNICATIONS BE LIABLE FOR ANY DAMAGES
28  * RESULTING FROM OR ARISING OUT OF ANY USE OF THIS SOFTWARE, INCLUDING
29  * WITHOUT LIMITATION, ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY,
30  * PUNITIVE, OR CONSEQUENTIAL DAMAGES, PROCUREMENT OF SUBSTITUTE GOODS OR
31  * SERVICES, LOSS OF USE, DATA OR PROFITS, HOWEVER CAUSED AND UNDER ANY
32  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
33  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
34  * THIS SOFTWARE, EVEN IF WHISTLE COMMUNICATIONS IS ADVISED OF THE POSSIBILITY
35  * OF SUCH DAMAGE.
36  *
37  * Author: Julian Elischer <julian@freebsd.org>
38  *
39  * $FreeBSD: src/sys/netgraph/ng_socket.c,v 1.11.2.6 2002/07/02 22:17:18 archie Exp $
40  * $DragonFly: src/sys/netgraph/socket/ng_socket.c,v 1.15 2008/01/05 14:02:40 swildner Exp $
41  * $Whistle: ng_socket.c,v 1.28 1999/11/01 09:24:52 julian Exp $
42  */
43
44 /*
45  * Netgraph socket nodes
46  *
47  * There are two types of netgraph sockets, control and data.
48  * Control sockets have a netgraph node, but data sockets are
49  * parasitic on control sockets, and have no node of their own.
50  */
51
52 #include <sys/param.h>
53 #include <sys/systm.h>
54 #include <sys/proc.h>
55 #include <sys/domain.h>
56 #include <sys/errno.h>
57 #include <sys/kernel.h>
58 #include <sys/filedesc.h>
59 #include <sys/malloc.h>
60 #include <sys/queue.h>
61 #include <sys/mbuf.h>
62 #include <sys/protosw.h>
63 #include <sys/socket.h>
64 #include <sys/socketvar.h>
65 #include <sys/sysctl.h>
66 #include <sys/thread2.h>
67 #ifdef NOTYET
68 #include <sys/vnode.h>
69 #endif
70 #include <netgraph/ng_message.h>
71 #include <netgraph/netgraph.h>
72 #include "ng_socketvar.h"
73 #include "ng_socket.h"
74
75 /*
76  * It's Ascii-art time!
77  *   +-------------+   +-------------+
78  *   |socket  (ctl)|   |socket (data)|
79  *   +-------------+   +-------------+
80  *          ^                 ^
81  *          |                 |
82  *          v                 v
83  *    +-----------+     +-----------+
84  *    |pcb   (ctl)|     |pcb  (data)|
85  *    +-----------+     +-----------+
86  *          ^                 ^
87  *          |                 |
88  *          v                 v
89  *      +--------------------------+
90  *      |   Socket type private    |
91  *      |       data               |
92  *      +--------------------------+
93  *                   ^
94  *                   |
95  *                   v
96  *           +----------------+
97  *           | struct ng_node |
98  *           +----------------+
99  */
100
101 /* Netgraph node methods */
102 static ng_constructor_t ngs_constructor;
103 static ng_rcvmsg_t      ngs_rcvmsg;
104 static ng_shutdown_t    ngs_rmnode;
105 static ng_newhook_t     ngs_newhook;
106 static ng_rcvdata_t     ngs_rcvdata;
107 static ng_disconnect_t  ngs_disconnect;
108
109 /* Internal methods */
110 static int      ng_attach_data(struct socket *so);
111 static int      ng_attach_cntl(struct socket *so);
112 static int      ng_attach_common(struct socket *so, int type);
113 static void     ng_detach_common(struct ngpcb *pcbp, int type);
114 /*static int    ng_internalize(struct mbuf *m, struct thread *td); */
115
116 static int      ng_connect_data(struct sockaddr *nam, struct ngpcb *pcbp);
117 static int      ng_connect_cntl(struct sockaddr *nam, struct ngpcb *pcbp);
118 static int      ng_bind(struct sockaddr *nam, struct ngpcb *pcbp);
119
120 static int      ngs_mod_event(module_t mod, int event, void *data);
121 static int      ship_msg(struct ngpcb *pcbp, struct ng_mesg *msg,
122                         struct sockaddr_ng *addr);
123
124 /* Netgraph type descriptor */
125 static struct ng_type typestruct = {
126         NG_VERSION,
127         NG_SOCKET_NODE_TYPE,
128         ngs_mod_event,
129         ngs_constructor,
130         ngs_rcvmsg,
131         ngs_rmnode,
132         ngs_newhook,
133         NULL,
134         NULL,
135         ngs_rcvdata,
136         ngs_rcvdata,
137         ngs_disconnect,
138         NULL
139 };
140 NETGRAPH_INIT(socket, &typestruct);
141
142 /* Buffer space */
143 static u_long ngpdg_sendspace = 20 * 1024;      /* really max datagram size */
144 static u_long ngpdg_recvspace = 20 * 1024;
145
146 /* List of all sockets */
147 LIST_HEAD(, ngpcb) ngsocklist;
148
149 #define sotongpcb(so) ((struct ngpcb *)(so)->so_pcb)
150
151 /* If getting unexplained errors returned, set this to "Debugger("X"); */
152 #ifndef TRAP_ERROR
153 #define TRAP_ERROR
154 #endif
155
156 /***************************************************************
157         Control sockets
158 ***************************************************************/
159
160 static int
161 ngc_attach(struct socket *so, int proto, struct pru_attach_info *ai)
162 {
163         struct ngpcb *const pcbp = sotongpcb(so);
164
165         if (suser_cred(ai->p_ucred, NULL_CRED_OKAY) != 0)
166                 return (EPERM);
167         if (pcbp != NULL)
168                 return (EISCONN);
169         return (ng_attach_cntl(so));
170 }
171
172 static int
173 ngc_detach(struct socket *so)
174 {
175         struct ngpcb *const pcbp = sotongpcb(so);
176
177         if (pcbp == NULL)
178                 return (EINVAL);
179         ng_detach_common(pcbp, NG_CONTROL);
180         return (0);
181 }
182
183 static int
184 ngc_send(struct socket *so, int flags, struct mbuf *m, struct sockaddr *addr,
185          struct mbuf *control, struct thread *td)
186 {
187         struct ngpcb *const pcbp = sotongpcb(so);
188         struct sockaddr_ng *const sap = (struct sockaddr_ng *) addr;
189         struct ng_mesg *resp;
190         struct mbuf *m0;
191         char *msg, *path = NULL;
192         int len, error = 0;
193
194         if (pcbp == NULL) {
195                 error = EINVAL;
196                 goto release;
197         }
198 #ifdef  NOTYET
199         if (control && (error = ng_internalize(control, p))) {
200                 if (pcbp->sockdata == NULL) {
201                         error = ENOTCONN;
202                         goto release;
203                 }
204         }
205 #else   /* NOTYET */
206         if (control) {
207                 error = EINVAL;
208                 goto release;
209         }
210 #endif  /* NOTYET */
211
212         /* Require destination as there may be >= 1 hooks on this node */
213         if (addr == NULL) {
214                 error = EDESTADDRREQ;
215                 goto release;
216         }
217
218         /* Allocate an expendable buffer for the path, chop off
219          * the sockaddr header, and make sure it's NUL terminated */
220         len = sap->sg_len - 2;
221         MALLOC(path, char *, len + 1, M_NETGRAPH, M_WAITOK);
222         if (path == NULL) {
223                 error = ENOMEM;
224                 goto release;
225         }
226         bcopy(sap->sg_data, path, len);
227         path[len] = '\0';
228
229         /* Move the actual message out of mbufs into a linear buffer.
230          * Start by adding up the size of the data. (could use mh_len?) */
231         for (len = 0, m0 = m; m0 != NULL; m0 = m0->m_next)
232                 len += m0->m_len;
233
234         /* Move the data into a linear buffer as well. Messages are not
235          * delivered in mbufs. */
236         MALLOC(msg, char *, len + 1, M_NETGRAPH, M_WAITOK);
237         if (msg == NULL) {
238                 error = ENOMEM;
239                 goto release;
240         }
241         m_copydata(m, 0, len, msg);
242
243         /* The callee will free the msg when done. The addr is our business. */
244         error = ng_send_msg(pcbp->sockdata->node,
245                             (struct ng_mesg *) msg, path, &resp);
246
247         /* If the callee responded with a synchronous response, then put it
248          * back on the receive side of the socket; sap is source address. */
249         if (error == 0 && resp != NULL)
250                 error = ship_msg(pcbp, resp, sap);
251
252 release:
253         if (path != NULL)
254                 FREE(path, M_NETGRAPH);
255         if (control != NULL)
256                 m_freem(control);
257         if (m != NULL)
258                 m_freem(m);
259         return (error);
260 }
261
262 static int
263 ngc_bind(struct socket *so, struct sockaddr *nam, struct thread *td)
264 {
265         struct ngpcb *const pcbp = sotongpcb(so);
266
267         if (pcbp == 0)
268                 return (EINVAL);
269         return (ng_bind(nam, pcbp));
270 }
271
272 static int
273 ngc_connect(struct socket *so, struct sockaddr *nam, struct thread *td)
274 {
275         struct ngpcb *const pcbp = sotongpcb(so);
276
277         if (pcbp == 0)
278                 return (EINVAL);
279         return (ng_connect_cntl(nam, pcbp));
280 }
281
282 /***************************************************************
283         Data sockets
284 ***************************************************************/
285
286 static int
287 ngd_attach(struct socket *so, int proto, struct pru_attach_info *ai)
288 {
289         struct ngpcb *const pcbp = sotongpcb(so);
290
291         if (pcbp != NULL)
292                 return (EISCONN);
293         return (ng_attach_data(so));
294 }
295
296 static int
297 ngd_detach(struct socket *so)
298 {
299         struct ngpcb *const pcbp = sotongpcb(so);
300
301         if (pcbp == NULL)
302                 return (EINVAL);
303         ng_detach_common(pcbp, NG_DATA);
304         return (0);
305 }
306
307 static int
308 ngd_send(struct socket *so, int flags, struct mbuf *m, struct sockaddr *addr,
309          struct mbuf *control, struct thread *td)
310 {
311         struct ngpcb *const pcbp = sotongpcb(so);
312         struct sockaddr_ng *const sap = (struct sockaddr_ng *) addr;
313         meta_p  mp = NULL;
314         int     len, error;
315         hook_p  hook = NULL;
316         char    hookname[NG_HOOKSIZ];
317
318         if ((pcbp == NULL) || (control != NULL)) {
319                 error = EINVAL;
320                 goto release;
321         }
322         if (pcbp->sockdata == NULL) {
323                 error = ENOTCONN;
324                 goto release;
325         }
326         /*
327          * If the user used any of these ways to not specify an address
328          * then handle specially.
329          */
330         if ((sap == NULL)
331             || ((len = sap->sg_len - 2) <= 0)
332             || (*sap->sg_data == '\0')) {
333                 if (pcbp->sockdata->node->numhooks != 1) {
334                         error = EDESTADDRREQ;
335                         goto release;
336                 }
337                 /*
338                  * if exactly one hook exists, just use it.
339                  * Special case to allow write(2) to work on an ng_socket.
340                  */
341                 hook = LIST_FIRST(&pcbp->sockdata->node->hooks);
342         } else {
343                 if (len >= NG_HOOKSIZ) {
344                         error = EINVAL;
345                         goto release;
346                 }
347
348                 /*
349                  * chop off the sockaddr header, and make sure it's NUL
350                  * terminated
351                  */
352                 bcopy(sap->sg_data, hookname, len);
353                 hookname[len] = '\0';
354
355                 /* Find the correct hook from 'hookname' */
356                 LIST_FOREACH(hook, &pcbp->sockdata->node->hooks, hooks) {
357                         if (strcmp(hookname, hook->name) == 0)
358                                 break;
359                 }
360                 if (hook == NULL)
361                         error = EHOSTUNREACH;
362         }
363
364         /* Send data (OK if hook is NULL) */
365         NG_SEND_DATA(error, hook, m, mp);       /* makes m NULL */
366
367 release:
368         if (control != NULL)
369                 m_freem(control);
370         if (m != NULL)
371                 m_freem(m);
372         return (error);
373 }
374
375 static int
376 ngd_connect(struct socket *so, struct sockaddr *nam, struct thread *td)
377 {
378         struct ngpcb *const pcbp = sotongpcb(so);
379
380         if (pcbp == 0)
381                 return (EINVAL);
382         return (ng_connect_data(nam, pcbp));
383 }
384
385 /*
386  * Used for both data and control sockets
387  */
388 static int
389 ng_setsockaddr(struct socket *so, struct sockaddr **addr)
390 {
391         struct ngpcb *pcbp;
392         struct sockaddr_ng *sg;
393         int sg_len, namelen;
394
395         /* Why isn't sg_data a `char[1]' ? :-( */
396         sg_len = sizeof(struct sockaddr_ng) - sizeof(sg->sg_data) + 1;
397
398         crit_enter();
399         pcbp = sotongpcb(so);
400         if ((pcbp == 0) || (pcbp->sockdata == NULL)) {
401                 crit_exit();
402                 return (EINVAL);
403         }
404
405         namelen = 0;            /* silence compiler ! */
406
407         if (pcbp->sockdata->node->name != NULL)
408                 sg_len += namelen = strlen(pcbp->sockdata->node->name);
409
410         MALLOC(sg, struct sockaddr_ng *, sg_len, M_SONAME, M_WAITOK | M_ZERO);
411
412         if (pcbp->sockdata->node->name != NULL)
413                 bcopy(pcbp->sockdata->node->name, sg->sg_data, namelen);
414         crit_exit();
415
416         sg->sg_len = sg_len;
417         sg->sg_family = AF_NETGRAPH;
418         *addr = (struct sockaddr *)sg;
419
420         return (0);
421 }
422
423 /*
424  * Attach a socket to it's protocol specific partner.
425  * For a control socket, actually create a netgraph node and attach
426  * to it as well.
427  */
428
429 static int
430 ng_attach_cntl(struct socket *so)
431 {
432         struct ngsock *privdata;
433         struct ngpcb *pcbp;
434         int error;
435
436         /* Setup protocol control block */
437         if ((error = ng_attach_common(so, NG_CONTROL)) != 0)
438                 return (error);
439         pcbp = sotongpcb(so);
440
441         /* Allocate node private info */
442         MALLOC(privdata, struct ngsock *,
443             sizeof(*privdata), M_NETGRAPH, M_WAITOK | M_ZERO);
444         if (privdata == NULL) {
445                 ng_detach_common(pcbp, NG_CONTROL);
446                 return (ENOMEM);
447         }
448
449         /* Make the generic node components */
450         if ((error = ng_make_node_common(&typestruct, &privdata->node)) != 0) {
451                 FREE(privdata, M_NETGRAPH);
452                 ng_detach_common(pcbp, NG_CONTROL);
453                 return (error);
454         }
455         privdata->node->private = privdata;
456
457         /* Link the pcb and the node private data */
458         privdata->ctlsock = pcbp;
459         pcbp->sockdata = privdata;
460         privdata->refs++;
461         return (0);
462 }
463
464 static int
465 ng_attach_data(struct socket *so)
466 {
467         return(ng_attach_common(so, NG_DATA));
468 }
469
470 /*
471  * Set up a socket protocol control block.
472  * This code is shared between control and data sockets.
473  */
474 static int
475 ng_attach_common(struct socket *so, int type)
476 {
477         struct ngpcb *pcbp;
478         int error;
479
480         /* Standard socket setup stuff */
481         error = soreserve(so, ngpdg_sendspace, ngpdg_recvspace, NULL);
482         if (error)
483                 return (error);
484
485         /* Allocate the pcb */
486         MALLOC(pcbp, struct ngpcb *, sizeof(*pcbp), M_PCB, M_WAITOK | M_ZERO);
487         if (pcbp == NULL)
488                 return (ENOMEM);
489         pcbp->type = type;
490
491         /* Link the pcb and the socket */
492         so->so_pcb = (caddr_t) pcbp;
493         pcbp->ng_socket = so;
494
495         /* Add the socket to linked list */
496         LIST_INSERT_HEAD(&ngsocklist, pcbp, socks);
497         return (0);
498 }
499
500 /*
501  * Disassociate the socket from it's protocol specific
502  * partner. If it's attached to a node's private data structure,
503  * then unlink from that too. If we were the last socket attached to it,
504  * then shut down the entire node. Shared code for control and data sockets.
505  */
506 static void
507 ng_detach_common(struct ngpcb *pcbp, int which)
508 {
509         struct ngsock *sockdata;
510
511         if (pcbp->sockdata) {
512                 sockdata = pcbp->sockdata;
513                 pcbp->sockdata = NULL;
514                 switch (which) {
515                 case NG_CONTROL:
516                         sockdata->ctlsock = NULL;
517                         break;
518                 case NG_DATA:
519                         sockdata->datasock = NULL;
520                         break;
521                 default:
522                         panic(__func__);
523                 }
524                 if ((--sockdata->refs == 0) && (sockdata->node != NULL))
525                         ng_rmnode(sockdata->node);
526         }
527         pcbp->ng_socket->so_pcb = NULL;
528         pcbp->ng_socket = NULL;
529         LIST_REMOVE(pcbp, socks);
530         FREE(pcbp, M_PCB);
531 }
532
533 #ifdef NOTYET
534 /*
535  * File descriptors can be passed into a AF_NETGRAPH socket.
536  * Note, that file descriptors cannot be passed OUT.
537  * Only character device descriptors are accepted.
538  * Character devices are useful to connect a graph to a device,
539  * which after all is the purpose of this whole system.
540  */
541 static int
542 ng_internalize(struct mbuf *control, struct thread *td)
543 {
544         struct filedesc *fdp = p->p_fd;
545         const struct cmsghdr *cm = mtod(control, const struct cmsghdr *);
546         struct file *fp;
547         struct vnode *vn;
548         int oldfds;
549         int fd;
550
551         if (cm->cmsg_type != SCM_RIGHTS || cm->cmsg_level != SOL_SOCKET ||
552             cm->cmsg_len != control->m_len) {
553                 TRAP_ERROR;
554                 return (EINVAL);
555         }
556
557         /* Check there is only one FD. XXX what would more than one signify? */
558         oldfds = (cm->cmsg_len - sizeof(*cm)) / sizeof(int);
559         if (oldfds != 1) {
560                 TRAP_ERROR;
561                 return (EINVAL);
562         }
563
564         /* Check that the FD given is legit. and change it to a pointer to a
565          * struct file. */
566         fd = *(int *) (cm + 1);
567         if ((unsigned) fd >= fdp->fd_nfiles
568             || (fp = fdp->fd_files[fd].fp) == NULL) {
569                 return (EBADF);
570         }
571
572         /* Depending on what kind of resource it is, act differently. For
573          * devices, we treat it as a file. For a AF_NETGRAPH socket,
574          * shortcut straight to the node. */
575         switch (fp->f_type) {
576         case DTYPE_VNODE:
577                 vn = (struct vnode *) fp->f_data;
578                 if (vn && (vn->v_type == VCHR)) {
579                         /* for a VCHR, actually reference the FILE */
580                         fp->f_count++;
581                         /* XXX then what :) */
582                         /* how to pass on to other modules? */
583                 } else {
584                         TRAP_ERROR;
585                         return (EINVAL);
586                 }
587                 break;
588         default:
589                 TRAP_ERROR;
590                 return (EINVAL);
591         }
592         return (0);
593 }
594 #endif  /* NOTYET */
595
596 /*
597  * Connect the data socket to a named control socket node.
598  */
599 static int
600 ng_connect_data(struct sockaddr *nam, struct ngpcb *pcbp)
601 {
602         struct sockaddr_ng *sap;
603         node_p farnode;
604         struct ngsock *sockdata;
605         int error;
606
607         /* If we are already connected, don't do it again */
608         if (pcbp->sockdata != NULL)
609                 return (EISCONN);
610
611         /* Find the target (victim) and check it doesn't already have a data
612          * socket. Also check it is a 'socket' type node. */
613         sap = (struct sockaddr_ng *) nam;
614         if ((error = ng_path2node(NULL, sap->sg_data, &farnode, NULL)))
615                 return (error);
616
617         if (strcmp(farnode->type->name, NG_SOCKET_NODE_TYPE) != 0)
618                 return (EINVAL);
619         sockdata = farnode->private;
620         if (sockdata->datasock != NULL)
621                 return (EADDRINUSE);
622
623         /* Link the PCB and the private data struct. and note the extra
624          * reference */
625         sockdata->datasock = pcbp;
626         pcbp->sockdata = sockdata;
627         sockdata->refs++;
628         return (0);
629 }
630
631 /*
632  * Connect the existing control socket node to a named node:hook.
633  * The hook we use on this end is the same name as the remote node name.
634  */
635 static int
636 ng_connect_cntl(struct sockaddr *nam, struct ngpcb *pcbp)
637 {
638         struct ngsock *const sockdata = pcbp->sockdata;
639         struct sockaddr_ng *sap;
640         char *node, *hook;
641         node_p farnode;
642         int rtn, error;
643
644         sap = (struct sockaddr_ng *) nam;
645         rtn = ng_path_parse(sap->sg_data, &node, NULL, &hook);
646         if (rtn < 0 || node == NULL || hook == NULL) {
647                 TRAP_ERROR;
648                 return (EINVAL);
649         }
650         farnode = ng_findname(sockdata->node, node);
651         if (farnode == NULL) {
652                 TRAP_ERROR;
653                 return (EADDRNOTAVAIL);
654         }
655
656         /* Connect, using a hook name the same as the far node name. */
657         error = ng_con_nodes(sockdata->node, node, farnode, hook);
658         return error;
659 }
660
661 /*
662  * Binding a socket means giving the corresponding node a name
663  */
664 static int
665 ng_bind(struct sockaddr *nam, struct ngpcb *pcbp)
666 {
667         struct ngsock *const sockdata = pcbp->sockdata;
668         struct sockaddr_ng *const sap = (struct sockaddr_ng *) nam;
669
670         if (sockdata == NULL) {
671                 TRAP_ERROR;
672                 return (EINVAL);
673         }
674         if (sap->sg_len < 3 || sap->sg_data[sap->sg_len - 3] != '\0') {
675                 TRAP_ERROR;
676                 return (EINVAL);
677         }
678         return (ng_name_node(sockdata->node, sap->sg_data));
679 }
680
681 /*
682  * Take a message and pass it up to the control socket associated
683  * with the node.
684  */
685 static int
686 ship_msg(struct ngpcb *pcbp, struct ng_mesg *msg, struct sockaddr_ng *addr)
687 {
688         struct socket *const so = pcbp->ng_socket;
689         struct mbuf *mdata;
690         int msglen;
691
692         /* Copy the message itself into an mbuf chain */
693         msglen = sizeof(struct ng_mesg) + msg->header.arglen;
694         mdata = m_devget((caddr_t) msg, msglen, 0, NULL, NULL);
695
696         /* Here we free the message, as we are the end of the line.
697          * We need to do that regardless of whether we got mbufs. */
698         FREE(msg, M_NETGRAPH);
699
700         if (mdata == NULL) {
701                 TRAP_ERROR;
702                 return (ENOBUFS);
703         }
704
705         /* Send it up to the socket */
706         if (ssb_appendaddr(&so->so_rcv,
707             (struct sockaddr *) addr, mdata, NULL) == 0) {
708                 TRAP_ERROR;
709                 m_freem(mdata);
710                 return (ENOBUFS);
711         }
712         sorwakeup(so);
713         return (0);
714 }
715
716 /*
717  * You can only create new nodes from the socket end of things.
718  */
719 static int
720 ngs_constructor(node_p *nodep)
721 {
722         return (EINVAL);
723 }
724
725 /*
726  * We allow any hook to be connected to the node.
727  * There is no per-hook private information though.
728  */
729 static int
730 ngs_newhook(node_p node, hook_p hook, const char *name)
731 {
732         hook->private = node->private;
733         return (0);
734 }
735
736 /*
737  * Incoming messages get passed up to the control socket.
738  * Unless they are for us specifically (socket_type)
739  */
740 static int
741 ngs_rcvmsg(node_p node, struct ng_mesg *msg, const char *retaddr,
742            struct ng_mesg **resp)
743 {
744         struct ngsock *const sockdata = node->private;
745         struct ngpcb *const pcbp = sockdata->ctlsock;
746         struct sockaddr_ng *addr;
747         int addrlen;
748         int error = 0;
749
750         /* Only allow mesgs to be passed if we have the control socket.
751          * Data sockets can only support the generic messages. */
752         if (pcbp == NULL) {
753                 TRAP_ERROR;
754                 return (EINVAL);
755         }
756
757         if (msg->header.typecookie == NGM_SOCKET_COOKIE) {
758                 switch (msg->header.cmd) {
759                 case NGM_SOCK_CMD_NOLINGER:
760                         sockdata->flags |= NGS_FLAG_NOLINGER;
761                         break;
762                 case NGM_SOCK_CMD_LINGER:
763                         sockdata->flags &= ~NGS_FLAG_NOLINGER;
764                         break;
765                 default:
766                         error = EINVAL;         /* unknown command */
767                 }
768                 /* Free the message and return */
769                 FREE(msg, M_NETGRAPH);
770                 return(error);
771
772         }
773         /* Get the return address into a sockaddr */
774         if ((retaddr == NULL) || (*retaddr == '\0'))
775                 retaddr = "";
776         addrlen = strlen(retaddr);
777         MALLOC(addr, struct sockaddr_ng *, addrlen + 4, M_NETGRAPH, M_NOWAIT);
778         if (addr == NULL) {
779                 TRAP_ERROR;
780                 return (ENOMEM);
781         }
782         addr->sg_len = addrlen + 3;
783         addr->sg_family = AF_NETGRAPH;
784         bcopy(retaddr, addr->sg_data, addrlen);
785         addr->sg_data[addrlen] = '\0';
786
787         /* Send it up */
788         error = ship_msg(pcbp, msg, addr);
789         FREE(addr, M_NETGRAPH);
790         return (error);
791 }
792
793 /*
794  * Receive data on a hook
795  */
796 static int
797 ngs_rcvdata(hook_p hook, struct mbuf *m, meta_p meta)
798 {
799         struct ngsock *const sockdata = hook->node->private;
800         struct ngpcb *const pcbp = sockdata->datasock;
801         struct socket *so;
802         struct sockaddr_ng *addr;
803         char *addrbuf[NG_HOOKSIZ + 4];
804         int addrlen;
805
806         /* If there is no data socket, black-hole it */
807         if (pcbp == NULL) {
808                 NG_FREE_DATA(m, meta);
809                 return (0);
810         }
811         so = pcbp->ng_socket;
812
813         /* Get the return address into a sockaddr. */
814         addrlen = strlen(hook->name);   /* <= NG_HOOKSIZ - 1 */
815         addr = (struct sockaddr_ng *) addrbuf;
816         addr->sg_len = addrlen + 3;
817         addr->sg_family = AF_NETGRAPH;
818         bcopy(hook->name, addr->sg_data, addrlen);
819         addr->sg_data[addrlen] = '\0';
820
821         /* We have no use for the meta data, free/clear it now. */
822         NG_FREE_META(meta);
823
824         /* Try to tell the socket which hook it came in on */
825         if (ssb_appendaddr(&so->so_rcv, (struct sockaddr *) addr, m, NULL) == 0) {
826                 m_freem(m);
827                 TRAP_ERROR;
828                 return (ENOBUFS);
829         }
830         sorwakeup(so);
831         return (0);
832 }
833
834 /*
835  * Hook disconnection
836  *
837  * For this type, removal of the last link destroys the node
838  * if the NOLINGER flag is set.
839  */
840 static int
841 ngs_disconnect(hook_p hook)
842 {
843         struct ngsock *const sockdata = hook->node->private;
844
845         if ((sockdata->flags & NGS_FLAG_NOLINGER )
846         && (hook->node->numhooks == 0)) {
847                 ng_rmnode(hook->node);
848         }
849         return (0);
850 }
851
852 /*
853  * Do local shutdown processing.
854  * In this case, that involves making sure the socket
855  * knows we should be shutting down.
856  */
857 static int
858 ngs_rmnode(node_p node)
859 {
860         struct ngsock *const sockdata = node->private;
861         struct ngpcb *const dpcbp = sockdata->datasock;
862         struct ngpcb *const pcbp = sockdata->ctlsock;
863
864         ng_cutlinks(node);
865         ng_unname(node);
866
867         if (dpcbp != NULL) {
868                 soisdisconnected(dpcbp->ng_socket);
869                 dpcbp->sockdata = NULL;
870                 sockdata->datasock = NULL;
871                 sockdata->refs--;
872         }
873         if (pcbp != NULL) {
874                 soisdisconnected(pcbp->ng_socket);
875                 pcbp->sockdata = NULL;
876                 sockdata->ctlsock = NULL;
877                 sockdata->refs--;
878         }
879         node->private = NULL;
880         ng_unref(node);
881         FREE(sockdata, M_NETGRAPH);
882         return (0);
883 }
884
885 /*
886  * Control and data socket type descriptors
887  */
888
889 static struct pr_usrreqs ngc_usrreqs = {
890         .pru_abort = NULL,
891         .pru_accept = pru_accept_notsupp,
892         .pru_attach = ngc_attach,
893         .pru_bind = ngc_bind,
894         .pru_connect = ngc_connect,
895         .pru_connect2 = pru_connect2_notsupp,
896         .pru_control = pru_control_notsupp,
897         .pru_detach = ngc_detach,
898         .pru_disconnect = NULL,
899         .pru_listen = pru_listen_notsupp,
900         .pru_peeraddr = NULL,
901         .pru_rcvd = pru_rcvd_notsupp,
902         .pru_rcvoob = pru_rcvoob_notsupp,
903         .pru_send = ngc_send,
904         .pru_sense = pru_sense_null,
905         .pru_shutdown = NULL,
906         .pru_sockaddr = ng_setsockaddr,
907         .pru_sosend = sosend,
908         .pru_soreceive = soreceive,
909         .pru_sopoll = sopoll
910 };
911
912 static struct pr_usrreqs ngd_usrreqs = {
913         .pru_abort = NULL,
914         .pru_accept = pru_accept_notsupp,
915         .pru_attach = ngd_attach,
916         .pru_bind = NULL,
917         .pru_connect = ngd_connect,
918         .pru_connect2 = pru_connect2_notsupp,
919         .pru_control = pru_control_notsupp,
920         .pru_detach = ngd_detach,
921         .pru_disconnect = NULL,
922         .pru_listen = pru_listen_notsupp,
923         .pru_peeraddr = NULL,
924         .pru_rcvd = pru_rcvd_notsupp,
925         .pru_rcvoob = pru_rcvoob_notsupp,
926         .pru_send = ngd_send,
927         .pru_sense = pru_sense_null,
928         .pru_shutdown = NULL,
929         .pru_sockaddr = ng_setsockaddr,
930         .pru_sosend = sosend,
931         .pru_soreceive = soreceive,
932         .pru_sopoll = sopoll
933 };
934
935 /*
936  * Definitions of protocols supported in the NETGRAPH domain.
937  */
938
939 extern struct domain ngdomain;          /* stop compiler warnings */
940
941 static struct protosw ngsw[] = {
942         {
943                 SOCK_DGRAM,
944                 &ngdomain,
945                 NG_CONTROL,
946                 PR_ATOMIC | PR_ADDR /* | PR_RIGHTS */,
947                 0, 0, 0, 0,
948                 cpu0_soport,
949                 0, 0, 0, 0,
950                 &ngc_usrreqs
951         },
952         {
953                 SOCK_DGRAM,
954                 &ngdomain,
955                 NG_DATA,
956                 PR_ATOMIC | PR_ADDR,
957                 0, 0, 0, 0,
958                 cpu0_soport,
959                 0, 0, 0, 0,
960                 &ngd_usrreqs
961         }
962 };
963
964 struct domain ngdomain = {
965         AF_NETGRAPH, "netgraph", NULL, NULL, NULL,
966         ngsw, &ngsw[sizeof(ngsw) / sizeof(ngsw[0])],
967 };
968
969 /*
970  * Handle loading and unloading for this node type
971  * This is to handle auxiliary linkages (e.g protocol domain addition).
972  */
973 static int
974 ngs_mod_event(module_t mod, int event, void *data)
975 {
976         int error = 0;
977
978         switch (event) {
979         case MOD_LOAD:
980                 /* Register protocol domain */
981                 net_add_domain(&ngdomain);
982                 break;
983         case MOD_UNLOAD:
984                 /* Insure there are no open netgraph sockets */
985                 if (!LIST_EMPTY(&ngsocklist)) {
986                         error = EBUSY;
987                         break;
988                 }
989
990 #ifdef NOTYET
991                 /* Unregister protocol domain XXX can't do this yet.. */
992                 if ((error = net_rm_domain(&ngdomain)) != 0)
993                         break;
994 #else
995                 error = EBUSY;
996 #endif
997                 break;
998         default:
999                 error = EOPNOTSUPP;
1000                 break;
1001         }
1002         return (error);
1003 }
1004
1005 SYSCTL_INT(_net_graph, OID_AUTO, family, CTLFLAG_RD, 0, AF_NETGRAPH, "");
1006 SYSCTL_NODE(_net_graph, OID_AUTO, data, CTLFLAG_RW, 0, "DATA");
1007 SYSCTL_INT(_net_graph_data, OID_AUTO, proto, CTLFLAG_RD, 0, NG_DATA, "");
1008 SYSCTL_NODE(_net_graph, OID_AUTO, control, CTLFLAG_RW, 0, "CONTROL");
1009 SYSCTL_INT(_net_graph_control, OID_AUTO, proto, CTLFLAG_RD, 0, NG_CONTROL, "");
1010