1/* 2 * Copyright (c) 2004 Topspin Communications. All rights reserved. 3 * Copyright (c) 2005 Sun Microsystems, Inc. All rights reserved. 4 * 5 * This software is available to you under a choice of one of two 6 * licenses. You may choose to be licensed under the terms of the GNU 7 * General Public License (GPL) Version 2, available from the file 8 * COPYING in the main directory of this source tree, or the 9 * OpenIB.org BSD license below: 10 * 11 * Redistribution and use in source and binary forms, with or 12 * without modification, are permitted provided that the following 13 * conditions are met: 14 * 15 * - Redistributions of source code must retain the above 16 * copyright notice, this list of conditions and the following 17 * disclaimer. 18 * 19 * - Redistributions in binary form must reproduce the above 20 * copyright notice, this list of conditions and the following 21 * disclaimer in the documentation and/or other materials 22 * provided with the distribution. 23 * 24 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, 25 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF 26 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND 27 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS 28 * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN 29 * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN 30 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE 31 * SOFTWARE. 32 * 33 * $Id: mthca_av.c,v 1.1.1.1 2007/08/03 18:52:32 Exp $ 34 */ 35 36#include <linux/string.h> 37#include <linux/slab.h> 38 39#include <rdma/ib_verbs.h> 40#include <rdma/ib_cache.h> 41 42#include "mthca_dev.h" 43 44enum { 45 MTHCA_RATE_TAVOR_FULL = 0, 46 MTHCA_RATE_TAVOR_1X = 1, 47 MTHCA_RATE_TAVOR_4X = 2, 48 MTHCA_RATE_TAVOR_1X_DDR = 3 49}; 50 51enum { 52 MTHCA_RATE_MEMFREE_FULL = 0, 53 MTHCA_RATE_MEMFREE_QUARTER = 1, 54 MTHCA_RATE_MEMFREE_EIGHTH = 2, 55 MTHCA_RATE_MEMFREE_HALF = 3 56}; 57 58struct mthca_av { 59 __be32 port_pd; 60 u8 reserved1; 61 u8 g_slid; 62 __be16 dlid; 63 u8 reserved2; 64 u8 gid_index; 65 u8 msg_sr; 66 u8 hop_limit; 67 __be32 sl_tclass_flowlabel; 68 __be32 dgid[4]; 69}; 70 71static enum ib_rate memfree_rate_to_ib(u8 mthca_rate, u8 port_rate) 72{ 73 switch (mthca_rate) { 74 case MTHCA_RATE_MEMFREE_EIGHTH: 75 return mult_to_ib_rate(port_rate >> 3); 76 case MTHCA_RATE_MEMFREE_QUARTER: 77 return mult_to_ib_rate(port_rate >> 2); 78 case MTHCA_RATE_MEMFREE_HALF: 79 return mult_to_ib_rate(port_rate >> 1); 80 case MTHCA_RATE_MEMFREE_FULL: 81 default: 82 return mult_to_ib_rate(port_rate); 83 } 84} 85 86static enum ib_rate tavor_rate_to_ib(u8 mthca_rate, u8 port_rate) 87{ 88 switch (mthca_rate) { 89 case MTHCA_RATE_TAVOR_1X: return IB_RATE_2_5_GBPS; 90 case MTHCA_RATE_TAVOR_1X_DDR: return IB_RATE_5_GBPS; 91 case MTHCA_RATE_TAVOR_4X: return IB_RATE_10_GBPS; 92 default: return mult_to_ib_rate(port_rate); 93 } 94} 95 96enum ib_rate mthca_rate_to_ib(struct mthca_dev *dev, u8 mthca_rate, u8 port) 97{ 98 if (mthca_is_memfree(dev)) { 99 /* Handle old Arbel FW */ 100 if (dev->limits.stat_rate_support == 0x3 && mthca_rate) 101 return IB_RATE_2_5_GBPS; 102 103 return memfree_rate_to_ib(mthca_rate, dev->rate[port - 1]); 104 } else 105 return tavor_rate_to_ib(mthca_rate, dev->rate[port - 1]); 106} 107 108static u8 ib_rate_to_memfree(u8 req_rate, u8 cur_rate) 109{ 110 if (cur_rate <= req_rate) 111 return 0; 112 113 /* 114 * Inter-packet delay (IPD) to get from rate X down to a rate 115 * no more than Y is (X - 1) / Y. 116 */ 117 switch ((cur_rate - 1) / req_rate) { 118 case 0: return MTHCA_RATE_MEMFREE_FULL; 119 case 1: return MTHCA_RATE_MEMFREE_HALF; 120 case 2: /* fall through */ 121 case 3: return MTHCA_RATE_MEMFREE_QUARTER; 122 default: return MTHCA_RATE_MEMFREE_EIGHTH; 123 } 124} 125 126static u8 ib_rate_to_tavor(u8 static_rate) 127{ 128 switch (static_rate) { 129 case IB_RATE_2_5_GBPS: return MTHCA_RATE_TAVOR_1X; 130 case IB_RATE_5_GBPS: return MTHCA_RATE_TAVOR_1X_DDR; 131 case IB_RATE_10_GBPS: return MTHCA_RATE_TAVOR_4X; 132 default: return MTHCA_RATE_TAVOR_FULL; 133 } 134} 135 136u8 mthca_get_rate(struct mthca_dev *dev, int static_rate, u8 port) 137{ 138 u8 rate; 139 140 if (!static_rate || ib_rate_to_mult(static_rate) >= dev->rate[port - 1]) 141 return 0; 142 143 if (mthca_is_memfree(dev)) 144 rate = ib_rate_to_memfree(ib_rate_to_mult(static_rate), 145 dev->rate[port - 1]); 146 else 147 rate = ib_rate_to_tavor(static_rate); 148 149 if (!(dev->limits.stat_rate_support & (1 << rate))) 150 rate = 1; 151 152 return rate; 153} 154 155int mthca_create_ah(struct mthca_dev *dev, 156 struct mthca_pd *pd, 157 struct ib_ah_attr *ah_attr, 158 struct mthca_ah *ah) 159{ 160 u32 index = -1; 161 struct mthca_av *av = NULL; 162 163 ah->type = MTHCA_AH_PCI_POOL; 164 165 if (mthca_is_memfree(dev)) { 166 ah->av = kmalloc(sizeof *ah->av, GFP_ATOMIC); 167 if (!ah->av) 168 return -ENOMEM; 169 170 ah->type = MTHCA_AH_KMALLOC; 171 av = ah->av; 172 } else if (!atomic_read(&pd->sqp_count) && 173 !(dev->mthca_flags & MTHCA_FLAG_DDR_HIDDEN)) { 174 index = mthca_alloc(&dev->av_table.alloc); 175 176 /* fall back to allocate in host memory */ 177 if (index == -1) 178 goto on_hca_fail; 179 180 av = kmalloc(sizeof *av, GFP_ATOMIC); 181 if (!av) 182 goto on_hca_fail; 183 184 ah->type = MTHCA_AH_ON_HCA; 185 ah->avdma = dev->av_table.ddr_av_base + 186 index * MTHCA_AV_SIZE; 187 } 188 189on_hca_fail: 190 if (ah->type == MTHCA_AH_PCI_POOL) { 191 ah->av = pci_pool_alloc(dev->av_table.pool, 192 GFP_ATOMIC, &ah->avdma); 193 if (!ah->av) 194 return -ENOMEM; 195 196 av = ah->av; 197 } 198 199 ah->key = pd->ntmr.ibmr.lkey; 200 201 memset(av, 0, MTHCA_AV_SIZE); 202 203 av->port_pd = cpu_to_be32(pd->pd_num | (ah_attr->port_num << 24)); 204 av->g_slid = ah_attr->src_path_bits; 205 av->dlid = cpu_to_be16(ah_attr->dlid); 206 av->msg_sr = (3 << 4) | /* 2K message */ 207 mthca_get_rate(dev, ah_attr->static_rate, ah_attr->port_num); 208 av->sl_tclass_flowlabel = cpu_to_be32(ah_attr->sl << 28); 209 if (ah_attr->ah_flags & IB_AH_GRH) { 210 av->g_slid |= 0x80; 211 av->gid_index = (ah_attr->port_num - 1) * dev->limits.gid_table_len + 212 ah_attr->grh.sgid_index; 213 av->hop_limit = ah_attr->grh.hop_limit; 214 av->sl_tclass_flowlabel |= 215 cpu_to_be32((ah_attr->grh.traffic_class << 20) | 216 ah_attr->grh.flow_label); 217 memcpy(av->dgid, ah_attr->grh.dgid.raw, 16); 218 } else { 219 av->dgid[3] = cpu_to_be32(2); 220 } 221 222 if (0) { 223 int j; 224 225 mthca_dbg(dev, "Created UDAV at %p/%08lx:\n", 226 av, (unsigned long) ah->avdma); 227 for (j = 0; j < 8; ++j) 228 printk(KERN_DEBUG " [%2x] %08x\n", 229 j * 4, be32_to_cpu(((__be32 *) av)[j])); 230 } 231 232 if (ah->type == MTHCA_AH_ON_HCA) { 233 memcpy_toio(dev->av_table.av_map + index * MTHCA_AV_SIZE, 234 av, MTHCA_AV_SIZE); 235 kfree(av); 236 } 237 238 return 0; 239} 240 241int mthca_destroy_ah(struct mthca_dev *dev, struct mthca_ah *ah) 242{ 243 switch (ah->type) { 244 case MTHCA_AH_ON_HCA: 245 mthca_free(&dev->av_table.alloc, 246 (ah->avdma - dev->av_table.ddr_av_base) / 247 MTHCA_AV_SIZE); 248 break; 249 250 case MTHCA_AH_PCI_POOL: 251 pci_pool_free(dev->av_table.pool, ah->av, ah->avdma); 252 break; 253 254 case MTHCA_AH_KMALLOC: 255 kfree(ah->av); 256 break; 257 } 258 259 return 0; 260} 261 262int mthca_ah_grh_present(struct mthca_ah *ah) 263{ 264 return !!(ah->av->g_slid & 0x80); 265} 266 267int mthca_read_ah(struct mthca_dev *dev, struct mthca_ah *ah, 268 struct ib_ud_header *header) 269{ 270 if (ah->type == MTHCA_AH_ON_HCA) 271 return -EINVAL; 272 273 header->lrh.service_level = be32_to_cpu(ah->av->sl_tclass_flowlabel) >> 28; 274 header->lrh.destination_lid = ah->av->dlid; 275 header->lrh.source_lid = cpu_to_be16(ah->av->g_slid & 0x7f); 276 if (mthca_ah_grh_present(ah)) { 277 header->grh.traffic_class = 278 (be32_to_cpu(ah->av->sl_tclass_flowlabel) >> 20) & 0xff; 279 header->grh.flow_label = 280 ah->av->sl_tclass_flowlabel & cpu_to_be32(0xfffff); 281 header->grh.hop_limit = ah->av->hop_limit; 282 ib_get_cached_gid(&dev->ib_dev, 283 be32_to_cpu(ah->av->port_pd) >> 24, 284 ah->av->gid_index % dev->limits.gid_table_len, 285 &header->grh.source_gid); 286 memcpy(header->grh.destination_gid.raw, 287 ah->av->dgid, 16); 288 } 289 290 return 0; 291} 292 293int mthca_ah_query(struct ib_ah *ibah, struct ib_ah_attr *attr) 294{ 295 struct mthca_ah *ah = to_mah(ibah); 296 struct mthca_dev *dev = to_mdev(ibah->device); 297 298 /* Only implement for MAD and memfree ah for now. */ 299 if (ah->type == MTHCA_AH_ON_HCA) 300 return -ENOSYS; 301 302 memset(attr, 0, sizeof *attr); 303 attr->dlid = be16_to_cpu(ah->av->dlid); 304 attr->sl = be32_to_cpu(ah->av->sl_tclass_flowlabel) >> 28; 305 attr->port_num = be32_to_cpu(ah->av->port_pd) >> 24; 306 attr->static_rate = mthca_rate_to_ib(dev, ah->av->msg_sr & 0x7, 307 attr->port_num); 308 attr->src_path_bits = ah->av->g_slid & 0x7F; 309 attr->ah_flags = mthca_ah_grh_present(ah) ? IB_AH_GRH : 0; 310 311 if (attr->ah_flags) { 312 attr->grh.traffic_class = 313 be32_to_cpu(ah->av->sl_tclass_flowlabel) >> 20; 314 attr->grh.flow_label = 315 be32_to_cpu(ah->av->sl_tclass_flowlabel) & 0xfffff; 316 attr->grh.hop_limit = ah->av->hop_limit; 317 attr->grh.sgid_index = ah->av->gid_index & 318 (dev->limits.gid_table_len - 1); 319 memcpy(attr->grh.dgid.raw, ah->av->dgid, 16); 320 } 321 322 return 0; 323} 324 325int mthca_init_av_table(struct mthca_dev *dev) 326{ 327 int err; 328 329 if (mthca_is_memfree(dev)) 330 return 0; 331 332 err = mthca_alloc_init(&dev->av_table.alloc, 333 dev->av_table.num_ddr_avs, 334 dev->av_table.num_ddr_avs - 1, 335 0); 336 if (err) 337 return err; 338 339 dev->av_table.pool = pci_pool_create("mthca_av", dev->pdev, 340 MTHCA_AV_SIZE, 341 MTHCA_AV_SIZE, 0); 342 if (!dev->av_table.pool) 343 goto out_free_alloc; 344 345 if (!(dev->mthca_flags & MTHCA_FLAG_DDR_HIDDEN)) { 346 dev->av_table.av_map = ioremap(pci_resource_start(dev->pdev, 4) + 347 dev->av_table.ddr_av_base - 348 dev->ddr_start, 349 dev->av_table.num_ddr_avs * 350 MTHCA_AV_SIZE); 351 if (!dev->av_table.av_map) 352 goto out_free_pool; 353 } else 354 dev->av_table.av_map = NULL; 355 356 return 0; 357 358 out_free_pool: 359 pci_pool_destroy(dev->av_table.pool); 360 361 out_free_alloc: 362 mthca_alloc_cleanup(&dev->av_table.alloc); 363 return -ENOMEM; 364} 365 366void mthca_cleanup_av_table(struct mthca_dev *dev) 367{ 368 if (mthca_is_memfree(dev)) 369 return; 370 371 if (dev->av_table.av_map) 372 iounmap(dev->av_table.av_map); 373 pci_pool_destroy(dev->av_table.pool); 374 mthca_alloc_cleanup(&dev->av_table.alloc); 375} 376