Linux 2.6.31-rc6
[linux-2.6] / drivers / isdn / capi / capilib.c
1
2 #include <linux/kernel.h>
3 #include <linux/module.h>
4 #include <linux/isdn/capilli.h>
5
6 #define DBG(format, arg...) do { \
7 printk(KERN_DEBUG "%s: " format "\n" , __func__ , ## arg); \
8 } while (0)
9
10 struct capilib_msgidqueue {
11         struct capilib_msgidqueue *next;
12         u16 msgid;
13 };
14
15 struct capilib_ncci {
16         struct list_head list;
17         u16 applid;
18         u32 ncci;
19         u32 winsize;
20         int   nmsg;
21         struct capilib_msgidqueue *msgidqueue;
22         struct capilib_msgidqueue *msgidlast;
23         struct capilib_msgidqueue *msgidfree;
24         struct capilib_msgidqueue msgidpool[CAPI_MAXDATAWINDOW];
25 };
26
27 // ---------------------------------------------------------------------------
28 // NCCI Handling
29
30 static inline void mq_init(struct capilib_ncci * np)
31 {
32         u_int i;
33         np->msgidqueue = NULL;
34         np->msgidlast = NULL;
35         np->nmsg = 0;
36         memset(np->msgidpool, 0, sizeof(np->msgidpool));
37         np->msgidfree = &np->msgidpool[0];
38         for (i = 1; i < np->winsize; i++) {
39                 np->msgidpool[i].next = np->msgidfree;
40                 np->msgidfree = &np->msgidpool[i];
41         }
42 }
43
44 static inline int mq_enqueue(struct capilib_ncci * np, u16 msgid)
45 {
46         struct capilib_msgidqueue *mq;
47         if ((mq = np->msgidfree) == NULL)
48                 return 0;
49         np->msgidfree = mq->next;
50         mq->msgid = msgid;
51         mq->next = NULL;
52         if (np->msgidlast)
53                 np->msgidlast->next = mq;
54         np->msgidlast = mq;
55         if (!np->msgidqueue)
56                 np->msgidqueue = mq;
57         np->nmsg++;
58         return 1;
59 }
60
61 static inline int mq_dequeue(struct capilib_ncci * np, u16 msgid)
62 {
63         struct capilib_msgidqueue **pp;
64         for (pp = &np->msgidqueue; *pp; pp = &(*pp)->next) {
65                 if ((*pp)->msgid == msgid) {
66                         struct capilib_msgidqueue *mq = *pp;
67                         *pp = mq->next;
68                         if (mq == np->msgidlast)
69                                 np->msgidlast = NULL;
70                         mq->next = np->msgidfree;
71                         np->msgidfree = mq;
72                         np->nmsg--;
73                         return 1;
74                 }
75         }
76         return 0;
77 }
78
79 void capilib_new_ncci(struct list_head *head, u16 applid, u32 ncci, u32 winsize)
80 {
81         struct capilib_ncci *np;
82
83         np = kmalloc(sizeof(*np), GFP_ATOMIC);
84         if (!np) {
85                 printk(KERN_WARNING "capilib_new_ncci: no memory.\n");
86                 return;
87         }
88         if (winsize > CAPI_MAXDATAWINDOW) {
89                 printk(KERN_ERR "capi_new_ncci: winsize %d too big\n",
90                        winsize);
91                 winsize = CAPI_MAXDATAWINDOW;
92         }
93         np->applid = applid;
94         np->ncci = ncci;
95         np->winsize = winsize;
96         mq_init(np);
97         list_add_tail(&np->list, head);
98         DBG("kcapi: appl %d ncci 0x%x up", applid, ncci);
99 }
100
101 EXPORT_SYMBOL(capilib_new_ncci);
102
103 void capilib_free_ncci(struct list_head *head, u16 applid, u32 ncci)
104 {
105         struct list_head *l;
106         struct capilib_ncci *np;
107
108         list_for_each(l, head) {
109                 np = list_entry(l, struct capilib_ncci, list);
110                 if (np->applid != applid)
111                         continue;
112                 if (np->ncci != ncci)
113                         continue;
114                 printk(KERN_INFO "kcapi: appl %d ncci 0x%x down\n", applid, ncci);
115                 list_del(&np->list);
116                 kfree(np);
117                 return;
118         }
119         printk(KERN_ERR "capilib_free_ncci: ncci 0x%x not found\n", ncci);
120 }
121
122 EXPORT_SYMBOL(capilib_free_ncci);
123
124 void capilib_release_appl(struct list_head *head, u16 applid)
125 {
126         struct list_head *l, *n;
127         struct capilib_ncci *np;
128
129         list_for_each_safe(l, n, head) {
130                 np = list_entry(l, struct capilib_ncci, list);
131                 if (np->applid != applid)
132                         continue;
133                 printk(KERN_INFO "kcapi: appl %d ncci 0x%x forced down\n", applid, np->ncci);
134                 list_del(&np->list);
135                 kfree(np);
136         }
137 }
138
139 EXPORT_SYMBOL(capilib_release_appl);
140
141 void capilib_release(struct list_head *head)
142 {
143         struct list_head *l, *n;
144         struct capilib_ncci *np;
145
146         list_for_each_safe(l, n, head) {
147                 np = list_entry(l, struct capilib_ncci, list);
148                 printk(KERN_INFO "kcapi: appl %d ncci 0x%x forced down\n", np->applid, np->ncci);
149                 list_del(&np->list);
150                 kfree(np);
151         }
152 }
153
154 EXPORT_SYMBOL(capilib_release);
155
156 u16 capilib_data_b3_req(struct list_head *head, u16 applid, u32 ncci, u16 msgid)
157 {
158         struct list_head *l;
159         struct capilib_ncci *np;
160
161         list_for_each(l, head) {
162                 np = list_entry(l, struct capilib_ncci, list);
163                 if (np->applid != applid)
164                         continue;
165                 if (np->ncci != ncci)
166                         continue;
167                 
168                 if (mq_enqueue(np, msgid) == 0)
169                         return CAPI_SENDQUEUEFULL;
170
171                 return CAPI_NOERROR;
172         }
173         printk(KERN_ERR "capilib_data_b3_req: ncci 0x%x not found\n", ncci);
174         return CAPI_NOERROR;
175 }
176
177 EXPORT_SYMBOL(capilib_data_b3_req);
178
179 void capilib_data_b3_conf(struct list_head *head, u16 applid, u32 ncci, u16 msgid)
180 {
181         struct list_head *l;
182         struct capilib_ncci *np;
183
184         list_for_each(l, head) {
185                 np = list_entry(l, struct capilib_ncci, list);
186                 if (np->applid != applid)
187                         continue;
188                 if (np->ncci != ncci)
189                         continue;
190                 
191                 if (mq_dequeue(np, msgid) == 0) {
192                         printk(KERN_ERR "kcapi: msgid %hu ncci 0x%x not on queue\n",
193                                msgid, ncci);
194                 }
195                 return;
196         }
197         printk(KERN_ERR "capilib_data_b3_conf: ncci 0x%x not found\n", ncci);
198 }
199
200 EXPORT_SYMBOL(capilib_data_b3_conf);