Merge tag 'regulator-fix-v4.9-rc3' of git://git.kernel.org/pub/scm/linux/kernel/git...
[cascardo/linux.git] / drivers / infiniband / ulp / ipoib / ipoib_ib.c
1 /*
2  * Copyright (c) 2004, 2005 Topspin Communications.  All rights reserved.
3  * Copyright (c) 2005 Sun Microsystems, Inc. All rights reserved.
4  * Copyright (c) 2005 Mellanox Technologies. All rights reserved.
5  * Copyright (c) 2004, 2005 Voltaire, Inc. All rights reserved.
6  *
7  * This software is available to you under a choice of one of two
8  * licenses.  You may choose to be licensed under the terms of the GNU
9  * General Public License (GPL) Version 2, available from the file
10  * COPYING in the main directory of this source tree, or the
11  * OpenIB.org BSD license below:
12  *
13  *     Redistribution and use in source and binary forms, with or
14  *     without modification, are permitted provided that the following
15  *     conditions are met:
16  *
17  *      - Redistributions of source code must retain the above
18  *        copyright notice, this list of conditions and the following
19  *        disclaimer.
20  *
21  *      - Redistributions in binary form must reproduce the above
22  *        copyright notice, this list of conditions and the following
23  *        disclaimer in the documentation and/or other materials
24  *        provided with the distribution.
25  *
26  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
27  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
28  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
29  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
30  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
31  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
32  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
33  * SOFTWARE.
34  */
35
36 #include <linux/delay.h>
37 #include <linux/moduleparam.h>
38 #include <linux/dma-mapping.h>
39 #include <linux/slab.h>
40
41 #include <linux/ip.h>
42 #include <linux/tcp.h>
43
44 #include "ipoib.h"
45
46 #ifdef CONFIG_INFINIBAND_IPOIB_DEBUG_DATA
47 static int data_debug_level;
48
49 module_param(data_debug_level, int, 0644);
50 MODULE_PARM_DESC(data_debug_level,
51                  "Enable data path debug tracing if > 0");
52 #endif
53
54 struct ipoib_ah *ipoib_create_ah(struct net_device *dev,
55                                  struct ib_pd *pd, struct ib_ah_attr *attr)
56 {
57         struct ipoib_ah *ah;
58         struct ib_ah *vah;
59
60         ah = kmalloc(sizeof *ah, GFP_KERNEL);
61         if (!ah)
62                 return ERR_PTR(-ENOMEM);
63
64         ah->dev       = dev;
65         ah->last_send = 0;
66         kref_init(&ah->ref);
67
68         vah = ib_create_ah(pd, attr);
69         if (IS_ERR(vah)) {
70                 kfree(ah);
71                 ah = (struct ipoib_ah *)vah;
72         } else {
73                 ah->ah = vah;
74                 ipoib_dbg(netdev_priv(dev), "Created ah %p\n", ah->ah);
75         }
76
77         return ah;
78 }
79
80 void ipoib_free_ah(struct kref *kref)
81 {
82         struct ipoib_ah *ah = container_of(kref, struct ipoib_ah, ref);
83         struct ipoib_dev_priv *priv = netdev_priv(ah->dev);
84
85         unsigned long flags;
86
87         spin_lock_irqsave(&priv->lock, flags);
88         list_add_tail(&ah->list, &priv->dead_ahs);
89         spin_unlock_irqrestore(&priv->lock, flags);
90 }
91
92 static void ipoib_ud_dma_unmap_rx(struct ipoib_dev_priv *priv,
93                                   u64 mapping[IPOIB_UD_RX_SG])
94 {
95         ib_dma_unmap_single(priv->ca, mapping[0],
96                             IPOIB_UD_BUF_SIZE(priv->max_ib_mtu),
97                             DMA_FROM_DEVICE);
98 }
99
100 static int ipoib_ib_post_receive(struct net_device *dev, int id)
101 {
102         struct ipoib_dev_priv *priv = netdev_priv(dev);
103         struct ib_recv_wr *bad_wr;
104         int ret;
105
106         priv->rx_wr.wr_id   = id | IPOIB_OP_RECV;
107         priv->rx_sge[0].addr = priv->rx_ring[id].mapping[0];
108         priv->rx_sge[1].addr = priv->rx_ring[id].mapping[1];
109
110
111         ret = ib_post_recv(priv->qp, &priv->rx_wr, &bad_wr);
112         if (unlikely(ret)) {
113                 ipoib_warn(priv, "receive failed for buf %d (%d)\n", id, ret);
114                 ipoib_ud_dma_unmap_rx(priv, priv->rx_ring[id].mapping);
115                 dev_kfree_skb_any(priv->rx_ring[id].skb);
116                 priv->rx_ring[id].skb = NULL;
117         }
118
119         return ret;
120 }
121
122 static struct sk_buff *ipoib_alloc_rx_skb(struct net_device *dev, int id)
123 {
124         struct ipoib_dev_priv *priv = netdev_priv(dev);
125         struct sk_buff *skb;
126         int buf_size;
127         u64 *mapping;
128
129         buf_size = IPOIB_UD_BUF_SIZE(priv->max_ib_mtu);
130
131         skb = dev_alloc_skb(buf_size + IPOIB_HARD_LEN);
132         if (unlikely(!skb))
133                 return NULL;
134
135         /*
136          * the IP header will be at IPOIP_HARD_LEN + IB_GRH_BYTES, that is
137          * 64 bytes aligned
138          */
139         skb_reserve(skb, sizeof(struct ipoib_pseudo_header));
140
141         mapping = priv->rx_ring[id].mapping;
142         mapping[0] = ib_dma_map_single(priv->ca, skb->data, buf_size,
143                                        DMA_FROM_DEVICE);
144         if (unlikely(ib_dma_mapping_error(priv->ca, mapping[0])))
145                 goto error;
146
147         priv->rx_ring[id].skb = skb;
148         return skb;
149 error:
150         dev_kfree_skb_any(skb);
151         return NULL;
152 }
153
154 static int ipoib_ib_post_receives(struct net_device *dev)
155 {
156         struct ipoib_dev_priv *priv = netdev_priv(dev);
157         int i;
158
159         for (i = 0; i < ipoib_recvq_size; ++i) {
160                 if (!ipoib_alloc_rx_skb(dev, i)) {
161                         ipoib_warn(priv, "failed to allocate receive buffer %d\n", i);
162                         return -ENOMEM;
163                 }
164                 if (ipoib_ib_post_receive(dev, i)) {
165                         ipoib_warn(priv, "ipoib_ib_post_receive failed for buf %d\n", i);
166                         return -EIO;
167                 }
168         }
169
170         return 0;
171 }
172
173 static void ipoib_ib_handle_rx_wc(struct net_device *dev, struct ib_wc *wc)
174 {
175         struct ipoib_dev_priv *priv = netdev_priv(dev);
176         unsigned int wr_id = wc->wr_id & ~IPOIB_OP_RECV;
177         struct sk_buff *skb;
178         u64 mapping[IPOIB_UD_RX_SG];
179         union ib_gid *dgid;
180         union ib_gid *sgid;
181
182         ipoib_dbg_data(priv, "recv completion: id %d, status: %d\n",
183                        wr_id, wc->status);
184
185         if (unlikely(wr_id >= ipoib_recvq_size)) {
186                 ipoib_warn(priv, "recv completion event with wrid %d (> %d)\n",
187                            wr_id, ipoib_recvq_size);
188                 return;
189         }
190
191         skb  = priv->rx_ring[wr_id].skb;
192
193         if (unlikely(wc->status != IB_WC_SUCCESS)) {
194                 if (wc->status != IB_WC_WR_FLUSH_ERR)
195                         ipoib_warn(priv, "failed recv event "
196                                    "(status=%d, wrid=%d vend_err %x)\n",
197                                    wc->status, wr_id, wc->vendor_err);
198                 ipoib_ud_dma_unmap_rx(priv, priv->rx_ring[wr_id].mapping);
199                 dev_kfree_skb_any(skb);
200                 priv->rx_ring[wr_id].skb = NULL;
201                 return;
202         }
203
204         memcpy(mapping, priv->rx_ring[wr_id].mapping,
205                IPOIB_UD_RX_SG * sizeof *mapping);
206
207         /*
208          * If we can't allocate a new RX buffer, dump
209          * this packet and reuse the old buffer.
210          */
211         if (unlikely(!ipoib_alloc_rx_skb(dev, wr_id))) {
212                 ++dev->stats.rx_dropped;
213                 goto repost;
214         }
215
216         ipoib_dbg_data(priv, "received %d bytes, SLID 0x%04x\n",
217                        wc->byte_len, wc->slid);
218
219         ipoib_ud_dma_unmap_rx(priv, mapping);
220
221         skb_put(skb, wc->byte_len);
222
223         /* First byte of dgid signals multicast when 0xff */
224         dgid = &((struct ib_grh *)skb->data)->dgid;
225
226         if (!(wc->wc_flags & IB_WC_GRH) || dgid->raw[0] != 0xff)
227                 skb->pkt_type = PACKET_HOST;
228         else if (memcmp(dgid, dev->broadcast + 4, sizeof(union ib_gid)) == 0)
229                 skb->pkt_type = PACKET_BROADCAST;
230         else
231                 skb->pkt_type = PACKET_MULTICAST;
232
233         sgid = &((struct ib_grh *)skb->data)->sgid;
234
235         /*
236          * Drop packets that this interface sent, ie multicast packets
237          * that the HCA has replicated.
238          */
239         if (wc->slid == priv->local_lid && wc->src_qp == priv->qp->qp_num) {
240                 int need_repost = 1;
241
242                 if ((wc->wc_flags & IB_WC_GRH) &&
243                     sgid->global.interface_id != priv->local_gid.global.interface_id)
244                         need_repost = 0;
245
246                 if (need_repost) {
247                         dev_kfree_skb_any(skb);
248                         goto repost;
249                 }
250         }
251
252         skb_pull(skb, IB_GRH_BYTES);
253
254         skb->protocol = ((struct ipoib_header *) skb->data)->proto;
255         skb_add_pseudo_hdr(skb);
256
257         ++dev->stats.rx_packets;
258         dev->stats.rx_bytes += skb->len;
259
260         skb->dev = dev;
261         if ((dev->features & NETIF_F_RXCSUM) &&
262                         likely(wc->wc_flags & IB_WC_IP_CSUM_OK))
263                 skb->ip_summed = CHECKSUM_UNNECESSARY;
264
265         napi_gro_receive(&priv->napi, skb);
266
267 repost:
268         if (unlikely(ipoib_ib_post_receive(dev, wr_id)))
269                 ipoib_warn(priv, "ipoib_ib_post_receive failed "
270                            "for buf %d\n", wr_id);
271 }
272
273 int ipoib_dma_map_tx(struct ib_device *ca, struct ipoib_tx_buf *tx_req)
274 {
275         struct sk_buff *skb = tx_req->skb;
276         u64 *mapping = tx_req->mapping;
277         int i;
278         int off;
279
280         if (skb_headlen(skb)) {
281                 mapping[0] = ib_dma_map_single(ca, skb->data, skb_headlen(skb),
282                                                DMA_TO_DEVICE);
283                 if (unlikely(ib_dma_mapping_error(ca, mapping[0])))
284                         return -EIO;
285
286                 off = 1;
287         } else
288                 off = 0;
289
290         for (i = 0; i < skb_shinfo(skb)->nr_frags; ++i) {
291                 const skb_frag_t *frag = &skb_shinfo(skb)->frags[i];
292                 mapping[i + off] = ib_dma_map_page(ca,
293                                                  skb_frag_page(frag),
294                                                  frag->page_offset, skb_frag_size(frag),
295                                                  DMA_TO_DEVICE);
296                 if (unlikely(ib_dma_mapping_error(ca, mapping[i + off])))
297                         goto partial_error;
298         }
299         return 0;
300
301 partial_error:
302         for (; i > 0; --i) {
303                 const skb_frag_t *frag = &skb_shinfo(skb)->frags[i - 1];
304
305                 ib_dma_unmap_page(ca, mapping[i - !off], skb_frag_size(frag), DMA_TO_DEVICE);
306         }
307
308         if (off)
309                 ib_dma_unmap_single(ca, mapping[0], skb_headlen(skb), DMA_TO_DEVICE);
310
311         return -EIO;
312 }
313
314 void ipoib_dma_unmap_tx(struct ipoib_dev_priv *priv,
315                         struct ipoib_tx_buf *tx_req)
316 {
317         struct sk_buff *skb = tx_req->skb;
318         u64 *mapping = tx_req->mapping;
319         int i;
320         int off;
321
322         if (skb_headlen(skb)) {
323                 ib_dma_unmap_single(priv->ca, mapping[0], skb_headlen(skb),
324                                     DMA_TO_DEVICE);
325                 off = 1;
326         } else
327                 off = 0;
328
329         for (i = 0; i < skb_shinfo(skb)->nr_frags; ++i) {
330                 const skb_frag_t *frag = &skb_shinfo(skb)->frags[i];
331
332                 ib_dma_unmap_page(priv->ca, mapping[i + off],
333                                   skb_frag_size(frag), DMA_TO_DEVICE);
334         }
335 }
336
337 /*
338  * As the result of a completion error the QP Can be transferred to SQE states.
339  * The function checks if the (send)QP is in SQE state and
340  * moves it back to RTS state, that in order to have it functional again.
341  */
342 static void ipoib_qp_state_validate_work(struct work_struct *work)
343 {
344         struct ipoib_qp_state_validate *qp_work =
345                 container_of(work, struct ipoib_qp_state_validate, work);
346
347         struct ipoib_dev_priv *priv = qp_work->priv;
348         struct ib_qp_attr qp_attr;
349         struct ib_qp_init_attr query_init_attr;
350         int ret;
351
352         ret = ib_query_qp(priv->qp, &qp_attr, IB_QP_STATE, &query_init_attr);
353         if (ret) {
354                 ipoib_warn(priv, "%s: Failed to query QP ret: %d\n",
355                            __func__, ret);
356                 goto free_res;
357         }
358         pr_info("%s: QP: 0x%x is in state: %d\n",
359                 __func__, priv->qp->qp_num, qp_attr.qp_state);
360
361         /* currently support only in SQE->RTS transition*/
362         if (qp_attr.qp_state == IB_QPS_SQE) {
363                 qp_attr.qp_state = IB_QPS_RTS;
364
365                 ret = ib_modify_qp(priv->qp, &qp_attr, IB_QP_STATE);
366                 if (ret) {
367                         pr_warn("failed(%d) modify QP:0x%x SQE->RTS\n",
368                                 ret, priv->qp->qp_num);
369                         goto free_res;
370                 }
371                 pr_info("%s: QP: 0x%x moved from IB_QPS_SQE to IB_QPS_RTS\n",
372                         __func__, priv->qp->qp_num);
373         } else {
374                 pr_warn("QP (%d) will stay in state: %d\n",
375                         priv->qp->qp_num, qp_attr.qp_state);
376         }
377
378 free_res:
379         kfree(qp_work);
380 }
381
382 static void ipoib_ib_handle_tx_wc(struct net_device *dev, struct ib_wc *wc)
383 {
384         struct ipoib_dev_priv *priv = netdev_priv(dev);
385         unsigned int wr_id = wc->wr_id;
386         struct ipoib_tx_buf *tx_req;
387
388         ipoib_dbg_data(priv, "send completion: id %d, status: %d\n",
389                        wr_id, wc->status);
390
391         if (unlikely(wr_id >= ipoib_sendq_size)) {
392                 ipoib_warn(priv, "send completion event with wrid %d (> %d)\n",
393                            wr_id, ipoib_sendq_size);
394                 return;
395         }
396
397         tx_req = &priv->tx_ring[wr_id];
398
399         ipoib_dma_unmap_tx(priv, tx_req);
400
401         ++dev->stats.tx_packets;
402         dev->stats.tx_bytes += tx_req->skb->len;
403
404         dev_kfree_skb_any(tx_req->skb);
405
406         ++priv->tx_tail;
407         if (unlikely(--priv->tx_outstanding == ipoib_sendq_size >> 1) &&
408             netif_queue_stopped(dev) &&
409             test_bit(IPOIB_FLAG_ADMIN_UP, &priv->flags))
410                 netif_wake_queue(dev);
411
412         if (wc->status != IB_WC_SUCCESS &&
413             wc->status != IB_WC_WR_FLUSH_ERR) {
414                 struct ipoib_qp_state_validate *qp_work;
415                 ipoib_warn(priv, "failed send event "
416                            "(status=%d, wrid=%d vend_err %x)\n",
417                            wc->status, wr_id, wc->vendor_err);
418                 qp_work = kzalloc(sizeof(*qp_work), GFP_ATOMIC);
419                 if (!qp_work) {
420                         ipoib_warn(priv, "%s Failed alloc ipoib_qp_state_validate for qp: 0x%x\n",
421                                    __func__, priv->qp->qp_num);
422                         return;
423                 }
424
425                 INIT_WORK(&qp_work->work, ipoib_qp_state_validate_work);
426                 qp_work->priv = priv;
427                 queue_work(priv->wq, &qp_work->work);
428         }
429 }
430
431 static int poll_tx(struct ipoib_dev_priv *priv)
432 {
433         int n, i;
434
435         n = ib_poll_cq(priv->send_cq, MAX_SEND_CQE, priv->send_wc);
436         for (i = 0; i < n; ++i)
437                 ipoib_ib_handle_tx_wc(priv->dev, priv->send_wc + i);
438
439         return n == MAX_SEND_CQE;
440 }
441
442 int ipoib_poll(struct napi_struct *napi, int budget)
443 {
444         struct ipoib_dev_priv *priv = container_of(napi, struct ipoib_dev_priv, napi);
445         struct net_device *dev = priv->dev;
446         int done;
447         int t;
448         int n, i;
449
450         done  = 0;
451
452 poll_more:
453         while (done < budget) {
454                 int max = (budget - done);
455
456                 t = min(IPOIB_NUM_WC, max);
457                 n = ib_poll_cq(priv->recv_cq, t, priv->ibwc);
458
459                 for (i = 0; i < n; i++) {
460                         struct ib_wc *wc = priv->ibwc + i;
461
462                         if (wc->wr_id & IPOIB_OP_RECV) {
463                                 ++done;
464                                 if (wc->wr_id & IPOIB_OP_CM)
465                                         ipoib_cm_handle_rx_wc(dev, wc);
466                                 else
467                                         ipoib_ib_handle_rx_wc(dev, wc);
468                         } else
469                                 ipoib_cm_handle_tx_wc(priv->dev, wc);
470                 }
471
472                 if (n != t)
473                         break;
474         }
475
476         if (done < budget) {
477                 napi_complete(napi);
478                 if (unlikely(ib_req_notify_cq(priv->recv_cq,
479                                               IB_CQ_NEXT_COMP |
480                                               IB_CQ_REPORT_MISSED_EVENTS)) &&
481                     napi_reschedule(napi))
482                         goto poll_more;
483         }
484
485         return done;
486 }
487
488 void ipoib_ib_completion(struct ib_cq *cq, void *dev_ptr)
489 {
490         struct net_device *dev = dev_ptr;
491         struct ipoib_dev_priv *priv = netdev_priv(dev);
492
493         napi_schedule(&priv->napi);
494 }
495
496 static void drain_tx_cq(struct net_device *dev)
497 {
498         struct ipoib_dev_priv *priv = netdev_priv(dev);
499
500         netif_tx_lock(dev);
501         while (poll_tx(priv))
502                 ; /* nothing */
503
504         if (netif_queue_stopped(dev))
505                 mod_timer(&priv->poll_timer, jiffies + 1);
506
507         netif_tx_unlock(dev);
508 }
509
510 void ipoib_send_comp_handler(struct ib_cq *cq, void *dev_ptr)
511 {
512         struct ipoib_dev_priv *priv = netdev_priv(dev_ptr);
513
514         mod_timer(&priv->poll_timer, jiffies);
515 }
516
517 static inline int post_send(struct ipoib_dev_priv *priv,
518                             unsigned int wr_id,
519                             struct ib_ah *address, u32 qpn,
520                             struct ipoib_tx_buf *tx_req,
521                             void *head, int hlen)
522 {
523         struct ib_send_wr *bad_wr;
524         struct sk_buff *skb = tx_req->skb;
525
526         ipoib_build_sge(priv, tx_req);
527
528         priv->tx_wr.wr.wr_id    = wr_id;
529         priv->tx_wr.remote_qpn  = qpn;
530         priv->tx_wr.ah          = address;
531
532         if (head) {
533                 priv->tx_wr.mss         = skb_shinfo(skb)->gso_size;
534                 priv->tx_wr.header      = head;
535                 priv->tx_wr.hlen        = hlen;
536                 priv->tx_wr.wr.opcode   = IB_WR_LSO;
537         } else
538                 priv->tx_wr.wr.opcode   = IB_WR_SEND;
539
540         return ib_post_send(priv->qp, &priv->tx_wr.wr, &bad_wr);
541 }
542
543 void ipoib_send(struct net_device *dev, struct sk_buff *skb,
544                 struct ipoib_ah *address, u32 qpn)
545 {
546         struct ipoib_dev_priv *priv = netdev_priv(dev);
547         struct ipoib_tx_buf *tx_req;
548         int hlen, rc;
549         void *phead;
550         unsigned usable_sge = priv->max_send_sge - !!skb_headlen(skb);
551
552         if (skb_is_gso(skb)) {
553                 hlen = skb_transport_offset(skb) + tcp_hdrlen(skb);
554                 phead = skb->data;
555                 if (unlikely(!skb_pull(skb, hlen))) {
556                         ipoib_warn(priv, "linear data too small\n");
557                         ++dev->stats.tx_dropped;
558                         ++dev->stats.tx_errors;
559                         dev_kfree_skb_any(skb);
560                         return;
561                 }
562         } else {
563                 if (unlikely(skb->len > priv->mcast_mtu + IPOIB_ENCAP_LEN)) {
564                         ipoib_warn(priv, "packet len %d (> %d) too long to send, dropping\n",
565                                    skb->len, priv->mcast_mtu + IPOIB_ENCAP_LEN);
566                         ++dev->stats.tx_dropped;
567                         ++dev->stats.tx_errors;
568                         ipoib_cm_skb_too_long(dev, skb, priv->mcast_mtu);
569                         return;
570                 }
571                 phead = NULL;
572                 hlen  = 0;
573         }
574         if (skb_shinfo(skb)->nr_frags > usable_sge) {
575                 if (skb_linearize(skb) < 0) {
576                         ipoib_warn(priv, "skb could not be linearized\n");
577                         ++dev->stats.tx_dropped;
578                         ++dev->stats.tx_errors;
579                         dev_kfree_skb_any(skb);
580                         return;
581                 }
582                 /* Does skb_linearize return ok without reducing nr_frags? */
583                 if (skb_shinfo(skb)->nr_frags > usable_sge) {
584                         ipoib_warn(priv, "too many frags after skb linearize\n");
585                         ++dev->stats.tx_dropped;
586                         ++dev->stats.tx_errors;
587                         dev_kfree_skb_any(skb);
588                         return;
589                 }
590         }
591
592         ipoib_dbg_data(priv, "sending packet, length=%d address=%p qpn=0x%06x\n",
593                        skb->len, address, qpn);
594
595         /*
596          * We put the skb into the tx_ring _before_ we call post_send()
597          * because it's entirely possible that the completion handler will
598          * run before we execute anything after the post_send().  That
599          * means we have to make sure everything is properly recorded and
600          * our state is consistent before we call post_send().
601          */
602         tx_req = &priv->tx_ring[priv->tx_head & (ipoib_sendq_size - 1)];
603         tx_req->skb = skb;
604         if (unlikely(ipoib_dma_map_tx(priv->ca, tx_req))) {
605                 ++dev->stats.tx_errors;
606                 dev_kfree_skb_any(skb);
607                 return;
608         }
609
610         if (skb->ip_summed == CHECKSUM_PARTIAL)
611                 priv->tx_wr.wr.send_flags |= IB_SEND_IP_CSUM;
612         else
613                 priv->tx_wr.wr.send_flags &= ~IB_SEND_IP_CSUM;
614
615         if (++priv->tx_outstanding == ipoib_sendq_size) {
616                 ipoib_dbg(priv, "TX ring full, stopping kernel net queue\n");
617                 if (ib_req_notify_cq(priv->send_cq, IB_CQ_NEXT_COMP))
618                         ipoib_warn(priv, "request notify on send CQ failed\n");
619                 netif_stop_queue(dev);
620         }
621
622         skb_orphan(skb);
623         skb_dst_drop(skb);
624
625         rc = post_send(priv, priv->tx_head & (ipoib_sendq_size - 1),
626                        address->ah, qpn, tx_req, phead, hlen);
627         if (unlikely(rc)) {
628                 ipoib_warn(priv, "post_send failed, error %d\n", rc);
629                 ++dev->stats.tx_errors;
630                 --priv->tx_outstanding;
631                 ipoib_dma_unmap_tx(priv, tx_req);
632                 dev_kfree_skb_any(skb);
633                 if (netif_queue_stopped(dev))
634                         netif_wake_queue(dev);
635         } else {
636                 netif_trans_update(dev);
637
638                 address->last_send = priv->tx_head;
639                 ++priv->tx_head;
640         }
641
642         if (unlikely(priv->tx_outstanding > MAX_SEND_CQE))
643                 while (poll_tx(priv))
644                         ; /* nothing */
645 }
646
647 static void __ipoib_reap_ah(struct net_device *dev)
648 {
649         struct ipoib_dev_priv *priv = netdev_priv(dev);
650         struct ipoib_ah *ah, *tah;
651         LIST_HEAD(remove_list);
652         unsigned long flags;
653
654         netif_tx_lock_bh(dev);
655         spin_lock_irqsave(&priv->lock, flags);
656
657         list_for_each_entry_safe(ah, tah, &priv->dead_ahs, list)
658                 if ((int) priv->tx_tail - (int) ah->last_send >= 0) {
659                         list_del(&ah->list);
660                         ib_destroy_ah(ah->ah);
661                         kfree(ah);
662                 }
663
664         spin_unlock_irqrestore(&priv->lock, flags);
665         netif_tx_unlock_bh(dev);
666 }
667
668 void ipoib_reap_ah(struct work_struct *work)
669 {
670         struct ipoib_dev_priv *priv =
671                 container_of(work, struct ipoib_dev_priv, ah_reap_task.work);
672         struct net_device *dev = priv->dev;
673
674         __ipoib_reap_ah(dev);
675
676         if (!test_bit(IPOIB_STOP_REAPER, &priv->flags))
677                 queue_delayed_work(priv->wq, &priv->ah_reap_task,
678                                    round_jiffies_relative(HZ));
679 }
680
681 static void ipoib_flush_ah(struct net_device *dev)
682 {
683         struct ipoib_dev_priv *priv = netdev_priv(dev);
684
685         cancel_delayed_work(&priv->ah_reap_task);
686         flush_workqueue(priv->wq);
687         ipoib_reap_ah(&priv->ah_reap_task.work);
688 }
689
690 static void ipoib_stop_ah(struct net_device *dev)
691 {
692         struct ipoib_dev_priv *priv = netdev_priv(dev);
693
694         set_bit(IPOIB_STOP_REAPER, &priv->flags);
695         ipoib_flush_ah(dev);
696 }
697
698 static void ipoib_ib_tx_timer_func(unsigned long ctx)
699 {
700         drain_tx_cq((struct net_device *)ctx);
701 }
702
703 int ipoib_ib_dev_open(struct net_device *dev)
704 {
705         struct ipoib_dev_priv *priv = netdev_priv(dev);
706         int ret;
707
708         ipoib_pkey_dev_check_presence(dev);
709
710         if (!test_bit(IPOIB_PKEY_ASSIGNED, &priv->flags)) {
711                 ipoib_warn(priv, "P_Key 0x%04x is %s\n", priv->pkey,
712                            (!(priv->pkey & 0x7fff) ? "Invalid" : "not found"));
713                 return -1;
714         }
715
716         ret = ipoib_init_qp(dev);
717         if (ret) {
718                 ipoib_warn(priv, "ipoib_init_qp returned %d\n", ret);
719                 return -1;
720         }
721
722         ret = ipoib_ib_post_receives(dev);
723         if (ret) {
724                 ipoib_warn(priv, "ipoib_ib_post_receives returned %d\n", ret);
725                 goto dev_stop;
726         }
727
728         ret = ipoib_cm_dev_open(dev);
729         if (ret) {
730                 ipoib_warn(priv, "ipoib_cm_dev_open returned %d\n", ret);
731                 goto dev_stop;
732         }
733
734         clear_bit(IPOIB_STOP_REAPER, &priv->flags);
735         queue_delayed_work(priv->wq, &priv->ah_reap_task,
736                            round_jiffies_relative(HZ));
737
738         if (!test_and_set_bit(IPOIB_FLAG_INITIALIZED, &priv->flags))
739                 napi_enable(&priv->napi);
740
741         return 0;
742 dev_stop:
743         if (!test_and_set_bit(IPOIB_FLAG_INITIALIZED, &priv->flags))
744                 napi_enable(&priv->napi);
745         ipoib_ib_dev_stop(dev);
746         return -1;
747 }
748
749 void ipoib_pkey_dev_check_presence(struct net_device *dev)
750 {
751         struct ipoib_dev_priv *priv = netdev_priv(dev);
752
753         if (!(priv->pkey & 0x7fff) ||
754             ib_find_pkey(priv->ca, priv->port, priv->pkey,
755                          &priv->pkey_index))
756                 clear_bit(IPOIB_PKEY_ASSIGNED, &priv->flags);
757         else
758                 set_bit(IPOIB_PKEY_ASSIGNED, &priv->flags);
759 }
760
761 int ipoib_ib_dev_up(struct net_device *dev)
762 {
763         struct ipoib_dev_priv *priv = netdev_priv(dev);
764
765         ipoib_pkey_dev_check_presence(dev);
766
767         if (!test_bit(IPOIB_PKEY_ASSIGNED, &priv->flags)) {
768                 ipoib_dbg(priv, "PKEY is not assigned.\n");
769                 return 0;
770         }
771
772         set_bit(IPOIB_FLAG_OPER_UP, &priv->flags);
773
774         return ipoib_mcast_start_thread(dev);
775 }
776
777 int ipoib_ib_dev_down(struct net_device *dev)
778 {
779         struct ipoib_dev_priv *priv = netdev_priv(dev);
780
781         ipoib_dbg(priv, "downing ib_dev\n");
782
783         clear_bit(IPOIB_FLAG_OPER_UP, &priv->flags);
784         netif_carrier_off(dev);
785
786         ipoib_mcast_stop_thread(dev);
787         ipoib_mcast_dev_flush(dev);
788
789         ipoib_flush_paths(dev);
790
791         return 0;
792 }
793
794 static int recvs_pending(struct net_device *dev)
795 {
796         struct ipoib_dev_priv *priv = netdev_priv(dev);
797         int pending = 0;
798         int i;
799
800         for (i = 0; i < ipoib_recvq_size; ++i)
801                 if (priv->rx_ring[i].skb)
802                         ++pending;
803
804         return pending;
805 }
806
807 void ipoib_drain_cq(struct net_device *dev)
808 {
809         struct ipoib_dev_priv *priv = netdev_priv(dev);
810         int i, n;
811
812         /*
813          * We call completion handling routines that expect to be
814          * called from the BH-disabled NAPI poll context, so disable
815          * BHs here too.
816          */
817         local_bh_disable();
818
819         do {
820                 n = ib_poll_cq(priv->recv_cq, IPOIB_NUM_WC, priv->ibwc);
821                 for (i = 0; i < n; ++i) {
822                         /*
823                          * Convert any successful completions to flush
824                          * errors to avoid passing packets up the
825                          * stack after bringing the device down.
826                          */
827                         if (priv->ibwc[i].status == IB_WC_SUCCESS)
828                                 priv->ibwc[i].status = IB_WC_WR_FLUSH_ERR;
829
830                         if (priv->ibwc[i].wr_id & IPOIB_OP_RECV) {
831                                 if (priv->ibwc[i].wr_id & IPOIB_OP_CM)
832                                         ipoib_cm_handle_rx_wc(dev, priv->ibwc + i);
833                                 else
834                                         ipoib_ib_handle_rx_wc(dev, priv->ibwc + i);
835                         } else
836                                 ipoib_cm_handle_tx_wc(dev, priv->ibwc + i);
837                 }
838         } while (n == IPOIB_NUM_WC);
839
840         while (poll_tx(priv))
841                 ; /* nothing */
842
843         local_bh_enable();
844 }
845
846 int ipoib_ib_dev_stop(struct net_device *dev)
847 {
848         struct ipoib_dev_priv *priv = netdev_priv(dev);
849         struct ib_qp_attr qp_attr;
850         unsigned long begin;
851         struct ipoib_tx_buf *tx_req;
852         int i;
853
854         if (test_and_clear_bit(IPOIB_FLAG_INITIALIZED, &priv->flags))
855                 napi_disable(&priv->napi);
856
857         ipoib_cm_dev_stop(dev);
858
859         /*
860          * Move our QP to the error state and then reinitialize in
861          * when all work requests have completed or have been flushed.
862          */
863         qp_attr.qp_state = IB_QPS_ERR;
864         if (ib_modify_qp(priv->qp, &qp_attr, IB_QP_STATE))
865                 ipoib_warn(priv, "Failed to modify QP to ERROR state\n");
866
867         /* Wait for all sends and receives to complete */
868         begin = jiffies;
869
870         while (priv->tx_head != priv->tx_tail || recvs_pending(dev)) {
871                 if (time_after(jiffies, begin + 5 * HZ)) {
872                         ipoib_warn(priv, "timing out; %d sends %d receives not completed\n",
873                                    priv->tx_head - priv->tx_tail, recvs_pending(dev));
874
875                         /*
876                          * assume the HW is wedged and just free up
877                          * all our pending work requests.
878                          */
879                         while ((int) priv->tx_tail - (int) priv->tx_head < 0) {
880                                 tx_req = &priv->tx_ring[priv->tx_tail &
881                                                         (ipoib_sendq_size - 1)];
882                                 ipoib_dma_unmap_tx(priv, tx_req);
883                                 dev_kfree_skb_any(tx_req->skb);
884                                 ++priv->tx_tail;
885                                 --priv->tx_outstanding;
886                         }
887
888                         for (i = 0; i < ipoib_recvq_size; ++i) {
889                                 struct ipoib_rx_buf *rx_req;
890
891                                 rx_req = &priv->rx_ring[i];
892                                 if (!rx_req->skb)
893                                         continue;
894                                 ipoib_ud_dma_unmap_rx(priv,
895                                                       priv->rx_ring[i].mapping);
896                                 dev_kfree_skb_any(rx_req->skb);
897                                 rx_req->skb = NULL;
898                         }
899
900                         goto timeout;
901                 }
902
903                 ipoib_drain_cq(dev);
904
905                 msleep(1);
906         }
907
908         ipoib_dbg(priv, "All sends and receives done.\n");
909
910 timeout:
911         del_timer_sync(&priv->poll_timer);
912         qp_attr.qp_state = IB_QPS_RESET;
913         if (ib_modify_qp(priv->qp, &qp_attr, IB_QP_STATE))
914                 ipoib_warn(priv, "Failed to modify QP to RESET state\n");
915
916         ipoib_flush_ah(dev);
917
918         ib_req_notify_cq(priv->recv_cq, IB_CQ_NEXT_COMP);
919
920         return 0;
921 }
922
923 int ipoib_ib_dev_init(struct net_device *dev, struct ib_device *ca, int port)
924 {
925         struct ipoib_dev_priv *priv = netdev_priv(dev);
926
927         priv->ca = ca;
928         priv->port = port;
929         priv->qp = NULL;
930
931         if (ipoib_transport_dev_init(dev, ca)) {
932                 printk(KERN_WARNING "%s: ipoib_transport_dev_init failed\n", ca->name);
933                 return -ENODEV;
934         }
935
936         setup_timer(&priv->poll_timer, ipoib_ib_tx_timer_func,
937                     (unsigned long) dev);
938
939         if (dev->flags & IFF_UP) {
940                 if (ipoib_ib_dev_open(dev)) {
941                         ipoib_transport_dev_cleanup(dev);
942                         return -ENODEV;
943                 }
944         }
945
946         return 0;
947 }
948
949 /*
950  * Takes whatever value which is in pkey index 0 and updates priv->pkey
951  * returns 0 if the pkey value was changed.
952  */
953 static inline int update_parent_pkey(struct ipoib_dev_priv *priv)
954 {
955         int result;
956         u16 prev_pkey;
957
958         prev_pkey = priv->pkey;
959         result = ib_query_pkey(priv->ca, priv->port, 0, &priv->pkey);
960         if (result) {
961                 ipoib_warn(priv, "ib_query_pkey port %d failed (ret = %d)\n",
962                            priv->port, result);
963                 return result;
964         }
965
966         priv->pkey |= 0x8000;
967
968         if (prev_pkey != priv->pkey) {
969                 ipoib_dbg(priv, "pkey changed from 0x%x to 0x%x\n",
970                           prev_pkey, priv->pkey);
971                 /*
972                  * Update the pkey in the broadcast address, while making sure to set
973                  * the full membership bit, so that we join the right broadcast group.
974                  */
975                 priv->dev->broadcast[8] = priv->pkey >> 8;
976                 priv->dev->broadcast[9] = priv->pkey & 0xff;
977                 return 0;
978         }
979
980         return 1;
981 }
982 /*
983  * returns 0 if pkey value was found in a different slot.
984  */
985 static inline int update_child_pkey(struct ipoib_dev_priv *priv)
986 {
987         u16 old_index = priv->pkey_index;
988
989         priv->pkey_index = 0;
990         ipoib_pkey_dev_check_presence(priv->dev);
991
992         if (test_bit(IPOIB_PKEY_ASSIGNED, &priv->flags) &&
993             (old_index == priv->pkey_index))
994                 return 1;
995         return 0;
996 }
997
998 /*
999  * returns true if the device address of the ipoib interface has changed and the
1000  * new address is a valid one (i.e in the gid table), return false otherwise.
1001  */
1002 static bool ipoib_dev_addr_changed_valid(struct ipoib_dev_priv *priv)
1003 {
1004         union ib_gid search_gid;
1005         union ib_gid gid0;
1006         union ib_gid *netdev_gid;
1007         int err;
1008         u16 index;
1009         u8 port;
1010         bool ret = false;
1011
1012         netdev_gid = (union ib_gid *)(priv->dev->dev_addr + 4);
1013         if (ib_query_gid(priv->ca, priv->port, 0, &gid0, NULL))
1014                 return false;
1015
1016         netif_addr_lock_bh(priv->dev);
1017
1018         /* The subnet prefix may have changed, update it now so we won't have
1019          * to do it later
1020          */
1021         priv->local_gid.global.subnet_prefix = gid0.global.subnet_prefix;
1022         netdev_gid->global.subnet_prefix = gid0.global.subnet_prefix;
1023         search_gid.global.subnet_prefix = gid0.global.subnet_prefix;
1024
1025         search_gid.global.interface_id = priv->local_gid.global.interface_id;
1026
1027         netif_addr_unlock_bh(priv->dev);
1028
1029         err = ib_find_gid(priv->ca, &search_gid, IB_GID_TYPE_IB,
1030                           priv->dev, &port, &index);
1031
1032         netif_addr_lock_bh(priv->dev);
1033
1034         if (search_gid.global.interface_id !=
1035             priv->local_gid.global.interface_id)
1036                 /* There was a change while we were looking up the gid, bail
1037                  * here and let the next work sort this out
1038                  */
1039                 goto out;
1040
1041         /* The next section of code needs some background:
1042          * Per IB spec the port GUID can't change if the HCA is powered on.
1043          * port GUID is the basis for GID at index 0 which is the basis for
1044          * the default device address of a ipoib interface.
1045          *
1046          * so it seems the flow should be:
1047          * if user_changed_dev_addr && gid in gid tbl
1048          *      set bit dev_addr_set
1049          *      return true
1050          * else
1051          *      return false
1052          *
1053          * The issue is that there are devices that don't follow the spec,
1054          * they change the port GUID when the HCA is powered, so in order
1055          * not to break userspace applications, We need to check if the
1056          * user wanted to control the device address and we assume that
1057          * if he sets the device address back to be based on GID index 0,
1058          * he no longer wishs to control it.
1059          *
1060          * If the user doesn't control the the device address,
1061          * IPOIB_FLAG_DEV_ADDR_SET is set and ib_find_gid failed it means
1062          * the port GUID has changed and GID at index 0 has changed
1063          * so we need to change priv->local_gid and priv->dev->dev_addr
1064          * to reflect the new GID.
1065          */
1066         if (!test_bit(IPOIB_FLAG_DEV_ADDR_SET, &priv->flags)) {
1067                 if (!err && port == priv->port) {
1068                         set_bit(IPOIB_FLAG_DEV_ADDR_SET, &priv->flags);
1069                         if (index == 0)
1070                                 clear_bit(IPOIB_FLAG_DEV_ADDR_CTRL,
1071                                           &priv->flags);
1072                         else
1073                                 set_bit(IPOIB_FLAG_DEV_ADDR_CTRL, &priv->flags);
1074                         ret = true;
1075                 } else {
1076                         ret = false;
1077                 }
1078         } else {
1079                 if (!err && port == priv->port) {
1080                         ret = true;
1081                 } else {
1082                         if (!test_bit(IPOIB_FLAG_DEV_ADDR_CTRL, &priv->flags)) {
1083                                 memcpy(&priv->local_gid, &gid0,
1084                                        sizeof(priv->local_gid));
1085                                 memcpy(priv->dev->dev_addr + 4, &gid0,
1086                                        sizeof(priv->local_gid));
1087                                 ret = true;
1088                         }
1089                 }
1090         }
1091
1092 out:
1093         netif_addr_unlock_bh(priv->dev);
1094
1095         return ret;
1096 }
1097
1098 static void __ipoib_ib_dev_flush(struct ipoib_dev_priv *priv,
1099                                 enum ipoib_flush_level level,
1100                                 int nesting)
1101 {
1102         struct ipoib_dev_priv *cpriv;
1103         struct net_device *dev = priv->dev;
1104         int result;
1105
1106         down_read_nested(&priv->vlan_rwsem, nesting);
1107
1108         /*
1109          * Flush any child interfaces too -- they might be up even if
1110          * the parent is down.
1111          */
1112         list_for_each_entry(cpriv, &priv->child_intfs, list)
1113                 __ipoib_ib_dev_flush(cpriv, level, nesting + 1);
1114
1115         up_read(&priv->vlan_rwsem);
1116
1117         if (!test_bit(IPOIB_FLAG_INITIALIZED, &priv->flags) &&
1118             level != IPOIB_FLUSH_HEAVY) {
1119                 /* Make sure the dev_addr is set even if not flushing */
1120                 if (level == IPOIB_FLUSH_LIGHT)
1121                         ipoib_dev_addr_changed_valid(priv);
1122                 ipoib_dbg(priv, "Not flushing - IPOIB_FLAG_INITIALIZED not set.\n");
1123                 return;
1124         }
1125
1126         if (!test_bit(IPOIB_FLAG_ADMIN_UP, &priv->flags)) {
1127                 /* interface is down. update pkey and leave. */
1128                 if (level == IPOIB_FLUSH_HEAVY) {
1129                         if (!test_bit(IPOIB_FLAG_SUBINTERFACE, &priv->flags))
1130                                 update_parent_pkey(priv);
1131                         else
1132                                 update_child_pkey(priv);
1133                 } else if (level == IPOIB_FLUSH_LIGHT)
1134                         ipoib_dev_addr_changed_valid(priv);
1135                 ipoib_dbg(priv, "Not flushing - IPOIB_FLAG_ADMIN_UP not set.\n");
1136                 return;
1137         }
1138
1139         if (level == IPOIB_FLUSH_HEAVY) {
1140                 /* child devices chase their origin pkey value, while non-child
1141                  * (parent) devices should always takes what present in pkey index 0
1142                  */
1143                 if (test_bit(IPOIB_FLAG_SUBINTERFACE, &priv->flags)) {
1144                         result = update_child_pkey(priv);
1145                         if (result) {
1146                                 /* restart QP only if P_Key index is changed */
1147                                 ipoib_dbg(priv, "Not flushing - P_Key index not changed.\n");
1148                                 return;
1149                         }
1150
1151                 } else {
1152                         result = update_parent_pkey(priv);
1153                         /* restart QP only if P_Key value changed */
1154                         if (result) {
1155                                 ipoib_dbg(priv, "Not flushing - P_Key value not changed.\n");
1156                                 return;
1157                         }
1158                 }
1159         }
1160
1161         if (level == IPOIB_FLUSH_LIGHT) {
1162                 int oper_up;
1163                 ipoib_mark_paths_invalid(dev);
1164                 /* Set IPoIB operation as down to prevent races between:
1165                  * the flush flow which leaves MCG and on the fly joins
1166                  * which can happen during that time. mcast restart task
1167                  * should deal with join requests we missed.
1168                  */
1169                 oper_up = test_and_clear_bit(IPOIB_FLAG_OPER_UP, &priv->flags);
1170                 ipoib_mcast_dev_flush(dev);
1171                 if (oper_up)
1172                         set_bit(IPOIB_FLAG_OPER_UP, &priv->flags);
1173                 ipoib_flush_ah(dev);
1174         }
1175
1176         if (level >= IPOIB_FLUSH_NORMAL)
1177                 ipoib_ib_dev_down(dev);
1178
1179         if (level == IPOIB_FLUSH_HEAVY) {
1180                 if (test_bit(IPOIB_FLAG_INITIALIZED, &priv->flags))
1181                         ipoib_ib_dev_stop(dev);
1182                 if (ipoib_ib_dev_open(dev) != 0)
1183                         return;
1184                 if (netif_queue_stopped(dev))
1185                         netif_start_queue(dev);
1186         }
1187
1188         /*
1189          * The device could have been brought down between the start and when
1190          * we get here, don't bring it back up if it's not configured up
1191          */
1192         if (test_bit(IPOIB_FLAG_ADMIN_UP, &priv->flags)) {
1193                 if (level >= IPOIB_FLUSH_NORMAL)
1194                         ipoib_ib_dev_up(dev);
1195                 if (ipoib_dev_addr_changed_valid(priv))
1196                         ipoib_mcast_restart_task(&priv->restart_task);
1197         }
1198 }
1199
1200 void ipoib_ib_dev_flush_light(struct work_struct *work)
1201 {
1202         struct ipoib_dev_priv *priv =
1203                 container_of(work, struct ipoib_dev_priv, flush_light);
1204
1205         __ipoib_ib_dev_flush(priv, IPOIB_FLUSH_LIGHT, 0);
1206 }
1207
1208 void ipoib_ib_dev_flush_normal(struct work_struct *work)
1209 {
1210         struct ipoib_dev_priv *priv =
1211                 container_of(work, struct ipoib_dev_priv, flush_normal);
1212
1213         __ipoib_ib_dev_flush(priv, IPOIB_FLUSH_NORMAL, 0);
1214 }
1215
1216 void ipoib_ib_dev_flush_heavy(struct work_struct *work)
1217 {
1218         struct ipoib_dev_priv *priv =
1219                 container_of(work, struct ipoib_dev_priv, flush_heavy);
1220
1221         __ipoib_ib_dev_flush(priv, IPOIB_FLUSH_HEAVY, 0);
1222 }
1223
1224 void ipoib_ib_dev_cleanup(struct net_device *dev)
1225 {
1226         struct ipoib_dev_priv *priv = netdev_priv(dev);
1227
1228         ipoib_dbg(priv, "cleaning up ib_dev\n");
1229         /*
1230          * We must make sure there are no more (path) completions
1231          * that may wish to touch priv fields that are no longer valid
1232          */
1233         ipoib_flush_paths(dev);
1234
1235         ipoib_mcast_stop_thread(dev);
1236         ipoib_mcast_dev_flush(dev);
1237
1238         /*
1239          * All of our ah references aren't free until after
1240          * ipoib_mcast_dev_flush(), ipoib_flush_paths, and
1241          * the neighbor garbage collection is stopped and reaped.
1242          * That should all be done now, so make a final ah flush.
1243          */
1244         ipoib_stop_ah(dev);
1245
1246         ipoib_transport_dev_cleanup(dev);
1247 }
1248
1249