First version
[3rdparty/ote_partner/tlk.git] / kernel / dpc.c
1 /*
2  * Copyright (c) 2008 Travis Geiselbrecht
3  *
4  * Permission is hereby granted, free of charge, to any person obtaining
5  * a copy of this software and associated documentation files
6  * (the "Software"), to deal in the Software without restriction,
7  * including without limitation the rights to use, copy, modify, merge,
8  * publish, distribute, sublicense, and/or sell copies of the Software,
9  * and to permit persons to whom the Software is furnished to do so,
10  * subject to the following conditions:
11  *
12  * The above copyright notice and this permission notice shall be
13  * included in all copies or substantial portions of the Software.
14  *
15  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
16  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
17  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.
18  * IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY
19  * CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT,
20  * TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE
21  * SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
22  */
23 #include <debug.h>
24 #include <stddef.h>
25 #include <list.h>
26 #include <malloc.h>
27 #include <err.h>
28 #include <kernel/dpc.h>
29 #include <kernel/thread.h>
30 #include <kernel/event.h>
31
32 struct dpc {
33         struct list_node node;  
34
35         dpc_callback cb;
36         void *arg;
37 };
38
39 static struct list_node dpc_list = LIST_INITIAL_VALUE(dpc_list);
40 static event_t dpc_event;
41
42 static int dpc_thread_routine(void *arg);
43
44 void dpc_init(void)
45 {
46         event_init(&dpc_event, false, 0);
47
48         thread_resume(thread_create("dpc", &dpc_thread_routine, NULL, DPC_PRIORITY, DEFAULT_STACK_SIZE));
49 }
50
51 status_t dpc_queue(dpc_callback cb, void *arg, uint flags)
52 {
53         struct dpc *dpc;
54
55         dpc = malloc(sizeof(struct dpc));
56
57         if(dpc == NULL)
58                 return ERR_NO_MEMORY;
59
60         dpc->cb = cb;
61         dpc->arg = arg;
62         enter_critical_section();
63         list_add_tail(&dpc_list, &dpc->node);
64         event_signal(&dpc_event, (flags & DPC_FLAG_NORESCHED) ? false : true);
65         exit_critical_section();
66
67         return NO_ERROR;
68 }
69
70 static int dpc_thread_routine(void *arg)
71 {
72         for (;;) {
73                 event_wait(&dpc_event);
74
75                 enter_critical_section();
76                 struct dpc *dpc = list_remove_head_type(&dpc_list, struct dpc, node);
77                 if (!dpc)
78                         event_unsignal(&dpc_event);
79                 exit_critical_section();
80
81                 if (dpc) {
82 //                      dprintf("dpc calling %p, arg %p\n", dpc->cb, dpc->arg);
83                         dpc->cb(dpc->arg);
84
85                         free(dpc);
86                 }
87         }
88
89         return 0;
90 }
91
92