I reworked this to clean a few things up and match the style of
mthca_cmd.c a little better.  Does this still seem OK?

(I got rid of the BUG_ON because I think the test

        BUG_ON((!ignore_bkey && !ignore_mkey) && !in_wc);

is not really correct -- eg passing a MAD known not to be BM-class
with only ignore_mkey set and no in_wc would be fine -- and I
couldn't decide on a check that did seem worth oopsing for)

Thanks,
  Roland

Index: hw/mthca/mthca_provider.c
===================================================================
--- hw/mthca/mthca_provider.c   (revision 1537)
+++ hw/mthca/mthca_provider.c   (working copy)
@@ -59,8 +59,8 @@
        in_mad->method             = IB_MGMT_METHOD_GET;
        in_mad->attr_id            = IB_SMP_ATTR_NODE_INFO;
 
-       err = mthca_MAD_IFC(to_mdev(ibdev), 1,
-                           1, in_mad, out_mad,
+       err = mthca_MAD_IFC(to_mdev(ibdev), 1, 1,
+                           1, NULL, NULL, in_mad, out_mad,
                            &status);
        if (err)
                goto out;
@@ -104,8 +104,8 @@
        in_mad->attr_id            = IB_SMP_ATTR_PORT_INFO;
        in_mad->attr_mod           = cpu_to_be32(port);
 
-       err = mthca_MAD_IFC(to_mdev(ibdev), 1,
-                           port, in_mad, out_mad,
+       err = mthca_MAD_IFC(to_mdev(ibdev), 1, 1,
+                           port, NULL, NULL, in_mad, out_mad,
                            &status);
        if (err)
                goto out;
@@ -189,8 +189,8 @@
        in_mad->attr_id            = IB_SMP_ATTR_PKEY_TABLE;
        in_mad->attr_mod           = cpu_to_be32(index / 32);
 
-       err = mthca_MAD_IFC(to_mdev(ibdev), 1,
-                           port, in_mad, out_mad,
+       err = mthca_MAD_IFC(to_mdev(ibdev), 1, 1,
+                           port, NULL, NULL, in_mad, out_mad,
                            &status);
        if (err)
                goto out;
@@ -228,8 +228,8 @@
        in_mad->attr_id            = IB_SMP_ATTR_PORT_INFO;
        in_mad->attr_mod           = cpu_to_be32(port);
 
-       err = mthca_MAD_IFC(to_mdev(ibdev), 1,
-                           port, in_mad, out_mad,
+       err = mthca_MAD_IFC(to_mdev(ibdev), 1, 1,
+                           port, NULL, NULL, in_mad, out_mad,
                            &status);
        if (err)
                goto out;
@@ -248,8 +248,8 @@
        in_mad->attr_id            = IB_SMP_ATTR_GUID_INFO;
        in_mad->attr_mod           = cpu_to_be32(index / 8);
 
-       err = mthca_MAD_IFC(to_mdev(ibdev), 1,
-                           port, in_mad, out_mad,
+       err = mthca_MAD_IFC(to_mdev(ibdev), 1, 1,
+                           port, NULL, NULL, in_mad, out_mad,
                            &status);
        if (err)
                goto out;
Index: hw/mthca/mthca_mad.c
===================================================================
--- hw/mthca/mthca_mad.c        (revision 1537)
+++ hw/mthca/mthca_mad.c        (working copy)
@@ -231,9 +231,16 @@
        } else
                return IB_MAD_RESULT_SUCCESS;
 
+       /*
+        * Key check traps can't be generated unless we have in_wc.
+        */
+       if (!in_wc)
+               mad_flags = IB_MAD_IGNORE_ALL;
+
        err = mthca_MAD_IFC(to_mdev(ibdev),
-                           !!(mad_flags & IB_MAD_IGNORE_MKEY),
-                           port_num, in_mad, out_mad,
+                           mad_flags & IB_MAD_IGNORE_MKEY,
+                           mad_flags & IB_MAD_IGNORE_BKEY,
+                           port_num, in_wc, in_grh, in_mad, out_mad,
                            &status);
        if (err) {
                mthca_err(to_mdev(ibdev), "MAD_IFC failed\n");
Index: hw/mthca/mthca_cmd.c
===================================================================
--- hw/mthca/mthca_cmd.c        (revision 1537)
+++ hw/mthca/mthca_cmd.c        (working copy)
@@ -36,6 +36,7 @@
 #include <linux/pci.h>
 #include <linux/errno.h>
 #include <asm/io.h>
+#include <ib_mad.h>
 
 #include "mthca_dev.h"
 #include "mthca_config_reg.h"
@@ -1626,25 +1627,70 @@
                         CMD_TIME_CLASS_B, status);
 }
 
-int mthca_MAD_IFC(struct mthca_dev *dev, int ignore_mkey, int port,
-                 void *in_mad, void *response_mad, u8 *status) {
+int mthca_MAD_IFC(struct mthca_dev *dev, int ignore_mkey, int ignore_bkey,
+                 int port, struct ib_wc* in_wc, struct ib_grh* in_grh,
+                 void *in_mad, void *response_mad, u8 *status)
+{
        void *box;
        dma_addr_t dma;
        int err;
+       u32 in_modifier = port;
+       u8 op_modifier = 0;
 
-#define MAD_IFC_BOX_SIZE 512
+#define MAD_IFC_BOX_SIZE      0x400
+#define MAD_IFC_MY_QPN_OFFSET 0x100
+#define MAD_IFC_RQPN_OFFSET   0x104
+#define MAD_IFC_SL_OFFSET     0x108
+#define MAD_IFC_G_PATH_OFFSET 0x109
+#define MAD_IFC_RLID_OFFSET   0x10a
+#define MAD_IFC_PKEY_OFFSET   0x10e
+#define MAD_IFC_GRH_OFFSET    0x140
 
+       BUG_ON((!ignore_bkey && !ignore_mkey) && !in_wc);
+
        box = pci_alloc_consistent(dev->pdev, MAD_IFC_BOX_SIZE, &dma);
        if (!box)
                return -ENOMEM;
 
        memcpy(box, in_mad, 256);
 
-       err = mthca_cmd_box(dev, dma, dma + 256, port, !!ignore_mkey,
+       if (ignore_mkey)
+               op_modifier |= 0x1;
+
+       if (ignore_bkey)
+               op_modifier |= 0x2;
+
+       if (in_wc) {
+               u8 val;
+
+               memset(box + 256, 0, 256);
+
+               MTHCA_PUT(box, in_wc->qp_num,     MAD_IFC_MY_QPN_OFFSET);
+               MTHCA_PUT(box, in_wc->src_qp,     MAD_IFC_RQPN_OFFSET);
+
+               val = in_wc->sl << 4;
+               MTHCA_PUT(box, val,               MAD_IFC_SL_OFFSET);
+
+               val = in_wc->dlid_path_bits |
+                       (in_wc->wc_flags & IB_WC_GRH ? 0x80 : 0);
+               MTHCA_PUT(box, val,               MAD_IFC_GRH_OFFSET);
+
+               MTHCA_PUT(box, in_wc->slid,       MAD_IFC_RLID_OFFSET);
+               MTHCA_PUT(box, in_wc->pkey_index, MAD_IFC_PKEY_OFFSET);
+
+               if (in_grh)
+                       memcpy((u8 *) box + MAD_IFC_GRH_OFFSET, in_grh, 40);
+
+               op_modifier |= 0x10;
+
+               in_modifier |= in_wc->slid << 16;
+       }
+
+       err = mthca_cmd_box(dev, dma, dma + 512, in_modifier, op_modifier,
                            CMD_MAD_IFC, CMD_TIME_CLASS_C, status);
 
        if (!err && !*status)
-               memcpy(response_mad, box + 256, 256);
+               memcpy(response_mad, box + 512, 256);
 
        pci_free_consistent(dev->pdev, MAD_IFC_BOX_SIZE, box, dma);
        return err;
Index: hw/mthca/mthca_cmd.h
===================================================================
--- hw/mthca/mthca_cmd.h        (revision 1537)
+++ hw/mthca/mthca_cmd.h        (working copy)
@@ -280,7 +280,8 @@
                   void *qp_context, u8 *status);
 int mthca_CONF_SPECIAL_QP(struct mthca_dev *dev, int type, u32 qpn,
                          u8 *status);
-int mthca_MAD_IFC(struct mthca_dev *dev, int ignore_mkey, int port,
+int mthca_MAD_IFC(struct mthca_dev *dev, int ignore_mkey, int ignore_bkey,
+                 int port, struct ib_wc* in_wc, struct ib_grh* in_grh,
                  void *in_mad, void *response_mad, u8 *status);
 int mthca_READ_MGM(struct mthca_dev *dev, int index, void *mgm,
                   u8 *status);
_______________________________________________
openib-general mailing list
[email protected]
http://openib.org/mailman/listinfo/openib-general

To unsubscribe, please visit http://openib.org/mailman/listinfo/openib-general

Reply via email to