2 * Copyright (c) 2003 Matthew Dillon <dillon@backplane.com>
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 AND CONTRIBUTORS ``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 OR CONTRIBUTORS 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
26 * $DragonFly: src/sys/kern/lwkt_msgport.c,v 1.5 2003/08/12 02:36:15 dillon Exp $
29 #include <sys/param.h>
30 #include <sys/systm.h>
31 #include <sys/kernel.h>
33 #include <sys/rtprio.h>
34 #include <sys/queue.h>
35 #include <sys/sysctl.h>
36 #include <sys/kthread.h>
37 #include <machine/cpu.h>
41 #include <vm/vm_param.h>
42 #include <vm/vm_kern.h>
43 #include <vm/vm_object.h>
44 #include <vm/vm_page.h>
45 #include <vm/vm_map.h>
46 #include <vm/vm_pager.h>
47 #include <vm/vm_extern.h>
48 #include <vm/vm_zone.h>
50 #include <sys/thread2.h>
51 #include <sys/msgport2.h>
53 #include <machine/stdarg.h>
54 #include <machine/ipl.h>
56 #include <machine/smp.h>
60 /************************************************************************
62 ************************************************************************/
64 static void lwkt_replyport_remote(lwkt_msg_t msg);
65 static void lwkt_putport_remote(lwkt_msg_t msg);
66 static void lwkt_abortport_remote(lwkt_port_t port);
69 lwkt_initmsg_td(lwkt_msg_t msg, thread_t td)
71 lwkt_initmsg(msg, &td->td_msgport, 0);
77 * Send a message asynchronously. This function requests asynchronous
78 * completion and calls lwkt_beginmsg(). If the target port decides to
79 * run the message synchronously this function will automatically queue
80 * the message to the current thread's message queue to present a
81 * consistent interface to the caller.
83 * The message's ms_cmd must be initialized and its ms_flags must be
84 * at least zero'd out. lwkt_sendmsg() will initialize the message's
85 * reply port to the current thread's built-in reply port.
88 lwkt_sendmsg(lwkt_port_t port, lwkt_msg_t msg)
92 msg->ms_flags |= MSGF_ASYNC;
93 msg->ms_flags &= ~(MSGF_REPLY | MSGF_QUEUED);
94 msg->ms_reply_port = &curthread->td_msgport;
96 if ((error = lwkt_beginmsg(port, msg)) != EASYNC) {
97 lwkt_replymsg(msg, error);
104 * Send a message synchronously. This function requests synchronous
105 * completion and calls lwkt_beginmsg(). If the target port decides to
106 * run the message asynchronously this function will block waiting for
107 * the message to complete. Since MSGF_ASYNC is not set the target
108 * will not attempt to queue the reply to a reply port but will simply
109 * wake up anyone waiting on the message.
111 * A synchronous error code is always returned.
113 * The message's ms_cmd must be initialized and its ms_flags must be
114 * at least zero'd out. lwkt_domsg() will initialize the message's
115 * reply port to the current thread's built-in reply port.
118 lwkt_domsg(lwkt_port_t port, lwkt_msg_t msg)
122 msg->ms_flags &= ~(MSGF_ASYNC | MSGF_REPLY | MSGF_QUEUED);
123 msg->ms_reply_port = &curthread->td_msgport;
124 msg->ms_abortreq = 0;
125 if ((error = lwkt_beginmsg(port, msg)) == EASYNC) {
126 error = lwkt_waitmsg(msg);
134 * Wait for a message that we originated to complete, remove it from
135 * the reply queue if necessary, and return its error code.
137 * This call may be used in virtually any situation, including for the
138 * case where you used lwkt_sendmsg() to initiate the message.
140 * Note that we don't own the message any more so we cannot safely
141 * modify ms_flags, meaning we can't clear MSGF_ASYNC as an optimization.
142 * However, since any remote cpu replying to the message will IPI the
143 * message over to us for action, a critical section is sufficient to
147 lwkt_waitmsg(lwkt_msg_t msg)
152 * Done but not queued case (message was originally a synchronous request)
154 if ((msg->ms_flags & (MSGF_DONE|MSGF_REPLY)) == MSGF_DONE)
155 return(msg->ms_error);
157 port = msg->ms_reply_port;
158 KKASSERT(port->mp_td == curthread); /* for now */
160 if ((msg->ms_flags & MSGF_DONE) == 0) {
161 port->mp_flags |= MSGPORTF_WAITING;
163 lwkt_deschedule_self();
165 } while ((msg->ms_flags & MSGF_DONE) == 0);
166 port->mp_flags &= ~MSGPORTF_WAITING;
169 * We own the message now.
171 if (msg->ms_flags & MSGF_QUEUED) {
172 msg->ms_flags &= ~MSGF_QUEUED;
173 TAILQ_REMOVE(&port->mp_msgq, msg, ms_node);
176 return(msg->ms_error);
180 /************************************************************************
182 ************************************************************************/
187 * Initialize a port for use and assign it to the specified thread.
190 lwkt_init_port(lwkt_port_t port, thread_t td)
192 bzero(port, sizeof(*port));
193 TAILQ_INIT(&port->mp_msgq);
195 port->mp_beginmsg = lwkt_putport;
196 port->mp_abortmsg = lwkt_abortport;
197 port->mp_returnmsg = lwkt_replyport;
203 * This function is typically assigned to the mp_replymsg port vector.
205 * The message is being returned to the specified port. The port is
206 * owned by the mp_td thread. If we are on the same cpu as the mp_td
207 * thread we can trivially queue the message to the messageq, otherwise
208 * we have to send an ipi message to the correct cpu. We then schedule
211 * If MSGF_ASYNC is not set we do not bother queueing the message, we
212 * just set the DONE bit.
214 * Note that the IPIQ callback function (*_remote) is entered with a
215 * critical section already held.
220 _lwkt_replyport(lwkt_port_t port, lwkt_msg_t msg)
222 thread_t td = port->mp_td;
224 if (td->td_gd == mycpu) {
225 TAILQ_INSERT_TAIL(&port->mp_msgq, msg, ms_node);
226 msg->ms_flags |= MSGF_DONE | MSGF_REPLY | MSGF_QUEUED;
227 if (port->mp_flags & MSGPORTF_WAITING)
230 lwkt_send_ipiq(td->td_gd->gd_cpuid, (ipifunc_t)lwkt_replyport_remote, msg);
236 lwkt_replyport_remote(lwkt_msg_t msg)
238 _lwkt_replyport(msg->ms_reply_port, msg);
243 lwkt_replyport(lwkt_port_t port, lwkt_msg_t msg)
246 if (msg->ms_flags & MSGF_ASYNC) {
247 _lwkt_replyport(port, msg);
249 msg->ms_flags |= MSGF_DONE;
250 if (port->mp_flags & MSGPORTF_WAITING)
251 lwkt_schedule(port->mp_td);
259 * This function is typically assigned to the mp_beginmsg port vector.
261 * Queue a message to the target port and wakeup the thread owning it.
262 * This function always returns EASYNC and may be assigned to a
263 * message port's mp_beginmsg function vector.
268 _lwkt_putport(lwkt_port_t port, lwkt_msg_t msg)
270 thread_t td = port->mp_td;
272 if (td->td_gd == mycpu) {
273 TAILQ_INSERT_TAIL(&port->mp_msgq, msg, ms_node);
274 msg->ms_flags |= MSGF_QUEUED;
275 if (port->mp_flags & MSGPORTF_WAITING)
278 msg->ms_target_port = port;
279 lwkt_send_ipiq(td->td_gd->gd_cpuid, (ipifunc_t)lwkt_putport_remote, msg);
285 lwkt_putport_remote(lwkt_msg_t msg)
287 _lwkt_putport(msg->ms_target_port, msg);
291 lwkt_putport(lwkt_port_t port, lwkt_msg_t msg)
294 _lwkt_putport(port, msg);
302 * This function is typically assigned to the mp_abortmsg port vector.
304 * This function attempts to abort a message. Aborts are always
305 * optional, so we could just do nothing if we wanted. We get onto the
306 * cpu owning the port, check to see if the message is queued on the
307 * port's message queue, and remove and abort it if it is. Otherwise
310 * Note that we cannot safely use ms_target_port because the port might
311 * have forwarded the message on to some other port and we could race
312 * against that use of ms_target_port.
317 _lwkt_abortport(lwkt_port_t port)
319 thread_t td = port->mp_td;
322 if (td->td_gd == mycpu) {
324 msg = TAILQ_FIRST(&port->mp_msgq);
326 if (msg->ms_abortreq) {
327 TAILQ_REMOVE(&port->mp_msgq, msg, ms_node);
328 msg->ms_flags &= ~MSGF_QUEUED;
329 lwkt_replymsg(msg, ECONNABORTED); /* YYY dangerous from IPI? */
332 msg = TAILQ_NEXT(msg, ms_node);
335 lwkt_send_ipiq(td->td_gd->gd_cpuid, (ipifunc_t)lwkt_abortport_remote, port);
341 lwkt_abortport_remote(lwkt_port_t port)
343 _lwkt_abortport(port);
347 lwkt_abortport(lwkt_port_t port, lwkt_msg_t msg)
349 msg->ms_abortreq = 1;
351 _lwkt_abortport(port);
358 * Retrieve the next message from the port's message queue, return NULL
359 * if no messages are pending.
361 * The calling thread MUST own the port.
364 lwkt_getport(lwkt_port_t port)
368 KKASSERT(port->mp_td == curthread);
371 if ((msg = TAILQ_FIRST(&port->mp_msgq)) != NULL) {
372 TAILQ_REMOVE(&port->mp_msgq, msg, ms_node);
373 msg->ms_flags &= ~MSGF_QUEUED;
382 * Retrieve the next message from the port's message queue, block until
383 * a message is ready. This function never returns NULL.
386 lwkt_waitport(lwkt_port_t port)
390 KKASSERT(port->mp_td == curthread);
393 if ((msg = TAILQ_FIRST(&port->mp_msgq)) == NULL) {
394 port->mp_flags |= MSGPORTF_WAITING;
396 lwkt_deschedule_self();
398 } while ((msg = TAILQ_FIRST(&port->mp_msgq)) == NULL);
399 port->mp_flags &= ~MSGPORTF_WAITING;
401 TAILQ_REMOVE(&port->mp_msgq, msg, ms_node);
402 msg->ms_flags &= ~MSGF_QUEUED;