2 * Copyright (c) 2003 Jeffrey Hsu
3 * Copyright (c) 2003 Jonathan Lemon
4 * Copyright (c) 2003 Matthew Dillon
6 * $DragonFly: src/sys/net/netisr.c,v 1.9 2004/03/06 19:40:30 dillon Exp $
10 #include <sys/systm.h>
11 #include <sys/kernel.h>
12 #include <sys/malloc.h>
13 #include <sys/msgport.h>
15 #include <sys/interrupt.h>
16 #include <sys/socket.h>
17 #include <sys/sysctl.h>
19 #include <net/if_var.h>
20 #include <net/netisr.h>
21 #include <machine/cpufunc.h>
22 #include <machine/ipl.h>
24 #include <sys/thread2.h>
25 #include <sys/msgport2.h>
27 static struct netisr netisrs[NETISR_MAX];
29 /* Per-CPU thread to handle any protocol. */
30 struct thread netisr_cpu[MAXCPU];
31 lwkt_port netisr_afree_rport;
34 * netisr_afree_rport replymsg function, only used to handle async
35 * messages which the sender has abandoned to their fate.
38 netisr_autofree_reply(lwkt_port_t port, lwkt_msg_t msg)
48 /* Create default per-cpu threads for generic protocol handling. */
49 for (i = 0; i < ncpus; ++i) {
50 lwkt_create(netmsg_service_loop, NULL, NULL, &netisr_cpu[i], 0, i,
53 lwkt_initport(&netisr_afree_rport, NULL);
54 netisr_afree_rport.mp_replyport = netisr_autofree_reply;
57 SYSINIT(netisr, SI_SUB_PROTO_BEGIN, SI_ORDER_FIRST, netisr_init, NULL);
60 netmsg_service_loop(void *arg)
65 while ((msg = lwkt_waitport(&curthread->td_msgport, NULL))) {
66 error = msg->nm_handler(msg);
67 lwkt_replymsg(&msg->nm_lmsg, error);
72 * Call the netisr directly.
73 * Queueing may be done in the msg port layer at its discretion.
76 netisr_dispatch(int num, struct mbuf *m)
78 /* just queue it for now XXX JH */
83 * Same as netisr_dispatch(), but always queue.
84 * This is either used in places where we are not confident that
85 * direct dispatch is possible, or where queueing is required.
88 netisr_queue(int num, struct mbuf *m)
91 struct netmsg_packet *pmsg;
94 KASSERT((num > 0 && num <= (sizeof(netisrs)/sizeof(netisrs[0]))),
95 ("netisr_queue: bad isr %d", num));
98 if (ni->ni_handler == NULL) {
99 printf("netisr_queue: unregistered isr %d\n", num);
103 if (!(port = ni->ni_mport(m)))
106 /* use better message allocation system with limits later XXX JH */
107 if (!(pmsg = malloc(sizeof(struct netmsg_packet), M_LWKTMSG, M_NOWAIT)))
110 lwkt_initmsg_rp(&pmsg->nm_lmsg, &netisr_afree_rport, CMD_NETMSG_NEWPKT);
112 pmsg->nm_handler = ni->ni_handler;
113 lwkt_sendmsg(port, &pmsg->nm_lmsg);
118 netisr_register(int num, lwkt_portfn_t mportfn, netisr_fn_t handler)
120 KASSERT((num > 0 && num <= (sizeof(netisrs)/sizeof(netisrs[0]))),
121 ("netisr_register: bad isr %d", num));
123 netisrs[num].ni_mport = mportfn;
124 netisrs[num].ni_handler = handler;
128 netisr_unregister(int num)
130 KASSERT((num > 0 && num <= (sizeof(netisrs)/sizeof(netisrs[0]))),
131 ("unregister_netisr: bad isr number: %d\n", num));
138 * Return message port for default handler thread on CPU 0.
141 cpu0_portfn(struct mbuf *m)
143 return (&netisr_cpu[0].td_msgport);
148 cpu0_soport(struct socket *so __unused, struct sockaddr *nam __unused)
150 return (&netisr_cpu[0].td_msgport);
154 * This function is used to call the netisr handler from the appropriate
155 * netisr thread for polling and other purposes.
160 struct netisr *ni = &netisrs[num];
162 lwkt_port_t port = &netisr_cpu[0].td_msgport;
164 KASSERT((num > 0 && num <= (sizeof(netisrs)/sizeof(netisrs[0]))),
165 ("schednetisr: bad isr %d", num));
167 if (!(pmsg = malloc(sizeof(struct netmsg), M_LWKTMSG, M_NOWAIT)))
170 lwkt_initmsg_rp(&pmsg->nm_lmsg, &netisr_afree_rport, CMD_NETMSG_POLL);
171 pmsg->nm_handler = ni->ni_handler;
172 lwkt_sendmsg(port, &pmsg->nm_lmsg);