?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
stop using DMA_xxBIT_MASK
[wrt350n-kernel.git] / net / 9p / mux.c
blobf14014793bedb2fcbee870e84a6b0bde10be88fb
1 /*
2 * net/9p/mux.c
3 *
4 * Protocol Multiplexer
5 *
6 * Copyright (C) 2004 by Eric Van Hensbergen <ericvh@gmail.com>
7 * Copyright (C) 2004-2005 by Latchesar Ionkov <lucho@ionkov.net>
8 *
9 * This program is free software; you can redistribute it and/or modify
10 * it under the terms of the GNU General Public License version 2
11 * as published by the Free Software Foundation.
12 *
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
17 *
18 * You should have received a copy of the GNU General Public License
19 * along with this program; if not, write to:
20 * Free Software Foundation
21 * 51 Franklin Street, Fifth Floor
22 * Boston, MA 02111-1301 USA
23 *
24 */
25
26 #include <linux/module.h>
27 #include <linux/errno.h>
28 #include <linux/fs.h>
29 #include <linux/poll.h>
30 #include <linux/kthread.h>
31 #include <linux/idr.h>
32 #include <linux/mutex.h>
33 #include <net/9p/9p.h>
34 #include <linux/parser.h>
35 #include <net/9p/transport.h>
36 #include <net/9p/conn.h>
37
38 #define ERREQFLUSH 1
39 #define SCHED_TIMEOUT 10
40 #define MAXPOLLWADDR 2
41
42 enum {
43 Rworksched = 1, /* read work scheduled or running */
44 Rpending = 2, /* can read */
45 Wworksched = 4, /* write work scheduled or running */
46 Wpending = 8, /* can write */
47 };
48
49 enum {
50 None,
51 Flushing,
52 Flushed,
53 };
54
55 struct p9_mux_poll_task;
56
57 struct p9_req {
58 spinlock_t lock; /* protect request structure */
59 int tag;
60 struct p9_fcall *tcall;
61 struct p9_fcall *rcall;
62 int err;
63 p9_conn_req_callback cb;
64 void *cba;
65 int flush;
66 struct list_head req_list;
67 };
68
69 struct p9_conn {
70 spinlock_t lock; /* protect lock structure */
71 struct list_head mux_list;
72 struct p9_mux_poll_task *poll_task;
73 int msize;
74 unsigned char *extended;
75 struct p9_trans *trans;
76 struct p9_idpool *tagpool;
77 int err;
78 wait_queue_head_t equeue;
79 struct list_head req_list;
80 struct list_head unsent_req_list;
81 struct p9_fcall *rcall;
82 int rpos;
83 char *rbuf;
84 int wpos;
85 int wsize;
86 char *wbuf;
87 wait_queue_t poll_wait[MAXPOLLWADDR];
88 wait_queue_head_t *poll_waddr[MAXPOLLWADDR];
89 poll_table pt;
90 struct work_struct rq;
91 struct work_struct wq;
92 unsigned long wsched;
93 };
94
95 struct p9_mux_poll_task {
96 struct task_struct *task;
97 struct list_head mux_list;
98 int muxnum;
99 };
100
101 struct p9_mux_rpc {
102 struct p9_conn *m;
103 int err;
104 struct p9_fcall *tcall;
105 struct p9_fcall *rcall;
106 wait_queue_head_t wqueue;
107 };
108
109 static int p9_poll_proc(void *);
110 static void p9_read_work(struct work_struct *work);
111 static void p9_write_work(struct work_struct *work);
112 static void p9_pollwait(struct file *filp, wait_queue_head_t *wait_address,
113 poll_table * p);
114 static u16 p9_mux_get_tag(struct p9_conn *);
115 static void p9_mux_put_tag(struct p9_conn *, u16);
116
117 static DEFINE_MUTEX(p9_mux_task_lock);
118 static struct workqueue_struct *p9_mux_wq;
119
120 static int p9_mux_num;
121 static int p9_mux_poll_task_num;
122 static struct p9_mux_poll_task p9_mux_poll_tasks[100];
123
124 int p9_mux_global_init(void)
125 {
126 int i;
127
128 for (i = 0; i < ARRAY_SIZE(p9_mux_poll_tasks); i++)
129 p9_mux_poll_tasks[i].task = NULL;
130
131 p9_mux_wq = create_workqueue("v9fs");
132 if (!p9_mux_wq) {
133 printk(KERN_WARNING "v9fs: mux: creating workqueue failed\n");
134 return -ENOMEM;
135 }
136
137 return 0;
138 }
139
140 void p9_mux_global_exit(void)
141 {
142 destroy_workqueue(p9_mux_wq);
143 }
144
145 /**
146 * p9_mux_calc_poll_procs - calculates the number of polling procs
147 * based on the number of mounted v9fs filesystems.
148 *
149 * The current implementation returns sqrt of the number of mounts.
150 */
151 static int p9_mux_calc_poll_procs(int muxnum)
152 {
153 int n;
154
155 if (p9_mux_poll_task_num)
156 n = muxnum / p9_mux_poll_task_num +
157 (muxnum % p9_mux_poll_task_num ? 1 : 0);
158 else
159 n = 1;
160
161 if (n > ARRAY_SIZE(p9_mux_poll_tasks))
162 n = ARRAY_SIZE(p9_mux_poll_tasks);
163
164 return n;
165 }
166
167 static int p9_mux_poll_start(struct p9_conn *m)
168 {
169 int i, n;
170 struct p9_mux_poll_task *vpt, *vptlast;
171 struct task_struct *pproc;
172
173 P9_DPRINTK(P9_DEBUG_MUX, "mux %p muxnum %d procnum %d\n", m, p9_mux_num,
174 p9_mux_poll_task_num);
175 mutex_lock(&p9_mux_task_lock);
176
177 n = p9_mux_calc_poll_procs(p9_mux_num + 1);
178 if (n > p9_mux_poll_task_num) {
179 for (i = 0; i < ARRAY_SIZE(p9_mux_poll_tasks); i++) {
180 if (p9_mux_poll_tasks[i].task == NULL) {
181 vpt = &p9_mux_poll_tasks[i];
182 P9_DPRINTK(P9_DEBUG_MUX, "create proc %p\n",
183 vpt);
184 pproc = kthread_create(p9_poll_proc, vpt,
185 "v9fs-poll");
186
187 if (!IS_ERR(pproc)) {
188 vpt->task = pproc;
189 INIT_LIST_HEAD(&vpt->mux_list);
190 vpt->muxnum = 0;
191 p9_mux_poll_task_num++;
192 wake_up_process(vpt->task);
193 }
194 break;
195 }
196 }
197
198 if (i >= ARRAY_SIZE(p9_mux_poll_tasks))
199 P9_DPRINTK(P9_DEBUG_ERROR,
200 "warning: no free poll slots\n");
201 }
202
203 n = (p9_mux_num + 1) / p9_mux_poll_task_num +
204 ((p9_mux_num + 1) % p9_mux_poll_task_num ? 1 : 0);
205
206 vptlast = NULL;
207 for (i = 0; i < ARRAY_SIZE(p9_mux_poll_tasks); i++) {
208 vpt = &p9_mux_poll_tasks[i];
209 if (vpt->task != NULL) {
210 vptlast = vpt;
211 if (vpt->muxnum < n) {
212 P9_DPRINTK(P9_DEBUG_MUX, "put in proc %d\n", i);
213 list_add(&m->mux_list, &vpt->mux_list);
214 vpt->muxnum++;
215 m->poll_task = vpt;
216 memset(&m->poll_waddr, 0,
217 sizeof(m->poll_waddr));
218 init_poll_funcptr(&m->pt, p9_pollwait);
219 break;
220 }
221 }
222 }
223
224 if (i >= ARRAY_SIZE(p9_mux_poll_tasks)) {
225 if (vptlast == NULL)
226 return -ENOMEM;
227
228 P9_DPRINTK(P9_DEBUG_MUX, "put in proc %d\n", i);
229 list_add(&m->mux_list, &vptlast->mux_list);
230 vptlast->muxnum++;
231 m->poll_task = vptlast;
232 memset(&m->poll_waddr, 0, sizeof(m->poll_waddr));
233 init_poll_funcptr(&m->pt, p9_pollwait);
234 }
235
236 p9_mux_num++;
237 mutex_unlock(&p9_mux_task_lock);
238
239 return 0;
240 }
241
242 static void p9_mux_poll_stop(struct p9_conn *m)
243 {
244 int i;
245 struct p9_mux_poll_task *vpt;
246
247 mutex_lock(&p9_mux_task_lock);
248 vpt = m->poll_task;
249 list_del(&m->mux_list);
250 for (i = 0; i < ARRAY_SIZE(m->poll_waddr); i++) {
251 if (m->poll_waddr[i] != NULL) {
252 remove_wait_queue(m->poll_waddr[i], &m->poll_wait[i]);
253 m->poll_waddr[i] = NULL;
254 }
255 }
256 vpt->muxnum--;
257 if (!vpt->muxnum) {
258 P9_DPRINTK(P9_DEBUG_MUX, "destroy proc %p\n", vpt);
259 kthread_stop(vpt->task);
260 vpt->task = NULL;
261 p9_mux_poll_task_num--;
262 }
263 p9_mux_num--;
264 mutex_unlock(&p9_mux_task_lock);
265 }
266
267 /**
268 * p9_conn_create - allocate and initialize the per-session mux data
269 * Creates the polling task if this is the first session.
270 *
271 * @trans - transport structure
272 * @msize - maximum message size
273 * @extended - pointer to the extended flag
274 */
275 struct p9_conn *p9_conn_create(struct p9_trans *trans, int msize,
276 unsigned char *extended)
277 {
278 int i, n;
279 struct p9_conn *m, *mtmp;
280
281 P9_DPRINTK(P9_DEBUG_MUX, "transport %p msize %d\n", trans, msize);
282 m = kmalloc(sizeof(struct p9_conn), GFP_KERNEL);
283 if (!m)
284 return ERR_PTR(-ENOMEM);
285
286 spin_lock_init(&m->lock);
287 INIT_LIST_HEAD(&m->mux_list);
288 m->msize = msize;
289 m->extended = extended;
290 m->trans = trans;
291 m->tagpool = p9_idpool_create();
292 if (IS_ERR(m->tagpool)) {
293 mtmp = ERR_PTR(-ENOMEM);
294 kfree(m);
295 return mtmp;
296 }
297
298 m->err = 0;
299 init_waitqueue_head(&m->equeue);
300 INIT_LIST_HEAD(&m->req_list);
301 INIT_LIST_HEAD(&m->unsent_req_list);
302 m->rcall = NULL;
303 m->rpos = 0;
304 m->rbuf = NULL;
305 m->wpos = m->wsize = 0;
306 m->wbuf = NULL;
307 INIT_WORK(&m->rq, p9_read_work);
308 INIT_WORK(&m->wq, p9_write_work);
309 m->wsched = 0;
310 memset(&m->poll_waddr, 0, sizeof(m->poll_waddr));
311 m->poll_task = NULL;
312 n = p9_mux_poll_start(m);
313 if (n) {
314 kfree(m);
315 return ERR_PTR(n);
316 }
317
318 n = trans->poll(trans, &m->pt);
319 if (n & POLLIN) {
320 P9_DPRINTK(P9_DEBUG_MUX, "mux %p can read\n", m);
321 set_bit(Rpending, &m->wsched);
322 }
323
324 if (n & POLLOUT) {
325 P9_DPRINTK(P9_DEBUG_MUX, "mux %p can write\n", m);
326 set_bit(Wpending, &m->wsched);
327 }
328
329 for (i = 0; i < ARRAY_SIZE(m->poll_waddr); i++) {
330 if (IS_ERR(m->poll_waddr[i])) {
331 p9_mux_poll_stop(m);
332 mtmp = (void *)m->poll_waddr; /* the error code */
333 kfree(m);
334 m = mtmp;
335 break;
336 }
337 }
338
339 return m;
340 }
341 EXPORT_SYMBOL(p9_conn_create);
342
343 /**
344 * p9_mux_destroy - cancels all pending requests and frees mux resources
345 */
346 void p9_conn_destroy(struct p9_conn *m)
347 {
348 P9_DPRINTK(P9_DEBUG_MUX, "mux %p prev %p next %p\n", m,
349 m->mux_list.prev, m->mux_list.next);
350 p9_conn_cancel(m, -ECONNRESET);
351
352 if (!list_empty(&m->req_list)) {
353 /* wait until all processes waiting on this session exit */
354 P9_DPRINTK(P9_DEBUG_MUX,
355 "mux %p waiting for empty request queue\n", m);
356 wait_event_timeout(m->equeue, (list_empty(&m->req_list)), 5000);
357 P9_DPRINTK(P9_DEBUG_MUX, "mux %p request queue empty: %d\n", m,
358 list_empty(&m->req_list));
359 }
360
361 p9_mux_poll_stop(m);
362 m->trans = NULL;
363 p9_idpool_destroy(m->tagpool);
364 kfree(m);
365 }
366 EXPORT_SYMBOL(p9_conn_destroy);
367
368 /**
369 * p9_pollwait - called by files poll operation to add v9fs-poll task
370 * to files wait queue
371 */
372 static void
373 p9_pollwait(struct file *filp, wait_queue_head_t *wait_address,
374 poll_table * p)
375 {
376 int i;
377 struct p9_conn *m;
378
379 m = container_of(p, struct p9_conn, pt);
380 for (i = 0; i < ARRAY_SIZE(m->poll_waddr); i++)
381 if (m->poll_waddr[i] == NULL)
382 break;
383
384 if (i >= ARRAY_SIZE(m->poll_waddr)) {
385 P9_DPRINTK(P9_DEBUG_ERROR, "not enough wait_address slots\n");
386 return;
387 }
388
389 m->poll_waddr[i] = wait_address;
390
391 if (!wait_address) {
392 P9_DPRINTK(P9_DEBUG_ERROR, "no wait_address\n");
393 m->poll_waddr[i] = ERR_PTR(-EIO);
394 return;
395 }
396
397 init_waitqueue_entry(&m->poll_wait[i], m->poll_task->task);
398 add_wait_queue(wait_address, &m->poll_wait[i]);
399 }
400
401 /**
402 * p9_poll_mux - polls a mux and schedules read or write works if necessary
403 */
404 static void p9_poll_mux(struct p9_conn *m)
405 {
406 int n;
407
408 if (m->err < 0)
409 return;
410
411 n = m->trans->poll(m->trans, NULL);
412 if (n < 0 || n & (POLLERR | POLLHUP | POLLNVAL)) {
413 P9_DPRINTK(P9_DEBUG_MUX, "error mux %p err %d\n", m, n);
414 if (n >= 0)
415 n = -ECONNRESET;
416 p9_conn_cancel(m, n);
417 }
418
419 if (n & POLLIN) {
420 set_bit(Rpending, &m->wsched);
421 P9_DPRINTK(P9_DEBUG_MUX, "mux %p can read\n", m);
422 if (!test_and_set_bit(Rworksched, &m->wsched)) {
423 P9_DPRINTK(P9_DEBUG_MUX, "schedule read work %p\n", m);
424 queue_work(p9_mux_wq, &m->rq);
425 }
426 }
427
428 if (n & POLLOUT) {
429 set_bit(Wpending, &m->wsched);
430 P9_DPRINTK(P9_DEBUG_MUX, "mux %p can write\n", m);
431 if ((m->wsize || !list_empty(&m->unsent_req_list))
432 && !test_and_set_bit(Wworksched, &m->wsched)) {
433 P9_DPRINTK(P9_DEBUG_MUX, "schedule write work %p\n", m);
434 queue_work(p9_mux_wq, &m->wq);
435 }
436 }
437 }
438
439 /**
440 * p9_poll_proc - polls all v9fs transports for new events and queues
441 * the appropriate work to the work queue
442 */
443 static int p9_poll_proc(void *a)
444 {
445 struct p9_conn *m, *mtmp;
446 struct p9_mux_poll_task *vpt;
447
448 vpt = a;
449 P9_DPRINTK(P9_DEBUG_MUX, "start %p %p\n", current, vpt);
450 while (!kthread_should_stop()) {
451 set_current_state(TASK_INTERRUPTIBLE);
452
453 list_for_each_entry_safe(m, mtmp, &vpt->mux_list, mux_list) {
454 p9_poll_mux(m);
455 }
456
457 P9_DPRINTK(P9_DEBUG_MUX, "sleeping...\n");
458 schedule_timeout(SCHED_TIMEOUT * HZ);
459 }
460
461 __set_current_state(TASK_RUNNING);
462 P9_DPRINTK(P9_DEBUG_MUX, "finish\n");
463 return 0;
464 }
465
466 /**
467 * p9_write_work - called when a transport can send some data
468 */
469 static void p9_write_work(struct work_struct *work)
470 {
471 int n, err;
472 struct p9_conn *m;
473 struct p9_req *req;
474
475 m = container_of(work, struct p9_conn, wq);
476
477 if (m->err < 0) {
478 clear_bit(Wworksched, &m->wsched);
479 return;
480 }
481
482 if (!m->wsize) {
483 if (list_empty(&m->unsent_req_list)) {
484 clear_bit(Wworksched, &m->wsched);
485 return;
486 }
487
488 spin_lock(&m->lock);
489 again:
490 req = list_entry(m->unsent_req_list.next, struct p9_req,
491 req_list);
492 list_move_tail(&req->req_list, &m->req_list);
493 if (req->err == ERREQFLUSH)
494 goto again;
495
496 m->wbuf = req->tcall->sdata;
497 m->wsize = req->tcall->size;
498 m->wpos = 0;
499 spin_unlock(&m->lock);
500 }
501
502 P9_DPRINTK(P9_DEBUG_MUX, "mux %p pos %d size %d\n", m, m->wpos,
503 m->wsize);
504 clear_bit(Wpending, &m->wsched);
505 err = m->trans->write(m->trans, m->wbuf + m->wpos, m->wsize - m->wpos);
506 P9_DPRINTK(P9_DEBUG_MUX, "mux %p sent %d bytes\n", m, err);
507 if (err == -EAGAIN) {
508 clear_bit(Wworksched, &m->wsched);
509 return;
510 }
511
512 if (err < 0)
513 goto error;
514 else if (err == 0) {
515 err = -EREMOTEIO;
516 goto error;
517 }
518
519 m->wpos += err;
520 if (m->wpos == m->wsize)
521 m->wpos = m->wsize = 0;
522
523 if (m->wsize == 0 && !list_empty(&m->unsent_req_list)) {
524 if (test_and_clear_bit(Wpending, &m->wsched))
525 n = POLLOUT;
526 else
527 n = m->trans->poll(m->trans, NULL);
528
529 if (n & POLLOUT) {
530 P9_DPRINTK(P9_DEBUG_MUX, "schedule write work %p\n", m);
531 queue_work(p9_mux_wq, &m->wq);
532 } else
533 clear_bit(Wworksched, &m->wsched);
534 } else
535 clear_bit(Wworksched, &m->wsched);
536
537 return;
538
539 error:
540 p9_conn_cancel(m, err);
541 clear_bit(Wworksched, &m->wsched);
542 }
543
544 static void process_request(struct p9_conn *m, struct p9_req *req)
545 {
546 int ecode;
547 struct p9_str *ename;
548
549 if (!req->err && req->rcall->id == P9_RERROR) {
550 ecode = req->rcall->params.rerror.errno;
551 ename = &req->rcall->params.rerror.error;
552
553 P9_DPRINTK(P9_DEBUG_MUX, "Rerror %.*s\n", ename->len,
554 ename->str);
555
556 if (*m->extended)
557 req->err = -ecode;
558
559 if (!req->err) {
560 req->err = p9_errstr2errno(ename->str, ename->len);
561
562 if (!req->err) { /* string match failed */
563 PRINT_FCALL_ERROR("unknown error", req->rcall);
564 }
565
566 if (!req->err)
567 req->err = -ESERVERFAULT;
568 }
569 } else if (req->tcall && req->rcall->id != req->tcall->id + 1) {
570 P9_DPRINTK(P9_DEBUG_ERROR,
571 "fcall mismatch: expected %d, got %d\n",
572 req->tcall->id + 1, req->rcall->id);
573 if (!req->err)
574 req->err = -EIO;
575 }
576 }
577
578 /**
579 * p9_read_work - called when there is some data to be read from a transport
580 */
581 static void p9_read_work(struct work_struct *work)
582 {
583 int n, err;
584 struct p9_conn *m;
585 struct p9_req *req, *rptr, *rreq;
586 struct p9_fcall *rcall;
587 char *rbuf;
588
589 m = container_of(work, struct p9_conn, rq);
590
591 if (m->err < 0)
592 return;
593
594 rcall = NULL;
595 P9_DPRINTK(P9_DEBUG_MUX, "start mux %p pos %d\n", m, m->rpos);
596
597 if (!m->rcall) {
598 m->rcall =
599 kmalloc(sizeof(struct p9_fcall) + m->msize, GFP_KERNEL);
600 if (!m->rcall) {
601 err = -ENOMEM;
602 goto error;
603 }
604
605 m->rbuf = (char *)m->rcall + sizeof(struct p9_fcall);
606 m->rpos = 0;
607 }
608
609 clear_bit(Rpending, &m->wsched);
610 err = m->trans->read(m->trans, m->rbuf + m->rpos, m->msize - m->rpos);
611 P9_DPRINTK(P9_DEBUG_MUX, "mux %p got %d bytes\n", m, err);
612 if (err == -EAGAIN) {
613 clear_bit(Rworksched, &m->wsched);
614 return;
615 }
616
617 if (err <= 0)
618 goto error;
619
620 m->rpos += err;
621 while (m->rpos > 4) {
622 n = le32_to_cpu(*(__le32 *) m->rbuf);
623 if (n >= m->msize) {
624 P9_DPRINTK(P9_DEBUG_ERROR,
625 "requested packet size too big: %d\n", n);
626 err = -EIO;
627 goto error;
628 }
629
630 if (m->rpos < n)
631 break;
632
633 err =
634 p9_deserialize_fcall(m->rbuf, n, m->rcall, *m->extended);
635 if (err < 0) {
636 goto error;
637 }
638
639 #ifdef CONFIG_NET_9P_DEBUG
640 if ((p9_debug_level&P9_DEBUG_FCALL) == P9_DEBUG_FCALL) {
641 char buf[150];
642
643 p9_printfcall(buf, sizeof(buf), m->rcall,
644 *m->extended);
645 printk(KERN_NOTICE ">>> %p %s\n", m, buf);
646 }
647 #endif
648
649 rcall = m->rcall;
650 rbuf = m->rbuf;
651 if (m->rpos > n) {
652 m->rcall = kmalloc(sizeof(struct p9_fcall) + m->msize,
653 GFP_KERNEL);
654 if (!m->rcall) {
655 err = -ENOMEM;
656 goto error;
657 }
658
659 m->rbuf = (char *)m->rcall + sizeof(struct p9_fcall);
660 memmove(m->rbuf, rbuf + n, m->rpos - n);
661 m->rpos -= n;
662 } else {
663 m->rcall = NULL;
664 m->rbuf = NULL;
665 m->rpos = 0;
666 }
667
668 P9_DPRINTK(P9_DEBUG_MUX, "mux %p fcall id %d tag %d\n", m,
669 rcall->id, rcall->tag);
670
671 req = NULL;
672 spin_lock(&m->lock);
673 list_for_each_entry_safe(rreq, rptr, &m->req_list, req_list) {
674 if (rreq->tag == rcall->tag) {
675 req = rreq;
676 if (req->flush != Flushing)
677 list_del(&req->req_list);
678 break;
679 }
680 }
681 spin_unlock(&m->lock);
682
683 if (req) {
684 req->rcall = rcall;
685 process_request(m, req);
686
687 if (req->flush != Flushing) {
688 if (req->cb)
689 (*req->cb) (req, req->cba);
690 else
691 kfree(req->rcall);
692
693 wake_up(&m->equeue);
694 }
695 } else {
696 if (err >= 0 && rcall->id != P9_RFLUSH)
697 P9_DPRINTK(P9_DEBUG_ERROR,
698 "unexpected response mux %p id %d tag %d\n",
699 m, rcall->id, rcall->tag);
700 kfree(rcall);
701 }
702 }
703
704 if (!list_empty(&m->req_list)) {
705 if (test_and_clear_bit(Rpending, &m->wsched))
706 n = POLLIN;
707 else
708 n = m->trans->poll(m->trans, NULL);
709
710 if (n & POLLIN) {
711 P9_DPRINTK(P9_DEBUG_MUX, "schedule read work %p\n", m);
712 queue_work(p9_mux_wq, &m->rq);
713 } else
714 clear_bit(Rworksched, &m->wsched);
715 } else
716 clear_bit(Rworksched, &m->wsched);
717
718 return;
719
720 error:
721 p9_conn_cancel(m, err);
722 clear_bit(Rworksched, &m->wsched);
723 }
724
725 /**
726 * p9_send_request - send 9P request
727 * The function can sleep until the request is scheduled for sending.
728 * The function can be interrupted. Return from the function is not
729 * a guarantee that the request is sent successfully. Can return errors
730 * that can be retrieved by PTR_ERR macros.
731 *
732 * @m: mux data
733 * @tc: request to be sent
734 * @cb: callback function to call when response is received
735 * @cba: parameter to pass to the callback function
736 */
737 static struct p9_req *p9_send_request(struct p9_conn *m,
738 struct p9_fcall *tc,
739 p9_conn_req_callback cb, void *cba)
740 {
741 int n;
742 struct p9_req *req;
743
744 P9_DPRINTK(P9_DEBUG_MUX, "mux %p task %p tcall %p id %d\n", m, current,
745 tc, tc->id);
746 if (m->err < 0)
747 return ERR_PTR(m->err);
748
749 req = kmalloc(sizeof(struct p9_req), GFP_KERNEL);
750 if (!req)
751 return ERR_PTR(-ENOMEM);
752
753 if (tc->id == P9_TVERSION)
754 n = P9_NOTAG;
755 else
756 n = p9_mux_get_tag(m);
757
758 if (n < 0)
759 return ERR_PTR(-ENOMEM);
760
761 p9_set_tag(tc, n);
762
763 #ifdef CONFIG_NET_9P_DEBUG
764 if ((p9_debug_level&P9_DEBUG_FCALL) == P9_DEBUG_FCALL) {
765 char buf[150];
766
767 p9_printfcall(buf, sizeof(buf), tc, *m->extended);
768 printk(KERN_NOTICE "<<< %p %s\n", m, buf);
769 }
770 #endif
771
772 spin_lock_init(&req->lock);
773 req->tag = n;
774 req->tcall = tc;
775 req->rcall = NULL;
776 req->err = 0;
777 req->cb = cb;
778 req->cba = cba;
779 req->flush = None;
780
781 spin_lock(&m->lock);
782 list_add_tail(&req->req_list, &m->unsent_req_list);
783 spin_unlock(&m->lock);
784
785 if (test_and_clear_bit(Wpending, &m->wsched))
786 n = POLLOUT;
787 else
788 n = m->trans->poll(m->trans, NULL);
789
790 if (n & POLLOUT && !test_and_set_bit(Wworksched, &m->wsched))
791 queue_work(p9_mux_wq, &m->wq);
792
793 return req;
794 }
795
796 static void p9_mux_free_request(struct p9_conn *m, struct p9_req *req)
797 {
798 p9_mux_put_tag(m, req->tag);
799 kfree(req);
800 }
801
802 static void p9_mux_flush_cb(struct p9_req *freq, void *a)
803 {
804 p9_conn_req_callback cb;
805 int tag;
806 struct p9_conn *m;
807 struct p9_req *req, *rreq, *rptr;
808
809 m = a;
810 P9_DPRINTK(P9_DEBUG_MUX, "mux %p tc %p rc %p err %d oldtag %d\n", m,
811 freq->tcall, freq->rcall, freq->err,
812 freq->tcall->params.tflush.oldtag);
813
814 spin_lock(&m->lock);
815 cb = NULL;
816 tag = freq->tcall->params.tflush.oldtag;
817 req = NULL;
818 list_for_each_entry_safe(rreq, rptr, &m->req_list, req_list) {
819 if (rreq->tag == tag) {
820 req = rreq;
821 list_del(&req->req_list);
822 break;
823 }
824 }
825 spin_unlock(&m->lock);
826
827 if (req) {
828 spin_lock(&req->lock);
829 req->flush = Flushed;
830 spin_unlock(&req->lock);
831
832 if (req->cb)
833 (*req->cb) (req, req->cba);
834 else
835 kfree(req->rcall);
836
837 wake_up(&m->equeue);
838 }
839
840 kfree(freq->tcall);
841 kfree(freq->rcall);
842 p9_mux_free_request(m, freq);
843 }
844
845 static int
846 p9_mux_flush_request(struct p9_conn *m, struct p9_req *req)
847 {
848 struct p9_fcall *fc;
849 struct p9_req *rreq, *rptr;
850
851 P9_DPRINTK(P9_DEBUG_MUX, "mux %p req %p tag %d\n", m, req, req->tag);
852
853 /* if a response was received for a request, do nothing */
854 spin_lock(&req->lock);
855 if (req->rcall || req->err) {
856 spin_unlock(&req->lock);
857 P9_DPRINTK(P9_DEBUG_MUX,
858 "mux %p req %p response already received\n", m, req);
859 return 0;
860 }
861
862 req->flush = Flushing;
863 spin_unlock(&req->lock);
864
865 spin_lock(&m->lock);
866 /* if the request is not sent yet, just remove it from the list */
867 list_for_each_entry_safe(rreq, rptr, &m->unsent_req_list, req_list) {
868 if (rreq->tag == req->tag) {
869 P9_DPRINTK(P9_DEBUG_MUX,
870 "mux %p req %p request is not sent yet\n", m, req);
871 list_del(&rreq->req_list);
872 req->flush = Flushed;
873 spin_unlock(&m->lock);
874 if (req->cb)
875 (*req->cb) (req, req->cba);
876 return 0;
877 }
878 }
879 spin_unlock(&m->lock);
880
881 clear_thread_flag(TIF_SIGPENDING);
882 fc = p9_create_tflush(req->tag);
883 p9_send_request(m, fc, p9_mux_flush_cb, m);
884 return 1;
885 }
886
887 static void
888 p9_conn_rpc_cb(struct p9_req *req, void *a)
889 {
890 struct p9_mux_rpc *r;
891
892 P9_DPRINTK(P9_DEBUG_MUX, "req %p r %p\n", req, a);
893 r = a;
894 r->rcall = req->rcall;
895 r->err = req->err;
896
897 if (req->flush != None && !req->err)
898 r->err = -ERESTARTSYS;
899
900 wake_up(&r->wqueue);
901 }
902
903 /**
904 * p9_mux_rpc - sends 9P request and waits until a response is available.
905 * The function can be interrupted.
906 * @m: mux data
907 * @tc: request to be sent
908 * @rc: pointer where a pointer to the response is stored
909 */
910 int
911 p9_conn_rpc(struct p9_conn *m, struct p9_fcall *tc,
912 struct p9_fcall **rc)
913 {
914 int err, sigpending;
915 unsigned long flags;
916 struct p9_req *req;
917 struct p9_mux_rpc r;
918
919 r.err = 0;
920 r.tcall = tc;
921 r.rcall = NULL;
922 r.m = m;
923 init_waitqueue_head(&r.wqueue);
924
925 if (rc)
926 *rc = NULL;
927
928 sigpending = 0;
929 if (signal_pending(current)) {
930 sigpending = 1;
931 clear_thread_flag(TIF_SIGPENDING);
932 }
933
934 req = p9_send_request(m, tc, p9_conn_rpc_cb, &r);
935 if (IS_ERR(req)) {
936 err = PTR_ERR(req);
937 P9_DPRINTK(P9_DEBUG_MUX, "error %d\n", err);
938 return err;
939 }
940
941 err = wait_event_interruptible(r.wqueue, r.rcall != NULL || r.err < 0);
942 if (r.err < 0)
943 err = r.err;
944
945 if (err == -ERESTARTSYS && m->trans->status == Connected
946 && m->err == 0) {
947 if (p9_mux_flush_request(m, req)) {
948 /* wait until we get response of the flush message */
949 do {
950 clear_thread_flag(TIF_SIGPENDING);
951 err = wait_event_interruptible(r.wqueue,
952 r.rcall || r.err);
953 } while (!r.rcall && !r.err && err == -ERESTARTSYS &&
954 m->trans->status == Connected && !m->err);
955
956 err = -ERESTARTSYS;
957 }
958 sigpending = 1;
959 }
960
961 if (sigpending) {
962 spin_lock_irqsave(&current->sighand->siglock, flags);
963 recalc_sigpending();
964 spin_unlock_irqrestore(&current->sighand->siglock, flags);
965 }
966
967 if (rc)
968 *rc = r.rcall;
969 else
970 kfree(r.rcall);
971
972 p9_mux_free_request(m, req);
973 if (err > 0)
974 err = -EIO;
975
976 return err;
977 }
978 EXPORT_SYMBOL(p9_conn_rpc);
979
980 #ifdef P9_NONBLOCK
981 /**
982 * p9_conn_rpcnb - sends 9P request without waiting for response.
983 * @m: mux data
984 * @tc: request to be sent
985 * @cb: callback function to be called when response arrives
986 * @cba: value to pass to the callback function
987 */
988 int p9_conn_rpcnb(struct p9_conn *m, struct p9_fcall *tc,
989 p9_conn_req_callback cb, void *a)
990 {
991 int err;
992 struct p9_req *req;
993
994 req = p9_send_request(m, tc, cb, a);
995 if (IS_ERR(req)) {
996 err = PTR_ERR(req);
997 P9_DPRINTK(P9_DEBUG_MUX, "error %d\n", err);
998 return PTR_ERR(req);
999 }
1000
1001 P9_DPRINTK(P9_DEBUG_MUX, "mux %p tc %p tag %d\n", m, tc, req->tag);
1002 return 0;
1003 }
1004 EXPORT_SYMBOL(p9_conn_rpcnb);
1005 #endif /* P9_NONBLOCK */
1006
1007 /**
1008 * p9_conn_cancel - cancel all pending requests with error
1009 * @m: mux data
1010 * @err: error code
1011 */
1012 void p9_conn_cancel(struct p9_conn *m, int err)
1013 {
1014 struct p9_req *req, *rtmp;
1015 LIST_HEAD(cancel_list);
1016
1017 P9_DPRINTK(P9_DEBUG_ERROR, "mux %p err %d\n", m, err);
1018 m->err = err;
1019 spin_lock(&m->lock);
1020 list_for_each_entry_safe(req, rtmp, &m->req_list, req_list) {
1021 list_move(&req->req_list, &cancel_list);
1022 }
1023 list_for_each_entry_safe(req, rtmp, &m->unsent_req_list, req_list) {
1024 list_move(&req->req_list, &cancel_list);
1025 }
1026 spin_unlock(&m->lock);
1027
1028 list_for_each_entry_safe(req, rtmp, &cancel_list, req_list) {
1029 list_del(&req->req_list);
1030 if (!req->err)
1031 req->err = err;
1032
1033 if (req->cb)
1034 (*req->cb) (req, req->cba);
1035 else
1036 kfree(req->rcall);
1037 }
1038
1039 wake_up(&m->equeue);
1040 }
1041 EXPORT_SYMBOL(p9_conn_cancel);
1042
1043 static u16 p9_mux_get_tag(struct p9_conn *m)
1044 {
1045 int tag;
1046
1047 tag = p9_idpool_get(m->tagpool);
1048 if (tag < 0)
1049 return P9_NOTAG;
1050 else
1051 return (u16) tag;
1052 }
1053
1054 static void p9_mux_put_tag(struct p9_conn *m, u16 tag)
1055 {
1056 if (tag != P9_NOTAG && p9_idpool_check(tag, m->tagpool))
1057 p9_idpool_put(tag, m->tagpool);
1058 }
WRT350N Kernel Patches