1fe2caefcSParav Pandit /******************************************************************* 2fe2caefcSParav Pandit * This file is part of the Emulex RoCE Device Driver for * 3fe2caefcSParav Pandit * RoCE (RDMA over Converged Ethernet) adapters. * 4fe2caefcSParav Pandit * Copyright (C) 2008-2012 Emulex. All rights reserved. * 5fe2caefcSParav Pandit * EMULEX and SLI are trademarks of Emulex. * 6fe2caefcSParav Pandit * www.emulex.com * 7fe2caefcSParav Pandit * * 8fe2caefcSParav Pandit * This program is free software; you can redistribute it and/or * 9fe2caefcSParav Pandit * modify it under the terms of version 2 of the GNU General * 10fe2caefcSParav Pandit * Public License as published by the Free Software Foundation. * 11fe2caefcSParav Pandit * This program is distributed in the hope that it will be useful. * 12fe2caefcSParav Pandit * ALL EXPRESS OR IMPLIED CONDITIONS, REPRESENTATIONS AND * 13fe2caefcSParav Pandit * WARRANTIES, INCLUDING ANY IMPLIED WARRANTY OF MERCHANTABILITY, * 14fe2caefcSParav Pandit * FITNESS FOR A PARTICULAR PURPOSE, OR NON-INFRINGEMENT, ARE * 15fe2caefcSParav Pandit * DISCLAIMED, EXCEPT TO THE EXTENT THAT SUCH DISCLAIMERS ARE HELD * 16fe2caefcSParav Pandit * TO BE LEGALLY INVALID. See the GNU General Public License for * 17fe2caefcSParav Pandit * more details, a copy of which can be found in the file COPYING * 18fe2caefcSParav Pandit * included with this package. * 19fe2caefcSParav Pandit * 20fe2caefcSParav Pandit * Contact Information: 21fe2caefcSParav Pandit * linux-drivers@emulex.com 22fe2caefcSParav Pandit * 23fe2caefcSParav Pandit * Emulex 24fe2caefcSParav Pandit * 3333 Susan Street 25fe2caefcSParav Pandit * Costa Mesa, CA 92626 26fe2caefcSParav Pandit *******************************************************************/ 27fe2caefcSParav Pandit 28fe2caefcSParav Pandit #include <net/neighbour.h> 29fe2caefcSParav Pandit #include <net/netevent.h> 30fe2caefcSParav Pandit 31fe2caefcSParav Pandit #include <rdma/ib_addr.h> 32fe2caefcSParav Pandit 33fe2caefcSParav Pandit #include "ocrdma.h" 34fe2caefcSParav Pandit #include "ocrdma_verbs.h" 35fe2caefcSParav Pandit #include "ocrdma_ah.h" 36fe2caefcSParav Pandit #include "ocrdma_hw.h" 37fe2caefcSParav Pandit 380ea87262SDevesh Sharma #define OCRDMA_VID_PCP_SHIFT 0xD 390ea87262SDevesh Sharma 401afc0454SNaresh Gottumukkala static inline int set_av_attr(struct ocrdma_dev *dev, struct ocrdma_ah *ah, 411be528bcSdevesh.sharma@emulex.com struct ib_ah_attr *attr, union ib_gid *sgid, int pdid) 42fe2caefcSParav Pandit { 43fe2caefcSParav Pandit int status = 0; 44fe2caefcSParav Pandit u16 vlan_tag; bool vlan_enabled = false; 45fe2caefcSParav Pandit struct ocrdma_eth_vlan eth; 46fe2caefcSParav Pandit struct ocrdma_grh grh; 47fe2caefcSParav Pandit int eth_sz; 48fe2caefcSParav Pandit 49fe2caefcSParav Pandit memset(ð, 0, sizeof(eth)); 50fe2caefcSParav Pandit memset(&grh, 0, sizeof(grh)); 51fe2caefcSParav Pandit 521be528bcSdevesh.sharma@emulex.com /* VLAN */ 5340aca6ffSMoni Shoua vlan_tag = attr->vlan_id; 5484b105dbSNaresh Gottumukkala if (!vlan_tag || (vlan_tag > 0xFFF)) 5584b105dbSNaresh Gottumukkala vlan_tag = dev->pvid; 56fe2caefcSParav Pandit if (vlan_tag && (vlan_tag < 0x1000)) { 57fe2caefcSParav Pandit eth.eth_type = cpu_to_be16(0x8100); 58fe2caefcSParav Pandit eth.roce_eth_type = cpu_to_be16(OCRDMA_ROCE_ETH_TYPE); 590ea87262SDevesh Sharma vlan_tag |= (dev->sl & 0x07) << OCRDMA_VID_PCP_SHIFT; 60fe2caefcSParav Pandit eth.vlan_tag = cpu_to_be16(vlan_tag); 61fe2caefcSParav Pandit eth_sz = sizeof(struct ocrdma_eth_vlan); 62fe2caefcSParav Pandit vlan_enabled = true; 63fe2caefcSParav Pandit } else { 64fe2caefcSParav Pandit eth.eth_type = cpu_to_be16(OCRDMA_ROCE_ETH_TYPE); 65fe2caefcSParav Pandit eth_sz = sizeof(struct ocrdma_eth_basic); 66fe2caefcSParav Pandit } 671be528bcSdevesh.sharma@emulex.com /* MAC */ 68fe2caefcSParav Pandit memcpy(ð.smac[0], &dev->nic_info.mac_addr[0], ETH_ALEN); 6940aca6ffSMoni Shoua status = ocrdma_resolve_dmac(dev, attr, ð.dmac[0]); 70fe2caefcSParav Pandit if (status) 71fe2caefcSParav Pandit return status; 721be528bcSdevesh.sharma@emulex.com ah->sgid_index = attr->grh.sgid_index; 731be528bcSdevesh.sharma@emulex.com memcpy(&grh.sgid[0], sgid->raw, sizeof(union ib_gid)); 741be528bcSdevesh.sharma@emulex.com memcpy(&grh.dgid[0], attr->grh.dgid.raw, sizeof(attr->grh.dgid.raw)); 75fe2caefcSParav Pandit 76fe2caefcSParav Pandit grh.tclass_flow = cpu_to_be32((6 << 28) | 77fe2caefcSParav Pandit (attr->grh.traffic_class << 24) | 78fe2caefcSParav Pandit attr->grh.flow_label); 79fe2caefcSParav Pandit /* 0x1b is next header value in GRH */ 80fe2caefcSParav Pandit grh.pdid_hoplimit = cpu_to_be32((pdid << 16) | 81fe2caefcSParav Pandit (0x1b << 8) | attr->grh.hop_limit); 821be528bcSdevesh.sharma@emulex.com /* Eth HDR */ 83fe2caefcSParav Pandit memcpy(&ah->av->eth_hdr, ð, eth_sz); 84fe2caefcSParav Pandit memcpy((u8 *)ah->av + eth_sz, &grh, sizeof(struct ocrdma_grh)); 85fe2caefcSParav Pandit if (vlan_enabled) 86fe2caefcSParav Pandit ah->av->valid |= OCRDMA_AV_VLAN_VALID; 87fe5e8a1aSDevesh Sharma ah->av->valid = cpu_to_le32(ah->av->valid); 88fe2caefcSParav Pandit return status; 89fe2caefcSParav Pandit } 90fe2caefcSParav Pandit 91fe2caefcSParav Pandit struct ib_ah *ocrdma_create_ah(struct ib_pd *ibpd, struct ib_ah_attr *attr) 92fe2caefcSParav Pandit { 93fe2caefcSParav Pandit u32 *ahid_addr; 94fe2caefcSParav Pandit int status; 95fe2caefcSParav Pandit struct ocrdma_ah *ah; 96fe2caefcSParav Pandit struct ocrdma_pd *pd = get_ocrdma_pd(ibpd); 97f99b1649SNaresh Gottumukkala struct ocrdma_dev *dev = get_ocrdma_dev(ibpd->device); 981be528bcSdevesh.sharma@emulex.com union ib_gid sgid; 991be528bcSdevesh.sharma@emulex.com u8 zmac[ETH_ALEN]; 100fe2caefcSParav Pandit 101fe2caefcSParav Pandit if (!(attr->ah_flags & IB_AH_GRH)) 102fe2caefcSParav Pandit return ERR_PTR(-EINVAL); 103fe2caefcSParav Pandit 10431dbdd9aSSelvin Xavier if (atomic_cmpxchg(&dev->update_sl, 1, 0)) 10531dbdd9aSSelvin Xavier ocrdma_init_service_level(dev); 106fad51b7dSDevesh Sharma ah = kzalloc(sizeof(*ah), GFP_ATOMIC); 107fe2caefcSParav Pandit if (!ah) 108fe2caefcSParav Pandit return ERR_PTR(-ENOMEM); 109fe2caefcSParav Pandit 110fe2caefcSParav Pandit status = ocrdma_alloc_av(dev, ah); 111fe2caefcSParav Pandit if (status) 112fe2caefcSParav Pandit goto av_err; 1131be528bcSdevesh.sharma@emulex.com 1141be528bcSdevesh.sharma@emulex.com status = ocrdma_query_gid(&dev->ibdev, 1, attr->grh.sgid_index, &sgid); 1151be528bcSdevesh.sharma@emulex.com if (status) { 1161be528bcSdevesh.sharma@emulex.com pr_err("%s(): Failed to query sgid, status = %d\n", 1171be528bcSdevesh.sharma@emulex.com __func__, status); 1181be528bcSdevesh.sharma@emulex.com goto av_conf_err; 1191be528bcSdevesh.sharma@emulex.com } 1201be528bcSdevesh.sharma@emulex.com 1211be528bcSdevesh.sharma@emulex.com memset(&zmac, 0, ETH_ALEN); 1221be528bcSdevesh.sharma@emulex.com if (pd->uctx && 1231be528bcSdevesh.sharma@emulex.com memcmp(attr->dmac, &zmac, ETH_ALEN)) { 1241be528bcSdevesh.sharma@emulex.com status = rdma_addr_find_dmac_by_grh(&sgid, &attr->grh.dgid, 1251be528bcSdevesh.sharma@emulex.com attr->dmac, &attr->vlan_id); 1261be528bcSdevesh.sharma@emulex.com if (status) { 1271be528bcSdevesh.sharma@emulex.com pr_err("%s(): Failed to resolve dmac from gid." 1281be528bcSdevesh.sharma@emulex.com "status = %d\n", __func__, status); 1291be528bcSdevesh.sharma@emulex.com goto av_conf_err; 1301be528bcSdevesh.sharma@emulex.com } 1311be528bcSdevesh.sharma@emulex.com } 1321be528bcSdevesh.sharma@emulex.com 1331be528bcSdevesh.sharma@emulex.com status = set_av_attr(dev, ah, attr, &sgid, pd->id); 134fe2caefcSParav Pandit if (status) 135fe2caefcSParav Pandit goto av_conf_err; 136fe2caefcSParav Pandit 137fe2caefcSParav Pandit /* if pd is for the user process, pass the ah_id to user space */ 138fe2caefcSParav Pandit if ((pd->uctx) && (pd->uctx->ah_tbl.va)) { 139fe2caefcSParav Pandit ahid_addr = pd->uctx->ah_tbl.va + attr->dlid; 140fe2caefcSParav Pandit *ahid_addr = ah->id; 141fe2caefcSParav Pandit } 142fe2caefcSParav Pandit return &ah->ibah; 143fe2caefcSParav Pandit 144fe2caefcSParav Pandit av_conf_err: 145fe2caefcSParav Pandit ocrdma_free_av(dev, ah); 146fe2caefcSParav Pandit av_err: 147fe2caefcSParav Pandit kfree(ah); 148fe2caefcSParav Pandit return ERR_PTR(status); 149fe2caefcSParav Pandit } 150fe2caefcSParav Pandit 151fe2caefcSParav Pandit int ocrdma_destroy_ah(struct ib_ah *ibah) 152fe2caefcSParav Pandit { 153fe2caefcSParav Pandit struct ocrdma_ah *ah = get_ocrdma_ah(ibah); 1541afc0454SNaresh Gottumukkala struct ocrdma_dev *dev = get_ocrdma_dev(ibah->device); 1551afc0454SNaresh Gottumukkala 1561afc0454SNaresh Gottumukkala ocrdma_free_av(dev, ah); 157fe2caefcSParav Pandit kfree(ah); 158fe2caefcSParav Pandit return 0; 159fe2caefcSParav Pandit } 160fe2caefcSParav Pandit 161fe2caefcSParav Pandit int ocrdma_query_ah(struct ib_ah *ibah, struct ib_ah_attr *attr) 162fe2caefcSParav Pandit { 163fe2caefcSParav Pandit struct ocrdma_ah *ah = get_ocrdma_ah(ibah); 164fe2caefcSParav Pandit struct ocrdma_av *av = ah->av; 165fe2caefcSParav Pandit struct ocrdma_grh *grh; 166fe2caefcSParav Pandit attr->ah_flags |= IB_AH_GRH; 167f0c2c225Sdevesh.sharma@emulex.com if (ah->av->valid & OCRDMA_AV_VALID) { 168fe2caefcSParav Pandit grh = (struct ocrdma_grh *)((u8 *)ah->av + 169fe2caefcSParav Pandit sizeof(struct ocrdma_eth_vlan)); 170fe2caefcSParav Pandit attr->sl = be16_to_cpu(av->eth_hdr.vlan_tag) >> 13; 171fe2caefcSParav Pandit } else { 172fe2caefcSParav Pandit grh = (struct ocrdma_grh *)((u8 *)ah->av + 173fe2caefcSParav Pandit sizeof(struct ocrdma_eth_basic)); 174fe2caefcSParav Pandit attr->sl = 0; 175fe2caefcSParav Pandit } 176fe2caefcSParav Pandit memcpy(&attr->grh.dgid.raw[0], &grh->dgid[0], sizeof(grh->dgid)); 177fe2caefcSParav Pandit attr->grh.sgid_index = ah->sgid_index; 178fe2caefcSParav Pandit attr->grh.hop_limit = be32_to_cpu(grh->pdid_hoplimit) & 0xff; 179fe2caefcSParav Pandit attr->grh.traffic_class = be32_to_cpu(grh->tclass_flow) >> 24; 180fe2caefcSParav Pandit attr->grh.flow_label = be32_to_cpu(grh->tclass_flow) & 0x00ffffffff; 181fe2caefcSParav Pandit return 0; 182fe2caefcSParav Pandit } 183fe2caefcSParav Pandit 184fe2caefcSParav Pandit int ocrdma_modify_ah(struct ib_ah *ibah, struct ib_ah_attr *attr) 185fe2caefcSParav Pandit { 186fe2caefcSParav Pandit /* modify_ah is unsupported */ 187fe2caefcSParav Pandit return -ENOSYS; 188fe2caefcSParav Pandit } 189fe2caefcSParav Pandit 190fe2caefcSParav Pandit int ocrdma_process_mad(struct ib_device *ibdev, 191fe2caefcSParav Pandit int process_mad_flags, 192fe2caefcSParav Pandit u8 port_num, 193fe2caefcSParav Pandit struct ib_wc *in_wc, 194fe2caefcSParav Pandit struct ib_grh *in_grh, 195fe2caefcSParav Pandit struct ib_mad *in_mad, struct ib_mad *out_mad) 196fe2caefcSParav Pandit { 197fe2caefcSParav Pandit return IB_MAD_RESULT_SUCCESS; 198fe2caefcSParav Pandit } 199