1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38#include <linux/dma-mapping.h>
39#include <linux/err.h>
40#include <linux/idr.h>
41#include <linux/interrupt.h>
42#include <linux/rbtree.h>
43#include <linux/sched.h>
44#include <linux/spinlock.h>
45#include <linux/workqueue.h>
46#include <linux/completion.h>
47#include <linux/slab.h>
48#include <linux/module.h>
49#include <linux/sysctl.h>
50
51#include <rdma/iw_cm.h>
52#include <rdma/ib_addr.h>
53#include <rdma/iw_portmap.h>
54#include <rdma/rdma_netlink.h>
55
56#include "iwcm.h"
57
58MODULE_AUTHOR("Tom Tucker");
59MODULE_DESCRIPTION("iWARP CM");
60MODULE_LICENSE("Dual BSD/GPL");
61
62static struct ibnl_client_cbs iwcm_nl_cb_table[] = {
63 [RDMA_NL_IWPM_REG_PID] = {.dump = iwpm_register_pid_cb},
64 [RDMA_NL_IWPM_ADD_MAPPING] = {.dump = iwpm_add_mapping_cb},
65 [RDMA_NL_IWPM_QUERY_MAPPING] = {.dump = iwpm_add_and_query_mapping_cb},
66 [RDMA_NL_IWPM_REMOTE_INFO] = {.dump = iwpm_remote_info_cb},
67 [RDMA_NL_IWPM_HANDLE_ERR] = {.dump = iwpm_mapping_error_cb},
68 [RDMA_NL_IWPM_MAPINFO] = {.dump = iwpm_mapping_info_cb},
69 [RDMA_NL_IWPM_MAPINFO_NUM] = {.dump = iwpm_ack_mapping_info_cb}
70};
71
72static struct workqueue_struct *iwcm_wq;
73struct iwcm_work {
74 struct work_struct work;
75 struct iwcm_id_private *cm_id;
76 struct list_head list;
77 struct iw_cm_event event;
78 struct list_head free_list;
79};
80
81static unsigned int default_backlog = 256;
82
83static struct ctl_table_header *iwcm_ctl_table_hdr;
84static struct ctl_table iwcm_ctl_table[] = {
85 {
86 .procname = "default_backlog",
87 .data = &default_backlog,
88 .maxlen = sizeof(default_backlog),
89 .mode = 0644,
90 .proc_handler = proc_dointvec,
91 },
92 { }
93};
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119static struct iwcm_work *get_work(struct iwcm_id_private *cm_id_priv)
120{
121 struct iwcm_work *work;
122
123 if (list_empty(&cm_id_priv->work_free_list))
124 return NULL;
125 work = list_entry(cm_id_priv->work_free_list.next, struct iwcm_work,
126 free_list);
127 list_del_init(&work->free_list);
128 return work;
129}
130
131static void put_work(struct iwcm_work *work)
132{
133 list_add(&work->free_list, &work->cm_id->work_free_list);
134}
135
136static void dealloc_work_entries(struct iwcm_id_private *cm_id_priv)
137{
138 struct list_head *e, *tmp;
139
140 list_for_each_safe(e, tmp, &cm_id_priv->work_free_list)
141 kfree(list_entry(e, struct iwcm_work, free_list));
142}
143
144static int alloc_work_entries(struct iwcm_id_private *cm_id_priv, int count)
145{
146 struct iwcm_work *work;
147
148 BUG_ON(!list_empty(&cm_id_priv->work_free_list));
149 while (count--) {
150 work = kmalloc(sizeof(struct iwcm_work), GFP_KERNEL);
151 if (!work) {
152 dealloc_work_entries(cm_id_priv);
153 return -ENOMEM;
154 }
155 work->cm_id = cm_id_priv;
156 INIT_LIST_HEAD(&work->list);
157 put_work(work);
158 }
159 return 0;
160}
161
162
163
164
165
166
167static int copy_private_data(struct iw_cm_event *event)
168{
169 void *p;
170
171 p = kmemdup(event->private_data, event->private_data_len, GFP_ATOMIC);
172 if (!p)
173 return -ENOMEM;
174 event->private_data = p;
175 return 0;
176}
177
178static void free_cm_id(struct iwcm_id_private *cm_id_priv)
179{
180 dealloc_work_entries(cm_id_priv);
181 kfree(cm_id_priv);
182}
183
184
185
186
187
188
189static int iwcm_deref_id(struct iwcm_id_private *cm_id_priv)
190{
191 BUG_ON(atomic_read(&cm_id_priv->refcount)==0);
192 if (atomic_dec_and_test(&cm_id_priv->refcount)) {
193 BUG_ON(!list_empty(&cm_id_priv->work_list));
194 complete(&cm_id_priv->destroy_comp);
195 return 1;
196 }
197
198 return 0;
199}
200
201static void add_ref(struct iw_cm_id *cm_id)
202{
203 struct iwcm_id_private *cm_id_priv;
204 cm_id_priv = container_of(cm_id, struct iwcm_id_private, id);
205 atomic_inc(&cm_id_priv->refcount);
206}
207
208static void rem_ref(struct iw_cm_id *cm_id)
209{
210 struct iwcm_id_private *cm_id_priv;
211 int cb_destroy;
212
213 cm_id_priv = container_of(cm_id, struct iwcm_id_private, id);
214
215
216
217
218
219 cb_destroy = test_bit(IWCM_F_CALLBACK_DESTROY, &cm_id_priv->flags);
220 if (iwcm_deref_id(cm_id_priv) && cb_destroy) {
221 BUG_ON(!list_empty(&cm_id_priv->work_list));
222 free_cm_id(cm_id_priv);
223 }
224}
225
226static int cm_event_handler(struct iw_cm_id *cm_id, struct iw_cm_event *event);
227
228struct iw_cm_id *iw_create_cm_id(struct ib_device *device,
229 iw_cm_handler cm_handler,
230 void *context)
231{
232 struct iwcm_id_private *cm_id_priv;
233
234 cm_id_priv = kzalloc(sizeof(*cm_id_priv), GFP_KERNEL);
235 if (!cm_id_priv)
236 return ERR_PTR(-ENOMEM);
237
238 cm_id_priv->state = IW_CM_STATE_IDLE;
239 cm_id_priv->id.device = device;
240 cm_id_priv->id.cm_handler = cm_handler;
241 cm_id_priv->id.context = context;
242 cm_id_priv->id.event_handler = cm_event_handler;
243 cm_id_priv->id.add_ref = add_ref;
244 cm_id_priv->id.rem_ref = rem_ref;
245 spin_lock_init(&cm_id_priv->lock);
246 atomic_set(&cm_id_priv->refcount, 1);
247 init_waitqueue_head(&cm_id_priv->connect_wait);
248 init_completion(&cm_id_priv->destroy_comp);
249 INIT_LIST_HEAD(&cm_id_priv->work_list);
250 INIT_LIST_HEAD(&cm_id_priv->work_free_list);
251
252 return &cm_id_priv->id;
253}
254EXPORT_SYMBOL(iw_create_cm_id);
255
256
257static int iwcm_modify_qp_err(struct ib_qp *qp)
258{
259 struct ib_qp_attr qp_attr;
260
261 if (!qp)
262 return -EINVAL;
263
264 qp_attr.qp_state = IB_QPS_ERR;
265 return ib_modify_qp(qp, &qp_attr, IB_QP_STATE);
266}
267
268
269
270
271
272static int iwcm_modify_qp_sqd(struct ib_qp *qp)
273{
274 struct ib_qp_attr qp_attr;
275
276 BUG_ON(qp == NULL);
277 qp_attr.qp_state = IB_QPS_SQD;
278 return ib_modify_qp(qp, &qp_attr, IB_QP_STATE);
279}
280
281
282
283
284
285
286
287
288
289
290
291
292
293int iw_cm_disconnect(struct iw_cm_id *cm_id, int abrupt)
294{
295 struct iwcm_id_private *cm_id_priv;
296 unsigned long flags;
297 int ret = 0;
298 struct ib_qp *qp = NULL;
299
300 cm_id_priv = container_of(cm_id, struct iwcm_id_private, id);
301
302 wait_event(cm_id_priv->connect_wait,
303 !test_bit(IWCM_F_CONNECT_WAIT, &cm_id_priv->flags));
304
305 spin_lock_irqsave(&cm_id_priv->lock, flags);
306 switch (cm_id_priv->state) {
307 case IW_CM_STATE_ESTABLISHED:
308 cm_id_priv->state = IW_CM_STATE_CLOSING;
309
310
311 if (cm_id_priv->qp)
312 qp = cm_id_priv->qp;
313 else
314 ret = -EINVAL;
315 break;
316 case IW_CM_STATE_LISTEN:
317 ret = -EINVAL;
318 break;
319 case IW_CM_STATE_CLOSING:
320
321 case IW_CM_STATE_IDLE:
322
323 break;
324 case IW_CM_STATE_CONN_RECV:
325
326
327
328
329 break;
330 case IW_CM_STATE_CONN_SENT:
331
332 default:
333 BUG();
334 }
335 spin_unlock_irqrestore(&cm_id_priv->lock, flags);
336
337 if (qp) {
338 if (abrupt)
339 ret = iwcm_modify_qp_err(qp);
340 else
341 ret = iwcm_modify_qp_sqd(qp);
342
343
344
345
346
347 ret = 0;
348 }
349
350 return ret;
351}
352EXPORT_SYMBOL(iw_cm_disconnect);
353
354
355
356
357
358
359
360static void destroy_cm_id(struct iw_cm_id *cm_id)
361{
362 struct iwcm_id_private *cm_id_priv;
363 unsigned long flags;
364
365 cm_id_priv = container_of(cm_id, struct iwcm_id_private, id);
366
367
368
369
370 wait_event(cm_id_priv->connect_wait,
371 !test_bit(IWCM_F_CONNECT_WAIT, &cm_id_priv->flags));
372
373 spin_lock_irqsave(&cm_id_priv->lock, flags);
374 switch (cm_id_priv->state) {
375 case IW_CM_STATE_LISTEN:
376 cm_id_priv->state = IW_CM_STATE_DESTROYING;
377 spin_unlock_irqrestore(&cm_id_priv->lock, flags);
378
379 cm_id->device->iwcm->destroy_listen(cm_id);
380 spin_lock_irqsave(&cm_id_priv->lock, flags);
381 break;
382 case IW_CM_STATE_ESTABLISHED:
383 cm_id_priv->state = IW_CM_STATE_DESTROYING;
384 spin_unlock_irqrestore(&cm_id_priv->lock, flags);
385
386 (void)iwcm_modify_qp_err(cm_id_priv->qp);
387 spin_lock_irqsave(&cm_id_priv->lock, flags);
388 break;
389 case IW_CM_STATE_IDLE:
390 case IW_CM_STATE_CLOSING:
391 cm_id_priv->state = IW_CM_STATE_DESTROYING;
392 break;
393 case IW_CM_STATE_CONN_RECV:
394
395
396
397
398
399
400 cm_id_priv->state = IW_CM_STATE_DESTROYING;
401 spin_unlock_irqrestore(&cm_id_priv->lock, flags);
402 cm_id->device->iwcm->reject(cm_id, NULL, 0);
403 spin_lock_irqsave(&cm_id_priv->lock, flags);
404 break;
405 case IW_CM_STATE_CONN_SENT:
406 case IW_CM_STATE_DESTROYING:
407 default:
408 BUG();
409 break;
410 }
411 if (cm_id_priv->qp) {
412 cm_id_priv->id.device->iwcm->rem_ref(cm_id_priv->qp);
413 cm_id_priv->qp = NULL;
414 }
415 spin_unlock_irqrestore(&cm_id_priv->lock, flags);
416
417 if (cm_id->mapped) {
418 iwpm_remove_mapinfo(&cm_id->local_addr, &cm_id->m_local_addr);
419 iwpm_remove_mapping(&cm_id->local_addr, RDMA_NL_IWCM);
420 }
421
422 (void)iwcm_deref_id(cm_id_priv);
423}
424
425
426
427
428
429
430
431void iw_destroy_cm_id(struct iw_cm_id *cm_id)
432{
433 struct iwcm_id_private *cm_id_priv;
434
435 cm_id_priv = container_of(cm_id, struct iwcm_id_private, id);
436 BUG_ON(test_bit(IWCM_F_CALLBACK_DESTROY, &cm_id_priv->flags));
437
438 destroy_cm_id(cm_id);
439
440 wait_for_completion(&cm_id_priv->destroy_comp);
441
442 free_cm_id(cm_id_priv);
443}
444EXPORT_SYMBOL(iw_destroy_cm_id);
445
446
447
448
449
450
451
452
453
454
455static void iw_cm_check_wildcard(struct sockaddr_storage *pm_addr,
456 struct sockaddr_storage *cm_addr,
457 struct sockaddr_storage *cm_outaddr)
458{
459 if (pm_addr->ss_family == AF_INET) {
460 struct sockaddr_in *pm4_addr = (struct sockaddr_in *)pm_addr;
461
462 if (pm4_addr->sin_addr.s_addr == INADDR_ANY) {
463 struct sockaddr_in *cm4_addr =
464 (struct sockaddr_in *)cm_addr;
465 struct sockaddr_in *cm4_outaddr =
466 (struct sockaddr_in *)cm_outaddr;
467
468 cm4_outaddr->sin_addr = cm4_addr->sin_addr;
469 }
470 } else {
471 struct sockaddr_in6 *pm6_addr = (struct sockaddr_in6 *)pm_addr;
472
473 if (ipv6_addr_type(&pm6_addr->sin6_addr) == IPV6_ADDR_ANY) {
474 struct sockaddr_in6 *cm6_addr =
475 (struct sockaddr_in6 *)cm_addr;
476 struct sockaddr_in6 *cm6_outaddr =
477 (struct sockaddr_in6 *)cm_outaddr;
478
479 cm6_outaddr->sin6_addr = cm6_addr->sin6_addr;
480 }
481 }
482}
483
484
485
486
487
488
489
490
491
492
493
494
495static int iw_cm_map(struct iw_cm_id *cm_id, bool active)
496{
497 struct iwpm_dev_data pm_reg_msg;
498 struct iwpm_sa_data pm_msg;
499 int status;
500
501 cm_id->m_local_addr = cm_id->local_addr;
502 cm_id->m_remote_addr = cm_id->remote_addr;
503
504 memcpy(pm_reg_msg.dev_name, cm_id->device->name,
505 sizeof(pm_reg_msg.dev_name));
506 memcpy(pm_reg_msg.if_name, cm_id->device->iwcm->ifname,
507 sizeof(pm_reg_msg.if_name));
508
509 if (iwpm_register_pid(&pm_reg_msg, RDMA_NL_IWCM) ||
510 !iwpm_valid_pid())
511 return 0;
512
513 cm_id->mapped = true;
514 pm_msg.loc_addr = cm_id->local_addr;
515 pm_msg.rem_addr = cm_id->remote_addr;
516 if (active)
517 status = iwpm_add_and_query_mapping(&pm_msg,
518 RDMA_NL_IWCM);
519 else
520 status = iwpm_add_mapping(&pm_msg, RDMA_NL_IWCM);
521
522 if (!status) {
523 cm_id->m_local_addr = pm_msg.mapped_loc_addr;
524 if (active) {
525 cm_id->m_remote_addr = pm_msg.mapped_rem_addr;
526 iw_cm_check_wildcard(&pm_msg.mapped_rem_addr,
527 &cm_id->remote_addr,
528 &cm_id->m_remote_addr);
529 }
530 }
531
532 return iwpm_create_mapinfo(&cm_id->local_addr,
533 &cm_id->m_local_addr,
534 RDMA_NL_IWCM);
535}
536
537
538
539
540
541
542
543int iw_cm_listen(struct iw_cm_id *cm_id, int backlog)
544{
545 struct iwcm_id_private *cm_id_priv;
546 unsigned long flags;
547 int ret;
548
549 cm_id_priv = container_of(cm_id, struct iwcm_id_private, id);
550
551 if (!backlog)
552 backlog = default_backlog;
553
554 ret = alloc_work_entries(cm_id_priv, backlog);
555 if (ret)
556 return ret;
557
558 spin_lock_irqsave(&cm_id_priv->lock, flags);
559 switch (cm_id_priv->state) {
560 case IW_CM_STATE_IDLE:
561 cm_id_priv->state = IW_CM_STATE_LISTEN;
562 spin_unlock_irqrestore(&cm_id_priv->lock, flags);
563 ret = iw_cm_map(cm_id, false);
564 if (!ret)
565 ret = cm_id->device->iwcm->create_listen(cm_id, backlog);
566 if (ret)
567 cm_id_priv->state = IW_CM_STATE_IDLE;
568 spin_lock_irqsave(&cm_id_priv->lock, flags);
569 break;
570 default:
571 ret = -EINVAL;
572 }
573 spin_unlock_irqrestore(&cm_id_priv->lock, flags);
574
575 return ret;
576}
577EXPORT_SYMBOL(iw_cm_listen);
578
579
580
581
582
583
584int iw_cm_reject(struct iw_cm_id *cm_id,
585 const void *private_data,
586 u8 private_data_len)
587{
588 struct iwcm_id_private *cm_id_priv;
589 unsigned long flags;
590 int ret;
591
592 cm_id_priv = container_of(cm_id, struct iwcm_id_private, id);
593 set_bit(IWCM_F_CONNECT_WAIT, &cm_id_priv->flags);
594
595 spin_lock_irqsave(&cm_id_priv->lock, flags);
596 if (cm_id_priv->state != IW_CM_STATE_CONN_RECV) {
597 spin_unlock_irqrestore(&cm_id_priv->lock, flags);
598 clear_bit(IWCM_F_CONNECT_WAIT, &cm_id_priv->flags);
599 wake_up_all(&cm_id_priv->connect_wait);
600 return -EINVAL;
601 }
602 cm_id_priv->state = IW_CM_STATE_IDLE;
603 spin_unlock_irqrestore(&cm_id_priv->lock, flags);
604
605 ret = cm_id->device->iwcm->reject(cm_id, private_data,
606 private_data_len);
607
608 clear_bit(IWCM_F_CONNECT_WAIT, &cm_id_priv->flags);
609 wake_up_all(&cm_id_priv->connect_wait);
610
611 return ret;
612}
613EXPORT_SYMBOL(iw_cm_reject);
614
615
616
617
618
619
620
621
622int iw_cm_accept(struct iw_cm_id *cm_id,
623 struct iw_cm_conn_param *iw_param)
624{
625 struct iwcm_id_private *cm_id_priv;
626 struct ib_qp *qp;
627 unsigned long flags;
628 int ret;
629
630 cm_id_priv = container_of(cm_id, struct iwcm_id_private, id);
631 set_bit(IWCM_F_CONNECT_WAIT, &cm_id_priv->flags);
632
633 spin_lock_irqsave(&cm_id_priv->lock, flags);
634 if (cm_id_priv->state != IW_CM_STATE_CONN_RECV) {
635 spin_unlock_irqrestore(&cm_id_priv->lock, flags);
636 clear_bit(IWCM_F_CONNECT_WAIT, &cm_id_priv->flags);
637 wake_up_all(&cm_id_priv->connect_wait);
638 return -EINVAL;
639 }
640
641 qp = cm_id->device->iwcm->get_qp(cm_id->device, iw_param->qpn);
642 if (!qp) {
643 spin_unlock_irqrestore(&cm_id_priv->lock, flags);
644 clear_bit(IWCM_F_CONNECT_WAIT, &cm_id_priv->flags);
645 wake_up_all(&cm_id_priv->connect_wait);
646 return -EINVAL;
647 }
648 cm_id->device->iwcm->add_ref(qp);
649 cm_id_priv->qp = qp;
650 spin_unlock_irqrestore(&cm_id_priv->lock, flags);
651
652 ret = cm_id->device->iwcm->accept(cm_id, iw_param);
653 if (ret) {
654
655 BUG_ON(cm_id_priv->state != IW_CM_STATE_CONN_RECV);
656 cm_id_priv->state = IW_CM_STATE_IDLE;
657 spin_lock_irqsave(&cm_id_priv->lock, flags);
658 if (cm_id_priv->qp) {
659 cm_id->device->iwcm->rem_ref(qp);
660 cm_id_priv->qp = NULL;
661 }
662 spin_unlock_irqrestore(&cm_id_priv->lock, flags);
663 clear_bit(IWCM_F_CONNECT_WAIT, &cm_id_priv->flags);
664 wake_up_all(&cm_id_priv->connect_wait);
665 }
666
667 return ret;
668}
669EXPORT_SYMBOL(iw_cm_accept);
670
671
672
673
674
675
676
677
678int iw_cm_connect(struct iw_cm_id *cm_id, struct iw_cm_conn_param *iw_param)
679{
680 struct iwcm_id_private *cm_id_priv;
681 int ret;
682 unsigned long flags;
683 struct ib_qp *qp;
684
685 cm_id_priv = container_of(cm_id, struct iwcm_id_private, id);
686
687 ret = alloc_work_entries(cm_id_priv, 4);
688 if (ret)
689 return ret;
690
691 set_bit(IWCM_F_CONNECT_WAIT, &cm_id_priv->flags);
692 spin_lock_irqsave(&cm_id_priv->lock, flags);
693
694 if (cm_id_priv->state != IW_CM_STATE_IDLE) {
695 ret = -EINVAL;
696 goto err;
697 }
698
699
700 qp = cm_id->device->iwcm->get_qp(cm_id->device, iw_param->qpn);
701 if (!qp) {
702 ret = -EINVAL;
703 goto err;
704 }
705 cm_id->device->iwcm->add_ref(qp);
706 cm_id_priv->qp = qp;
707 cm_id_priv->state = IW_CM_STATE_CONN_SENT;
708 spin_unlock_irqrestore(&cm_id_priv->lock, flags);
709
710 ret = iw_cm_map(cm_id, true);
711 if (!ret)
712 ret = cm_id->device->iwcm->connect(cm_id, iw_param);
713 if (!ret)
714 return 0;
715
716 spin_lock_irqsave(&cm_id_priv->lock, flags);
717 if (cm_id_priv->qp) {
718 cm_id->device->iwcm->rem_ref(qp);
719 cm_id_priv->qp = NULL;
720 }
721 cm_id_priv->state = IW_CM_STATE_IDLE;
722err:
723 spin_unlock_irqrestore(&cm_id_priv->lock, flags);
724 clear_bit(IWCM_F_CONNECT_WAIT, &cm_id_priv->flags);
725 wake_up_all(&cm_id_priv->connect_wait);
726 return ret;
727}
728EXPORT_SYMBOL(iw_cm_connect);
729
730
731
732
733
734
735
736
737
738
739
740
741
742
743
744
745static void cm_conn_req_handler(struct iwcm_id_private *listen_id_priv,
746 struct iw_cm_event *iw_event)
747{
748 unsigned long flags;
749 struct iw_cm_id *cm_id;
750 struct iwcm_id_private *cm_id_priv;
751 int ret;
752
753
754
755
756
757 BUG_ON(iw_event->status);
758
759 cm_id = iw_create_cm_id(listen_id_priv->id.device,
760 listen_id_priv->id.cm_handler,
761 listen_id_priv->id.context);
762
763 if (IS_ERR(cm_id))
764 goto out;
765
766 cm_id->provider_data = iw_event->provider_data;
767 cm_id->m_local_addr = iw_event->local_addr;
768 cm_id->m_remote_addr = iw_event->remote_addr;
769 cm_id->local_addr = listen_id_priv->id.local_addr;
770
771 ret = iwpm_get_remote_info(&listen_id_priv->id.m_local_addr,
772 &iw_event->remote_addr,
773 &cm_id->remote_addr,
774 RDMA_NL_IWCM);
775 if (ret) {
776 cm_id->remote_addr = iw_event->remote_addr;
777 } else {
778 iw_cm_check_wildcard(&listen_id_priv->id.m_local_addr,
779 &iw_event->local_addr,
780 &cm_id->local_addr);
781 iw_event->local_addr = cm_id->local_addr;
782 iw_event->remote_addr = cm_id->remote_addr;
783 }
784
785 cm_id_priv = container_of(cm_id, struct iwcm_id_private, id);
786 cm_id_priv->state = IW_CM_STATE_CONN_RECV;
787
788
789
790
791
792 spin_lock_irqsave(&listen_id_priv->lock, flags);
793 if (listen_id_priv->state != IW_CM_STATE_LISTEN) {
794 spin_unlock_irqrestore(&listen_id_priv->lock, flags);
795 iw_cm_reject(cm_id, NULL, 0);
796 iw_destroy_cm_id(cm_id);
797 goto out;
798 }
799 spin_unlock_irqrestore(&listen_id_priv->lock, flags);
800
801 ret = alloc_work_entries(cm_id_priv, 3);
802 if (ret) {
803 iw_cm_reject(cm_id, NULL, 0);
804 iw_destroy_cm_id(cm_id);
805 goto out;
806 }
807
808
809 ret = cm_id->cm_handler(cm_id, iw_event);
810 if (ret) {
811 iw_cm_reject(cm_id, NULL, 0);
812 set_bit(IWCM_F_CALLBACK_DESTROY, &cm_id_priv->flags);
813 destroy_cm_id(cm_id);
814 if (atomic_read(&cm_id_priv->refcount)==0)
815 free_cm_id(cm_id_priv);
816 }
817
818out:
819 if (iw_event->private_data_len)
820 kfree(iw_event->private_data);
821}
822
823
824
825
826
827
828
829
830
831
832
833
834
835static int cm_conn_est_handler(struct iwcm_id_private *cm_id_priv,
836 struct iw_cm_event *iw_event)
837{
838 unsigned long flags;
839 int ret;
840
841 spin_lock_irqsave(&cm_id_priv->lock, flags);
842
843
844
845
846
847
848 clear_bit(IWCM_F_CONNECT_WAIT, &cm_id_priv->flags);
849 BUG_ON(cm_id_priv->state != IW_CM_STATE_CONN_RECV);
850 cm_id_priv->state = IW_CM_STATE_ESTABLISHED;
851 spin_unlock_irqrestore(&cm_id_priv->lock, flags);
852 ret = cm_id_priv->id.cm_handler(&cm_id_priv->id, iw_event);
853 wake_up_all(&cm_id_priv->connect_wait);
854
855 return ret;
856}
857
858
859
860
861
862
863
864
865static int cm_conn_rep_handler(struct iwcm_id_private *cm_id_priv,
866 struct iw_cm_event *iw_event)
867{
868 unsigned long flags;
869 int ret;
870
871 spin_lock_irqsave(&cm_id_priv->lock, flags);
872
873
874
875
876 clear_bit(IWCM_F_CONNECT_WAIT, &cm_id_priv->flags);
877 BUG_ON(cm_id_priv->state != IW_CM_STATE_CONN_SENT);
878 if (iw_event->status == 0) {
879 cm_id_priv->id.m_local_addr = iw_event->local_addr;
880 cm_id_priv->id.m_remote_addr = iw_event->remote_addr;
881 iw_event->local_addr = cm_id_priv->id.local_addr;
882 iw_event->remote_addr = cm_id_priv->id.remote_addr;
883 cm_id_priv->state = IW_CM_STATE_ESTABLISHED;
884 } else {
885
886 cm_id_priv->id.device->iwcm->rem_ref(cm_id_priv->qp);
887 cm_id_priv->qp = NULL;
888 cm_id_priv->state = IW_CM_STATE_IDLE;
889 }
890 spin_unlock_irqrestore(&cm_id_priv->lock, flags);
891 ret = cm_id_priv->id.cm_handler(&cm_id_priv->id, iw_event);
892
893 if (iw_event->private_data_len)
894 kfree(iw_event->private_data);
895
896
897 wake_up_all(&cm_id_priv->connect_wait);
898
899 return ret;
900}
901
902
903
904
905
906
907static void cm_disconnect_handler(struct iwcm_id_private *cm_id_priv,
908 struct iw_cm_event *iw_event)
909{
910 unsigned long flags;
911
912 spin_lock_irqsave(&cm_id_priv->lock, flags);
913 if (cm_id_priv->state == IW_CM_STATE_ESTABLISHED)
914 cm_id_priv->state = IW_CM_STATE_CLOSING;
915 spin_unlock_irqrestore(&cm_id_priv->lock, flags);
916}
917
918
919
920
921
922
923
924
925
926
927
928
929static int cm_close_handler(struct iwcm_id_private *cm_id_priv,
930 struct iw_cm_event *iw_event)
931{
932 unsigned long flags;
933 int ret = 0;
934 spin_lock_irqsave(&cm_id_priv->lock, flags);
935
936 if (cm_id_priv->qp) {
937 cm_id_priv->id.device->iwcm->rem_ref(cm_id_priv->qp);
938 cm_id_priv->qp = NULL;
939 }
940 switch (cm_id_priv->state) {
941 case IW_CM_STATE_ESTABLISHED:
942 case IW_CM_STATE_CLOSING:
943 cm_id_priv->state = IW_CM_STATE_IDLE;
944 spin_unlock_irqrestore(&cm_id_priv->lock, flags);
945 ret = cm_id_priv->id.cm_handler(&cm_id_priv->id, iw_event);
946 spin_lock_irqsave(&cm_id_priv->lock, flags);
947 break;
948 case IW_CM_STATE_DESTROYING:
949 break;
950 default:
951 BUG();
952 }
953 spin_unlock_irqrestore(&cm_id_priv->lock, flags);
954
955 return ret;
956}
957
958static int process_event(struct iwcm_id_private *cm_id_priv,
959 struct iw_cm_event *iw_event)
960{
961 int ret = 0;
962
963 switch (iw_event->event) {
964 case IW_CM_EVENT_CONNECT_REQUEST:
965 cm_conn_req_handler(cm_id_priv, iw_event);
966 break;
967 case IW_CM_EVENT_CONNECT_REPLY:
968 ret = cm_conn_rep_handler(cm_id_priv, iw_event);
969 break;
970 case IW_CM_EVENT_ESTABLISHED:
971 ret = cm_conn_est_handler(cm_id_priv, iw_event);
972 break;
973 case IW_CM_EVENT_DISCONNECT:
974 cm_disconnect_handler(cm_id_priv, iw_event);
975 break;
976 case IW_CM_EVENT_CLOSE:
977 ret = cm_close_handler(cm_id_priv, iw_event);
978 break;
979 default:
980 BUG();
981 }
982
983 return ret;
984}
985
986
987
988
989
990
991
992
993
994
995static void cm_work_handler(struct work_struct *_work)
996{
997 struct iwcm_work *work = container_of(_work, struct iwcm_work, work);
998 struct iw_cm_event levent;
999 struct iwcm_id_private *cm_id_priv = work->cm_id;
1000 unsigned long flags;
1001 int empty;
1002 int ret = 0;
1003 int destroy_id;
1004
1005 spin_lock_irqsave(&cm_id_priv->lock, flags);
1006 empty = list_empty(&cm_id_priv->work_list);
1007 while (!empty) {
1008 work = list_entry(cm_id_priv->work_list.next,
1009 struct iwcm_work, list);
1010 list_del_init(&work->list);
1011 empty = list_empty(&cm_id_priv->work_list);
1012 levent = work->event;
1013 put_work(work);
1014 spin_unlock_irqrestore(&cm_id_priv->lock, flags);
1015
1016 ret = process_event(cm_id_priv, &levent);
1017 if (ret) {
1018 set_bit(IWCM_F_CALLBACK_DESTROY, &cm_id_priv->flags);
1019 destroy_cm_id(&cm_id_priv->id);
1020 }
1021 BUG_ON(atomic_read(&cm_id_priv->refcount)==0);
1022 destroy_id = test_bit(IWCM_F_CALLBACK_DESTROY, &cm_id_priv->flags);
1023 if (iwcm_deref_id(cm_id_priv)) {
1024 if (destroy_id) {
1025 BUG_ON(!list_empty(&cm_id_priv->work_list));
1026 free_cm_id(cm_id_priv);
1027 }
1028 return;
1029 }
1030 if (empty)
1031 return;
1032 spin_lock_irqsave(&cm_id_priv->lock, flags);
1033 }
1034 spin_unlock_irqrestore(&cm_id_priv->lock, flags);
1035}
1036
1037
1038
1039
1040
1041
1042
1043
1044
1045
1046
1047
1048
1049
1050
1051
1052static int cm_event_handler(struct iw_cm_id *cm_id,
1053 struct iw_cm_event *iw_event)
1054{
1055 struct iwcm_work *work;
1056 struct iwcm_id_private *cm_id_priv;
1057 unsigned long flags;
1058 int ret = 0;
1059
1060 cm_id_priv = container_of(cm_id, struct iwcm_id_private, id);
1061
1062 spin_lock_irqsave(&cm_id_priv->lock, flags);
1063 work = get_work(cm_id_priv);
1064 if (!work) {
1065 ret = -ENOMEM;
1066 goto out;
1067 }
1068
1069 INIT_WORK(&work->work, cm_work_handler);
1070 work->cm_id = cm_id_priv;
1071 work->event = *iw_event;
1072
1073 if ((work->event.event == IW_CM_EVENT_CONNECT_REQUEST ||
1074 work->event.event == IW_CM_EVENT_CONNECT_REPLY) &&
1075 work->event.private_data_len) {
1076 ret = copy_private_data(&work->event);
1077 if (ret) {
1078 put_work(work);
1079 goto out;
1080 }
1081 }
1082
1083 atomic_inc(&cm_id_priv->refcount);
1084 if (list_empty(&cm_id_priv->work_list)) {
1085 list_add_tail(&work->list, &cm_id_priv->work_list);
1086 queue_work(iwcm_wq, &work->work);
1087 } else
1088 list_add_tail(&work->list, &cm_id_priv->work_list);
1089out:
1090 spin_unlock_irqrestore(&cm_id_priv->lock, flags);
1091 return ret;
1092}
1093
1094static int iwcm_init_qp_init_attr(struct iwcm_id_private *cm_id_priv,
1095 struct ib_qp_attr *qp_attr,
1096 int *qp_attr_mask)
1097{
1098 unsigned long flags;
1099 int ret;
1100
1101 spin_lock_irqsave(&cm_id_priv->lock, flags);
1102 switch (cm_id_priv->state) {
1103 case IW_CM_STATE_IDLE:
1104 case IW_CM_STATE_CONN_SENT:
1105 case IW_CM_STATE_CONN_RECV:
1106 case IW_CM_STATE_ESTABLISHED:
1107 *qp_attr_mask = IB_QP_STATE | IB_QP_ACCESS_FLAGS;
1108 qp_attr->qp_access_flags = IB_ACCESS_REMOTE_WRITE|
1109 IB_ACCESS_REMOTE_READ;
1110 ret = 0;
1111 break;
1112 default:
1113 ret = -EINVAL;
1114 break;
1115 }
1116 spin_unlock_irqrestore(&cm_id_priv->lock, flags);
1117 return ret;
1118}
1119
1120static int iwcm_init_qp_rts_attr(struct iwcm_id_private *cm_id_priv,
1121 struct ib_qp_attr *qp_attr,
1122 int *qp_attr_mask)
1123{
1124 unsigned long flags;
1125 int ret;
1126
1127 spin_lock_irqsave(&cm_id_priv->lock, flags);
1128 switch (cm_id_priv->state) {
1129 case IW_CM_STATE_IDLE:
1130 case IW_CM_STATE_CONN_SENT:
1131 case IW_CM_STATE_CONN_RECV:
1132 case IW_CM_STATE_ESTABLISHED:
1133 *qp_attr_mask = 0;
1134 ret = 0;
1135 break;
1136 default:
1137 ret = -EINVAL;
1138 break;
1139 }
1140 spin_unlock_irqrestore(&cm_id_priv->lock, flags);
1141 return ret;
1142}
1143
1144int iw_cm_init_qp_attr(struct iw_cm_id *cm_id,
1145 struct ib_qp_attr *qp_attr,
1146 int *qp_attr_mask)
1147{
1148 struct iwcm_id_private *cm_id_priv;
1149 int ret;
1150
1151 cm_id_priv = container_of(cm_id, struct iwcm_id_private, id);
1152 switch (qp_attr->qp_state) {
1153 case IB_QPS_INIT:
1154 case IB_QPS_RTR:
1155 ret = iwcm_init_qp_init_attr(cm_id_priv,
1156 qp_attr, qp_attr_mask);
1157 break;
1158 case IB_QPS_RTS:
1159 ret = iwcm_init_qp_rts_attr(cm_id_priv,
1160 qp_attr, qp_attr_mask);
1161 break;
1162 default:
1163 ret = -EINVAL;
1164 break;
1165 }
1166 return ret;
1167}
1168EXPORT_SYMBOL(iw_cm_init_qp_attr);
1169
1170static int __init iw_cm_init(void)
1171{
1172 int ret;
1173
1174 ret = iwpm_init(RDMA_NL_IWCM);
1175 if (ret)
1176 pr_err("iw_cm: couldn't init iwpm\n");
1177
1178 ret = ibnl_add_client(RDMA_NL_IWCM, RDMA_NL_IWPM_NUM_OPS,
1179 iwcm_nl_cb_table);
1180 if (ret)
1181 pr_err("iw_cm: couldn't register netlink callbacks\n");
1182
1183 iwcm_wq = create_singlethread_workqueue("iw_cm_wq");
1184 if (!iwcm_wq)
1185 return -ENOMEM;
1186
1187 iwcm_ctl_table_hdr = register_net_sysctl(&init_net, "net/iw_cm",
1188 iwcm_ctl_table);
1189 if (!iwcm_ctl_table_hdr) {
1190 pr_err("iw_cm: couldn't register sysctl paths\n");
1191 destroy_workqueue(iwcm_wq);
1192 return -ENOMEM;
1193 }
1194
1195 return 0;
1196}
1197
1198static void __exit iw_cm_cleanup(void)
1199{
1200 unregister_net_sysctl_table(iwcm_ctl_table_hdr);
1201 destroy_workqueue(iwcm_wq);
1202 ibnl_remove_client(RDMA_NL_IWCM);
1203 iwpm_exit(RDMA_NL_IWCM);
1204}
1205
1206module_init(iw_cm_init);
1207module_exit(iw_cm_cleanup);
1208