diff options
Diffstat (limited to 'drivers/net')
| -rw-r--r-- | drivers/net/Kconfig | 14 | ||||
| -rw-r--r-- | drivers/net/Makefile | 1 | ||||
| -rw-r--r-- | drivers/net/mlx4/Makefile | 4 | ||||
| -rw-r--r-- | drivers/net/mlx4/alloc.c | 179 | ||||
| -rw-r--r-- | drivers/net/mlx4/catas.c | 70 | ||||
| -rw-r--r-- | drivers/net/mlx4/cmd.c | 429 | ||||
| -rw-r--r-- | drivers/net/mlx4/cq.c | 254 | ||||
| -rw-r--r-- | drivers/net/mlx4/eq.c | 696 | ||||
| -rw-r--r-- | drivers/net/mlx4/fw.c | 775 | ||||
| -rw-r--r-- | drivers/net/mlx4/fw.h | 167 | ||||
| -rw-r--r-- | drivers/net/mlx4/icm.c | 379 | ||||
| -rw-r--r-- | drivers/net/mlx4/icm.h | 135 | ||||
| -rw-r--r-- | drivers/net/mlx4/intf.c | 165 | ||||
| -rw-r--r-- | drivers/net/mlx4/main.c | 936 | ||||
| -rw-r--r-- | drivers/net/mlx4/mcg.c | 380 | ||||
| -rw-r--r-- | drivers/net/mlx4/mlx4.h | 348 | ||||
| -rw-r--r-- | drivers/net/mlx4/mr.c | 479 | ||||
| -rw-r--r-- | drivers/net/mlx4/pd.c | 102 | ||||
| -rw-r--r-- | drivers/net/mlx4/profile.c | 238 | ||||
| -rw-r--r-- | drivers/net/mlx4/qp.c | 280 | ||||
| -rw-r--r-- | drivers/net/mlx4/reset.c | 181 | ||||
| -rw-r--r-- | drivers/net/mlx4/srq.c | 227 |
22 files changed, 6439 insertions, 0 deletions
diff --git a/drivers/net/Kconfig b/drivers/net/Kconfig index b86ccd2ecd5b..6db12d0265da 100644 --- a/drivers/net/Kconfig +++ b/drivers/net/Kconfig | |||
| @@ -2493,6 +2493,20 @@ config PASEMI_MAC | |||
| 2493 | This driver supports the on-chip 1/10Gbit Ethernet controller on | 2493 | This driver supports the on-chip 1/10Gbit Ethernet controller on |
| 2494 | PA Semi's PWRficient line of chips. | 2494 | PA Semi's PWRficient line of chips. |
| 2495 | 2495 | ||
| 2496 | config MLX4_CORE | ||
| 2497 | tristate | ||
| 2498 | depends on PCI | ||
| 2499 | default n | ||
| 2500 | |||
| 2501 | config MLX4_DEBUG | ||
| 2502 | bool "Verbose debugging output" if (MLX4_CORE && EMBEDDED) | ||
| 2503 | default y | ||
| 2504 | ---help--- | ||
| 2505 | This option causes debugging code to be compiled into the | ||
| 2506 | mlx4_core driver. The output can be turned on via the | ||
| 2507 | debug_level module parameter (which can also be set after | ||
| 2508 | the driver is loaded through sysfs). | ||
| 2509 | |||
| 2496 | endmenu | 2510 | endmenu |
| 2497 | 2511 | ||
| 2498 | source "drivers/net/tokenring/Kconfig" | 2512 | source "drivers/net/tokenring/Kconfig" |
diff --git a/drivers/net/Makefile b/drivers/net/Makefile index 59c0459a037c..7faeeeabc838 100644 --- a/drivers/net/Makefile +++ b/drivers/net/Makefile | |||
| @@ -197,6 +197,7 @@ obj-$(CONFIG_SMC911X) += smc911x.o | |||
| 197 | obj-$(CONFIG_DM9000) += dm9000.o | 197 | obj-$(CONFIG_DM9000) += dm9000.o |
| 198 | obj-$(CONFIG_FEC_8XX) += fec_8xx/ | 198 | obj-$(CONFIG_FEC_8XX) += fec_8xx/ |
| 199 | obj-$(CONFIG_PASEMI_MAC) += pasemi_mac.o | 199 | obj-$(CONFIG_PASEMI_MAC) += pasemi_mac.o |
| 200 | obj-$(CONFIG_MLX4_CORE) += mlx4/ | ||
| 200 | 201 | ||
| 201 | obj-$(CONFIG_MACB) += macb.o | 202 | obj-$(CONFIG_MACB) += macb.o |
| 202 | 203 | ||
diff --git a/drivers/net/mlx4/Makefile b/drivers/net/mlx4/Makefile new file mode 100644 index 000000000000..0952a6528f58 --- /dev/null +++ b/drivers/net/mlx4/Makefile | |||
| @@ -0,0 +1,4 @@ | |||
| 1 | obj-$(CONFIG_MLX4_CORE) += mlx4_core.o | ||
| 2 | |||
| 3 | mlx4_core-y := alloc.o catas.o cmd.o cq.o eq.o fw.o icm.o intf.o main.o mcg.o \ | ||
| 4 | mr.o pd.o profile.o qp.o reset.o srq.o | ||
diff --git a/drivers/net/mlx4/alloc.c b/drivers/net/mlx4/alloc.c new file mode 100644 index 000000000000..9ffdb9d29da9 --- /dev/null +++ b/drivers/net/mlx4/alloc.c | |||
| @@ -0,0 +1,179 @@ | |||
| 1 | /* | ||
| 2 | * Copyright (c) 2006, 2007 Cisco Systems, Inc. All rights reserved. | ||
| 3 | * | ||
| 4 | * This software is available to you under a choice of one of two | ||
| 5 | * licenses. You may choose to be licensed under the terms of the GNU | ||
| 6 | * General Public License (GPL) Version 2, available from the file | ||
| 7 | * COPYING in the main directory of this source tree, or the | ||
| 8 | * OpenIB.org BSD license below: | ||
| 9 | * | ||
| 10 | * Redistribution and use in source and binary forms, with or | ||
| 11 | * without modification, are permitted provided that the following | ||
| 12 | * conditions are met: | ||
| 13 | * | ||
| 14 | * - Redistributions of source code must retain the above | ||
| 15 | * copyright notice, this list of conditions and the following | ||
| 16 | * disclaimer. | ||
| 17 | * | ||
| 18 | * - Redistributions in binary form must reproduce the above | ||
| 19 | * copyright notice, this list of conditions and the following | ||
| 20 | * disclaimer in the documentation and/or other materials | ||
| 21 | * provided with the distribution. | ||
| 22 | * | ||
| 23 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, | ||
| 24 | * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF | ||
| 25 | * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND | ||
| 26 | * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS | ||
| 27 | * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN | ||
| 28 | * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN | ||
| 29 | * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE | ||
| 30 | * SOFTWARE. | ||
| 31 | */ | ||
| 32 | |||
| 33 | #include <linux/errno.h> | ||
| 34 | #include <linux/slab.h> | ||
| 35 | #include <linux/bitmap.h> | ||
| 36 | |||
| 37 | #include "mlx4.h" | ||
| 38 | |||
| 39 | u32 mlx4_bitmap_alloc(struct mlx4_bitmap *bitmap) | ||
| 40 | { | ||
| 41 | u32 obj; | ||
| 42 | |||
| 43 | spin_lock(&bitmap->lock); | ||
| 44 | |||
| 45 | obj = find_next_zero_bit(bitmap->table, bitmap->max, bitmap->last); | ||
| 46 | if (obj >= bitmap->max) { | ||
| 47 | bitmap->top = (bitmap->top + bitmap->max) & bitmap->mask; | ||
| 48 | obj = find_first_zero_bit(bitmap->table, bitmap->max); | ||
| 49 | } | ||
| 50 | |||
| 51 | if (obj < bitmap->max) { | ||
| 52 | set_bit(obj, bitmap->table); | ||
| 53 | obj |= bitmap->top; | ||
| 54 | bitmap->last = obj + 1; | ||
| 55 | } else | ||
| 56 | obj = -1; | ||
| 57 | |||
| 58 | spin_unlock(&bitmap->lock); | ||
| 59 | |||
| 60 | return obj; | ||
| 61 | } | ||
| 62 | |||
| 63 | void mlx4_bitmap_free(struct mlx4_bitmap *bitmap, u32 obj) | ||
| 64 | { | ||
| 65 | obj &= bitmap->max - 1; | ||
| 66 | |||
| 67 | spin_lock(&bitmap->lock); | ||
| 68 | clear_bit(obj, bitmap->table); | ||
| 69 | bitmap->last = min(bitmap->last, obj); | ||
| 70 | bitmap->top = (bitmap->top + bitmap->max) & bitmap->mask; | ||
| 71 | spin_unlock(&bitmap->lock); | ||
| 72 | } | ||
| 73 | |||
| 74 | int mlx4_bitmap_init(struct mlx4_bitmap *bitmap, u32 num, u32 mask, u32 reserved) | ||
| 75 | { | ||
| 76 | int i; | ||
| 77 | |||
| 78 | /* num must be a power of 2 */ | ||
| 79 | if (num != roundup_pow_of_two(num)) | ||
| 80 | return -EINVAL; | ||
| 81 | |||
| 82 | bitmap->last = 0; | ||
| 83 | bitmap->top = 0; | ||
| 84 | bitmap->max = num; | ||
| 85 | bitmap->mask = mask; | ||
| 86 | spin_lock_init(&bitmap->lock); | ||
| 87 | bitmap->table = kzalloc(BITS_TO_LONGS(num) * sizeof (long), GFP_KERNEL); | ||
| 88 | if (!bitmap->table) | ||
| 89 | return -ENOMEM; | ||
| 90 | |||
| 91 | for (i = 0; i < reserved; ++i) | ||
| 92 | set_bit(i, bitmap->table); | ||
| 93 | |||
| 94 | return 0; | ||
| 95 | } | ||
| 96 | |||
| 97 | void mlx4_bitmap_cleanup(struct mlx4_bitmap *bitmap) | ||
| 98 | { | ||
| 99 | kfree(bitmap->table); | ||
| 100 | } | ||
| 101 | |||
| 102 | /* | ||
| 103 | * Handling for queue buffers -- we allocate a bunch of memory and | ||
| 104 | * register it in a memory region at HCA virtual address 0. If the | ||
| 105 | * requested size is > max_direct, we split the allocation into | ||
| 106 | * multiple pages, so we don't require too much contiguous memory. | ||
| 107 | */ | ||
| 108 | |||
| 109 | int mlx4_buf_alloc(struct mlx4_dev *dev, int size, int max_direct, | ||
| 110 | struct mlx4_buf *buf) | ||
| 111 | { | ||
| 112 | dma_addr_t t; | ||
| 113 | |||
| 114 | if (size <= max_direct) { | ||
| 115 | buf->nbufs = 1; | ||
| 116 | buf->npages = 1; | ||
| 117 | buf->page_shift = get_order(size) + PAGE_SHIFT; | ||
| 118 | buf->u.direct.buf = dma_alloc_coherent(&dev->pdev->dev, | ||
| 119 | size, &t, GFP_KERNEL); | ||
| 120 | if (!buf->u.direct.buf) | ||
| 121 | return -ENOMEM; | ||
| 122 | |||
| 123 | buf->u.direct.map = t; | ||
| 124 | |||
| 125 | while (t & ((1 << buf->page_shift) - 1)) { | ||
| 126 | --buf->page_shift; | ||
| 127 | buf->npages *= 2; | ||
| 128 | } | ||
| 129 | |||
| 130 | memset(buf->u.direct.buf, 0, size); | ||
| 131 | } else { | ||
| 132 | int i; | ||
| 133 | |||
| 134 | buf->nbufs = (size + PAGE_SIZE - 1) / PAGE_SIZE; | ||
| 135 | buf->npages = buf->nbufs; | ||
| 136 | buf->page_shift = PAGE_SHIFT; | ||
| 137 | buf->u.page_list = kzalloc(buf->nbufs * sizeof *buf->u.page_list, | ||
| 138 | GFP_KERNEL); | ||
| 139 | if (!buf->u.page_list) | ||
| 140 | return -ENOMEM; | ||
| 141 | |||
| 142 | for (i = 0; i < buf->nbufs; ++i) { | ||
| 143 | buf->u.page_list[i].buf = | ||
| 144 | dma_alloc_coherent(&dev->pdev->dev, PAGE_SIZE, | ||
| 145 | &t, GFP_KERNEL); | ||
| 146 | if (!buf->u.page_list[i].buf) | ||
| 147 | goto err_free; | ||
| 148 | |||
| 149 | buf->u.page_list[i].map = t; | ||
| 150 | |||
| 151 | memset(buf->u.page_list[i].buf, 0, PAGE_SIZE); | ||
| 152 | } | ||
| 153 | } | ||
| 154 | |||
| 155 | return 0; | ||
| 156 | |||
| 157 | err_free: | ||
| 158 | mlx4_buf_free(dev, size, buf); | ||
| 159 | |||
| 160 | return -ENOMEM; | ||
| 161 | } | ||
| 162 | EXPORT_SYMBOL_GPL(mlx4_buf_alloc); | ||
| 163 | |||
| 164 | void mlx4_buf_free(struct mlx4_dev *dev, int size, struct mlx4_buf *buf) | ||
| 165 | { | ||
| 166 | int i; | ||
| 167 | |||
| 168 | if (buf->nbufs == 1) | ||
| 169 | dma_free_coherent(&dev->pdev->dev, size, buf->u.direct.buf, | ||
| 170 | buf->u.direct.map); | ||
| 171 | else { | ||
| 172 | for (i = 0; i < buf->nbufs; ++i) | ||
| 173 | dma_free_coherent(&dev->pdev->dev, PAGE_SIZE, | ||
| 174 | buf->u.page_list[i].buf, | ||
| 175 | buf->u.page_list[i].map); | ||
| 176 | kfree(buf->u.page_list); | ||
| 177 | } | ||
| 178 | } | ||
| 179 | EXPORT_SYMBOL_GPL(mlx4_buf_free); | ||
diff --git a/drivers/net/mlx4/catas.c b/drivers/net/mlx4/catas.c new file mode 100644 index 000000000000..1bb088aeaf71 --- /dev/null +++ b/drivers/net/mlx4/catas.c | |||
| @@ -0,0 +1,70 @@ | |||
| 1 | /* | ||
| 2 | * Copyright (c) 2007 Cisco Systems, Inc. All rights reserved. | ||
| 3 | * | ||
| 4 | * This software is available to you under a choice of one of two | ||
| 5 | * licenses. You may choose to be licensed under the terms of the GNU | ||
| 6 | * General Public License (GPL) Version 2, available from the file | ||
| 7 | * COPYING in the main directory of this source tree, or the | ||
| 8 | * OpenIB.org BSD license below: | ||
| 9 | * | ||
| 10 | * Redistribution and use in source and binary forms, with or | ||
| 11 | * without modification, are permitted provided that the following | ||
| 12 | * conditions are met: | ||
| 13 | * | ||
| 14 | * - Redistributions of source code must retain the above | ||
| 15 | * copyright notice, this list of conditions and the following | ||
| 16 | * disclaimer. | ||
| 17 | * | ||
| 18 | * - Redistributions in binary form must reproduce the above | ||
| 19 | * copyright notice, this list of conditions and the following | ||
| 20 | * disclaimer in the documentation and/or other materials | ||
| 21 | * provided with the distribution. | ||
| 22 | * | ||
| 23 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, | ||
| 24 | * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF | ||
| 25 | * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND | ||
| 26 | * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS | ||
| 27 | * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN | ||
| 28 | * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN | ||
| 29 | * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE | ||
| 30 | * SOFTWARE. | ||
| 31 | */ | ||
| 32 | |||
| 33 | #include "mlx4.h" | ||
| 34 | |||
| 35 | void mlx4_handle_catas_err(struct mlx4_dev *dev) | ||
| 36 | { | ||
| 37 | struct mlx4_priv *priv = mlx4_priv(dev); | ||
| 38 | |||
| 39 | int i; | ||
| 40 | |||
| 41 | mlx4_err(dev, "Catastrophic error detected:\n"); | ||
| 42 | for (i = 0; i < priv->fw.catas_size; ++i) | ||
| 43 | mlx4_err(dev, " buf[%02x]: %08x\n", | ||
| 44 | i, swab32(readl(priv->catas_err.map + i))); | ||
| 45 | |||
| 46 | mlx4_dispatch_event(dev, MLX4_EVENT_TYPE_LOCAL_CATAS_ERROR, 0, 0); | ||
| 47 | } | ||
| 48 | |||
| 49 | void mlx4_map_catas_buf(struct mlx4_dev *dev) | ||
| 50 | { | ||
| 51 | struct mlx4_priv *priv = mlx4_priv(dev); | ||
| 52 | unsigned long addr; | ||
| 53 | |||
| 54 | addr = pci_resource_start(dev->pdev, priv->fw.catas_bar) + | ||
| 55 | priv->fw.catas_offset; | ||
| 56 | |||
| 57 | priv->catas_err.map = ioremap(addr, priv->fw.catas_size * 4); | ||
| 58 | if (!priv->catas_err.map) | ||
| 59 | mlx4_warn(dev, "Failed to map catastrophic error buffer at 0x%lx\n", | ||
| 60 | addr); | ||
| 61 | |||
| 62 | } | ||
| 63 | |||
| 64 | void mlx4_unmap_catas_buf(struct mlx4_dev *dev) | ||
| 65 | { | ||
| 66 | struct mlx4_priv *priv = mlx4_priv(dev); | ||
| 67 | |||
| 68 | if (priv->catas_err.map) | ||
| 69 | iounmap(priv->catas_err.map); | ||
| 70 | } | ||
diff --git a/drivers/net/mlx4/cmd.c b/drivers/net/mlx4/cmd.c new file mode 100644 index 000000000000..c1f81a993f5d --- /dev/null +++ b/drivers/net/mlx4/cmd.c | |||
| @@ -0,0 +1,429 @@ | |||
| 1 | /* | ||
| 2 | * Copyright (c) 2004, 2005 Topspin Communications. All rights reserved. | ||
| 3 | * Copyright (c) 2005 Mellanox Technologies. All rights reserved. | ||
| 4 | * Copyright (c) 2005, 2006, 2007 Cisco Systems, Inc. All rights reserved. | ||
| 5 | * | ||
| 6 | * This software is available to you under a choice of one of two | ||
| 7 | * licenses. You may choose to be licensed under the terms of the GNU | ||
| 8 | * General Public License (GPL) Version 2, available from the file | ||
| 9 | * COPYING in the main directory of this source tree, or the | ||
| 10 | * OpenIB.org BSD license below: | ||
| 11 | * | ||
| 12 | * Redistribution and use in source and binary forms, with or | ||
| 13 | * without modification, are permitted provided that the following | ||
| 14 | * conditions are met: | ||
| 15 | * | ||
| 16 | * - Redistributions of source code must retain the above | ||
| 17 | * copyright notice, this list of conditions and the following | ||
| 18 | * disclaimer. | ||
| 19 | * | ||
| 20 | * - Redistributions in binary form must reproduce the above | ||
| 21 | * copyright notice, this list of conditions and the following | ||
| 22 | * disclaimer in the documentation and/or other materials | ||
| 23 | * provided with the distribution. | ||
| 24 | * | ||
| 25 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, | ||
| 26 | * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF | ||
| 27 | * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND | ||
| 28 | * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS | ||
| 29 | * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN | ||
| 30 | * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN | ||
| 31 | * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE | ||
| 32 | * SOFTWARE. | ||
| 33 | */ | ||
| 34 | |||
| 35 | #include <linux/sched.h> | ||
| 36 | #include <linux/pci.h> | ||
| 37 | #include <linux/errno.h> | ||
| 38 | |||
| 39 | #include <linux/mlx4/cmd.h> | ||
| 40 | |||
| 41 | #include <asm/io.h> | ||
| 42 | |||
| 43 | #include "mlx4.h" | ||
| 44 | |||
| 45 | #define CMD_POLL_TOKEN 0xffff | ||
| 46 | |||
| 47 | enum { | ||
| 48 | /* command completed successfully: */ | ||
| 49 | CMD_STAT_OK = 0x00, | ||
| 50 | /* Internal error (such as a bus error) occurred while processing command: */ | ||
| 51 | CMD_STAT_INTERNAL_ERR = 0x01, | ||
| 52 | /* Operation/command not supported or opcode modifier not supported: */ | ||
| 53 | CMD_STAT_BAD_OP = 0x02, | ||
| 54 | /* Parameter not supported or parameter out of range: */ | ||
| 55 | CMD_STAT_BAD_PARAM = 0x03, | ||
| 56 | /* System not enabled or bad system state: */ | ||
| 57 | CMD_STAT_BAD_SYS_STATE = 0x04, | ||
| 58 | /* Attempt to access reserved or unallocaterd resource: */ | ||
| 59 | CMD_STAT_BAD_RESOURCE = 0x05, | ||
| 60 | /* Requested resource is currently executing a command, or is otherwise busy: */ | ||
| 61 | CMD_STAT_RESOURCE_BUSY = 0x06, | ||
| 62 | /* Required capability exceeds device limits: */ | ||
| 63 | CMD_STAT_EXCEED_LIM = 0x08, | ||
| 64 | /* Resource is not in the appropriate state or ownership: */ | ||
| 65 | CMD_STAT_BAD_RES_STATE = 0x09, | ||
| 66 | /* Index out of range: */ | ||
| 67 | CMD_STAT_BAD_INDEX = 0x0a, | ||
| 68 | /* FW image corrupted: */ | ||
| 69 | CMD_STAT_BAD_NVMEM = 0x0b, | ||
| 70 | /* Attempt to modify a QP/EE which is not in the presumed state: */ | ||
| 71 | CMD_STAT_BAD_QP_STATE = 0x10, | ||
| 72 | /* Bad segment parameters (Address/Size): */ | ||
| 73 | CMD_STAT_BAD_SEG_PARAM = 0x20, | ||
| 74 | /* Memory Region has Memory Windows bound to: */ | ||
| 75 | CMD_STAT_REG_BOUND = 0x21, | ||
| 76 | /* HCA local attached memory not present: */ | ||
| 77 | CMD_STAT_LAM_NOT_PRE = 0x22, | ||
| 78 | /* Bad management packet (silently discarded): */ | ||
| 79 | CMD_STAT_BAD_PKT = 0x30, | ||
| 80 | /* More outstanding CQEs in CQ than new CQ size: */ | ||
| 81 | CMD_STAT_BAD_SIZE = 0x40 | ||
| 82 | }; | ||
| 83 | |||
| 84 | enum { | ||
| 85 | HCR_IN_PARAM_OFFSET = 0x00, | ||
| 86 | HCR_IN_MODIFIER_OFFSET = 0x08, | ||
| 87 | HCR_OUT_PARAM_OFFSET = 0x0c, | ||
| 88 | HCR_TOKEN_OFFSET = 0x14, | ||
| 89 | HCR_STATUS_OFFSET = 0x18, | ||
| 90 | |||
| 91 | HCR_OPMOD_SHIFT = 12, | ||
| 92 | HCR_T_BIT = 21, | ||
| 93 | HCR_E_BIT = 22, | ||
| 94 | HCR_GO_BIT = 23 | ||
| 95 | }; | ||
| 96 | |||
| 97 | enum { | ||
| 98 | GO_BIT_TIMEOUT = 10000 | ||
| 99 | }; | ||
| 100 | |||
| 101 | struct mlx4_cmd_context { | ||
| 102 | struct completion done; | ||
| 103 | int result; | ||
| 104 | int next; | ||
| 105 | u64 out_param; | ||
| 106 | u16 token; | ||
| 107 | }; | ||
| 108 | |||
| 109 | static int mlx4_status_to_errno(u8 status) { | ||
| 110 | static const int trans_table[] = { | ||
| 111 | [CMD_STAT_INTERNAL_ERR] = -EIO, | ||
| 112 | [CMD_STAT_BAD_OP] = -EPERM, | ||
| 113 | [CMD_STAT_BAD_PARAM] = -EINVAL, | ||
| 114 | [CMD_STAT_BAD_SYS_STATE] = -ENXIO, | ||
| 115 | [CMD_STAT_BAD_RESOURCE] = -EBADF, | ||
| 116 | [CMD_STAT_RESOURCE_BUSY] = -EBUSY, | ||
| 117 | [CMD_STAT_EXCEED_LIM] = -ENOMEM, | ||
| 118 | [CMD_STAT_BAD_RES_STATE] = -EBADF, | ||
| 119 | [CMD_STAT_BAD_INDEX] = -EBADF, | ||
| 120 | [CMD_STAT_BAD_NVMEM] = -EFAULT, | ||
| 121 | [CMD_STAT_BAD_QP_STATE] = -EINVAL, | ||
| 122 | [CMD_STAT_BAD_SEG_PARAM] = -EFAULT, | ||
| 123 | [CMD_STAT_REG_BOUND] = -EBUSY, | ||
| 124 | [CMD_STAT_LAM_NOT_PRE] = -EAGAIN, | ||
| 125 | [CMD_STAT_BAD_PKT] = -EINVAL, | ||
| 126 | [CMD_STAT_BAD_SIZE] = -ENOMEM, | ||
| 127 | }; | ||
| 128 | |||
| 129 | if (status >= ARRAY_SIZE(trans_table) || | ||
| 130 | (status != CMD_STAT_OK && trans_table[status] == 0)) | ||
| 131 | return -EIO; | ||
| 132 | |||
| 133 | return trans_table[status]; | ||
| 134 | } | ||
| 135 | |||
| 136 | static int cmd_pending(struct mlx4_dev *dev) | ||
| 137 | { | ||
| 138 | u32 status = readl(mlx4_priv(dev)->cmd.hcr + HCR_STATUS_OFFSET); | ||
| 139 | |||
| 140 | return (status & swab32(1 << HCR_GO_BIT)) || | ||
| 141 | (mlx4_priv(dev)->cmd.toggle == | ||
| 142 | !!(status & swab32(1 << HCR_T_BIT))); | ||
| 143 | } | ||
| 144 | |||
| 145 | static int mlx4_cmd_post(struct mlx4_dev *dev, u64 in_param, u64 out_param, | ||
| 146 | u32 in_modifier, u8 op_modifier, u16 op, u16 token, | ||
| 147 | int event) | ||
| 148 | { | ||
| 149 | struct mlx4_cmd *cmd = &mlx4_priv(dev)->cmd; | ||
| 150 | u32 __iomem *hcr = cmd->hcr; | ||
| 151 | int ret = -EAGAIN; | ||
| 152 | unsigned long end; | ||
| 153 | |||
| 154 | mutex_lock(&cmd->hcr_mutex); | ||
| 155 | |||
| 156 | end = jiffies; | ||
| 157 | if (event) | ||
| 158 | end += HZ * 10; | ||
| 159 | |||
| 160 | while (cmd_pending(dev)) { | ||
| 161 | if (time_after_eq(jiffies, end)) | ||
| 162 | goto out; | ||
| 163 | cond_resched(); | ||
| 164 | } | ||
| 165 | |||
| 166 | /* | ||
| 167 | * We use writel (instead of something like memcpy_toio) | ||
| 168 | * because writes of less than 32 bits to the HCR don't work | ||
| 169 | * (and some architectures such as ia64 implement memcpy_toio | ||
| 170 | * in terms of writeb). | ||
| 171 | */ | ||
| 172 | __raw_writel((__force u32) cpu_to_be32(in_param >> 32), hcr + 0); | ||
| 173 | __raw_writel((__force u32) cpu_to_be32(in_param & 0xfffffffful), hcr + 1); | ||
| 174 | __raw_writel((__force u32) cpu_to_be32(in_modifier), hcr + 2); | ||
| 175 | __raw_writel((__force u32) cpu_to_be32(out_param >> 32), hcr + 3); | ||
| 176 | __raw_writel((__force u32) cpu_to_be32(out_param & 0xfffffffful), hcr + 4); | ||
| 177 | __raw_writel((__force u32) cpu_to_be32(token << 16), hcr + 5); | ||
| 178 | |||
| 179 | /* __raw_writel may not order writes. */ | ||
| 180 | wmb(); | ||
| 181 | |||
| 182 | __raw_writel((__force u32) cpu_to_be32((1 << HCR_GO_BIT) | | ||
| 183 | (cmd->toggle << HCR_T_BIT) | | ||
| 184 | (event ? (1 << HCR_E_BIT) : 0) | | ||
| 185 | (op_modifier << HCR_OPMOD_SHIFT) | | ||
| 186 | op), hcr + 6); | ||
| 187 | cmd->toggle = cmd->toggle ^ 1; | ||
| 188 | |||
| 189 | ret = 0; | ||
| 190 | |||
| 191 | out: | ||
| 192 | mutex_unlock(&cmd->hcr_mutex); | ||
| 193 | return ret; | ||
| 194 | } | ||
| 195 | |||
| 196 | static int mlx4_cmd_poll(struct mlx4_dev *dev, u64 in_param, u64 *out_param, | ||
| 197 | int out_is_imm, u32 in_modifier, u8 op_modifier, | ||
| 198 | u16 op, unsigned long timeout) | ||
| 199 | { | ||
| 200 | struct mlx4_priv *priv = mlx4_priv(dev); | ||
| 201 | void __iomem *hcr = priv->cmd.hcr; | ||
| 202 | int err = 0; | ||
| 203 | unsigned long end; | ||
| 204 | |||
| 205 | down(&priv->cmd.poll_sem); | ||
| 206 | |||
| 207 | err = mlx4_cmd_post(dev, in_param, out_param ? *out_param : 0, | ||
| 208 | in_modifier, op_modifier, op, CMD_POLL_TOKEN, 0); | ||
| 209 | if (err) | ||
| 210 | goto out; | ||
| 211 | |||
| 212 | end = msecs_to_jiffies(timeout) + jiffies; | ||
| 213 | while (cmd_pending(dev) && time_before(jiffies, end)) | ||
| 214 | cond_resched(); | ||
| 215 | |||
| 216 | if (cmd_pending(dev)) { | ||
| 217 | err = -ETIMEDOUT; | ||
| 218 | goto out; | ||
| 219 | } | ||
| 220 | |||
| 221 | if (out_is_imm) | ||
| 222 | *out_param = | ||
| 223 | (u64) be32_to_cpu((__force __be32) | ||
| 224 | __raw_readl(hcr + HCR_OUT_PARAM_OFFSET)) << 32 | | ||
| 225 | (u64) be32_to_cpu((__force __be32) | ||
| 226 | __raw_readl(hcr + HCR_OUT_PARAM_OFFSET + 4)); | ||
| 227 | |||
| 228 | err = mlx4_status_to_errno(be32_to_cpu((__force __be32) | ||
| 229 | __raw_readl(hcr + HCR_STATUS_OFFSET)) >> 24); | ||
| 230 | |||
| 231 | out: | ||
| 232 | up(&priv->cmd.poll_sem); | ||
| 233 | return err; | ||
| 234 | } | ||
| 235 | |||
| 236 | void mlx4_cmd_event(struct mlx4_dev *dev, u16 token, u8 status, u64 out_param) | ||
| 237 | { | ||
| 238 | struct mlx4_priv *priv = mlx4_priv(dev); | ||
| 239 | struct mlx4_cmd_context *context = | ||
| 240 | &priv->cmd.context[token & priv->cmd.token_mask]; | ||
| 241 | |||
| 242 | /* previously timed out command completing at long last */ | ||
| 243 | if (token != context->token) | ||
| 244 | return; | ||
| 245 | |||
| 246 | context->result = mlx4_status_to_errno(status); | ||
| 247 | context->out_param = out_param; | ||
| 248 | |||
| 249 | context->token += priv->cmd.token_mask + 1; | ||
| 250 | |||
| 251 | complete(&context->done); | ||
| 252 | } | ||
| 253 | |||
| 254 | static int mlx4_cmd_wait(struct mlx4_dev *dev, u64 in_param, u64 *out_param, | ||
| 255 | int out_is_imm, u32 in_modifier, u8 op_modifier, | ||
| 256 | u16 op, unsigned long timeout) | ||
| 257 | { | ||
| 258 | struct mlx4_cmd *cmd = &mlx4_priv(dev)->cmd; | ||
| 259 | struct mlx4_cmd_context *context; | ||
| 260 | int err = 0; | ||
| 261 | |||
| 262 | down(&cmd->event_sem); | ||
| 263 | |||
| 264 | spin_lock(&cmd->context_lock); | ||
| 265 | BUG_ON(cmd->free_head < 0); | ||
| 266 | context = &cmd->context[cmd->free_head]; | ||
| 267 | cmd->free_head = context->next; | ||
| 268 | spin_unlock(&cmd->context_lock); | ||
| 269 | |||
| 270 | init_completion(&context->done); | ||
| 271 | |||
| 272 | mlx4_cmd_post(dev, in_param, out_param ? *out_param : 0, | ||
| 273 | in_modifier, op_modifier, op, context->token, 1); | ||
| 274 | |||
| 275 | if (!wait_for_completion_timeout(&context->done, msecs_to_jiffies(timeout))) { | ||
| 276 | err = -EBUSY; | ||
| 277 | goto out; | ||
| 278 | } | ||
| 279 | |||
| 280 | err = context->result; | ||
| 281 | if (err) | ||
| 282 | goto out; | ||
| 283 | |||
| 284 | if (out_is_imm) | ||
| 285 | *out_param = context->out_param; | ||
| 286 | |||
| 287 | out: | ||
| 288 | spin_lock(&cmd->context_lock); | ||
| 289 | context->next = cmd->free_head; | ||
| 290 | cmd->free_head = context - cmd->context; | ||
| 291 | spin_unlock(&cmd->context_lock); | ||
| 292 | |||
| 293 | up(&cmd->event_sem); | ||
| 294 | return err; | ||
| 295 | } | ||
| 296 | |||
| 297 | int __mlx4_cmd(struct mlx4_dev *dev, u64 in_param, u64 *out_param, | ||
| 298 | int out_is_imm, u32 in_modifier, u8 op_modifier, | ||
| 299 | u16 op, unsigned long timeout) | ||
| 300 | { | ||
| 301 | if (mlx4_priv(dev)->cmd.use_events) | ||
| 302 | return mlx4_cmd_wait(dev, in_param, out_param, out_is_imm, | ||
| 303 | in_modifier, op_modifier, op, timeout); | ||
| 304 | else | ||
| 305 | return mlx4_cmd_poll(dev, in_param, out_param, out_is_imm, | ||
| 306 | in_modifier, op_modifier, op, timeout); | ||
| 307 | } | ||
| 308 | EXPORT_SYMBOL_GPL(__mlx4_cmd); | ||
| 309 | |||
| 310 | int mlx4_cmd_init(struct mlx4_dev *dev) | ||
| 311 | { | ||
| 312 | struct mlx4_priv *priv = mlx4_priv(dev); | ||
| 313 | |||
| 314 | mutex_init(&priv->cmd.hcr_mutex); | ||
| 315 | sema_init(&priv->cmd.poll_sem, 1); | ||
| 316 | priv->cmd.use_events = 0; | ||
| 317 | priv->cmd.toggle = 1; | ||
| 318 | |||
| 319 | priv->cmd.hcr = ioremap(pci_resource_start(dev->pdev, 0) + MLX4_HCR_BASE, | ||
| 320 | MLX4_HCR_SIZE); | ||
| 321 | if (!priv->cmd.hcr) { | ||
| 322 | mlx4_err(dev, "Couldn't map command register."); | ||
| 323 | return -ENOMEM; | ||
| 324 | } | ||
| 325 | |||
| 326 | priv->cmd.pool = pci_pool_create("mlx4_cmd", dev->pdev, | ||
| 327 | MLX4_MAILBOX_SIZE, | ||
| 328 | MLX4_MAILBOX_SIZE, 0); | ||
| 329 | if (!priv->cmd.pool) { | ||
| 330 | iounmap(priv->cmd.hcr); | ||
| 331 | return -ENOMEM; | ||
| 332 | } | ||
| 333 | |||
| 334 | return 0; | ||
| 335 | } | ||
| 336 | |||
| 337 | void mlx4_cmd_cleanup(struct mlx4_dev *dev) | ||
| 338 | { | ||
| 339 | struct mlx4_priv *priv = mlx4_priv(dev); | ||
| 340 | |||
| 341 | pci_pool_destroy(priv->cmd.pool); | ||
| 342 | iounmap(priv->cmd.hcr); | ||
| 343 | } | ||
| 344 | |||
| 345 | /* | ||
| 346 | * Switch to using events to issue FW commands (can only be called | ||
| 347 | * after event queue for command events has been initialized). | ||
| 348 | */ | ||
| 349 | int mlx4_cmd_use_events(struct mlx4_dev *dev) | ||
| 350 | { | ||
| 351 | struct mlx4_priv *priv = mlx4_priv(dev); | ||
| 352 | int i; | ||
| 353 | |||
| 354 | priv->cmd.context = kmalloc(priv->cmd.max_cmds * | ||
| 355 | sizeof (struct mlx4_cmd_context), | ||
| 356 | GFP_KERNEL); | ||
| 357 | if (!priv->cmd.context) | ||
| 358 | return -ENOMEM; | ||
| 359 | |||
| 360 | for (i = 0; i < priv->cmd.max_cmds; ++i) { | ||
| 361 | priv->cmd.context[i].token = i; | ||
| 362 | priv->cmd.context[i].next = i + 1; | ||
| 363 | } | ||
| 364 | |||
| 365 | priv->cmd.context[priv->cmd.max_cmds - 1].next = -1; | ||
| 366 | priv->cmd.free_head = 0; | ||
| 367 | |||
| 368 | sema_init(&priv->cmd.event_sem, priv->cmd.max_cmds); | ||
| 369 | spin_lock_init(&priv->cmd.context_lock); | ||
| 370 | |||
| 371 | for (priv->cmd.token_mask = 1; | ||
| 372 | priv->cmd.token_mask < priv->cmd.max_cmds; | ||
| 373 | priv->cmd.token_mask <<= 1) | ||
| 374 | ; /* nothing */ | ||
| 375 | --priv->cmd.token_mask; | ||
| 376 | |||
| 377 | priv->cmd.use_events = 1; | ||
| 378 | |||
| 379 | down(&priv->cmd.poll_sem); | ||
| 380 | |||
| 381 | return 0; | ||
| 382 | } | ||
| 383 | |||
| 384 | /* | ||
| 385 | * Switch back to polling (used when shutting down the device) | ||
| 386 | */ | ||
| 387 | void mlx4_cmd_use_polling(struct mlx4_dev *dev) | ||
| 388 | { | ||
| 389 | struct mlx4_priv *priv = mlx4_priv(dev); | ||
| 390 | int i; | ||
| 391 | |||
| 392 | priv->cmd.use_events = 0; | ||
| 393 | |||
| 394 | for (i = 0; i < priv->cmd.max_cmds; ++i) | ||
| 395 | down(&priv->cmd.event_sem); | ||
| 396 | |||
| 397 | kfree(priv->cmd.context); | ||
| 398 | |||
| 399 | up(&priv->cmd.poll_sem); | ||
| 400 | } | ||
| 401 | |||
| 402 | struct mlx4_cmd_mailbox *mlx4_alloc_cmd_mailbox(struct mlx4_dev *dev) | ||
| 403 | { | ||
| 404 | struct mlx4_cmd_mailbox *mailbox; | ||
| 405 | |||
| 406 | mailbox = kmalloc(sizeof *mailbox, GFP_KERNEL); | ||
| 407 | if (!mailbox) | ||
| 408 | return ERR_PTR(-ENOMEM); | ||
| 409 | |||
| 410 | mailbox->buf = pci_pool_alloc(mlx4_priv(dev)->cmd.pool, GFP_KERNEL, | ||
| 411 | &mailbox->dma); | ||
| 412 | if (!mailbox->buf) { | ||
| 413 | kfree(mailbox); | ||
| 414 | return ERR_PTR(-ENOMEM); | ||
| 415 | } | ||
| 416 | |||
| 417 | return mailbox; | ||
| 418 | } | ||
| 419 | EXPORT_SYMBOL_GPL(mlx4_alloc_cmd_mailbox); | ||
| 420 | |||
| 421 | void mlx4_free_cmd_mailbox(struct mlx4_dev *dev, struct mlx4_cmd_mailbox *mailbox) | ||
| 422 | { | ||
| 423 | if (!mailbox) | ||
| 424 | return; | ||
| 425 | |||
| 426 | pci_pool_free(mlx4_priv(dev)->cmd.pool, mailbox->buf, mailbox->dma); | ||
| 427 | kfree(mailbox); | ||
| 428 | } | ||
| 429 | EXPORT_SYMBOL_GPL(mlx4_free_cmd_mailbox); | ||
diff --git a/drivers/net/mlx4/cq.c b/drivers/net/mlx4/cq.c new file mode 100644 index 000000000000..437d78ad0912 --- /dev/null +++ b/drivers/net/mlx4/cq.c | |||
| @@ -0,0 +1,254 @@ | |||
| 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, 2006, 2007 Cisco Systems, Inc. All rights reserved. | ||
| 5 | * Copyright (c) 2005 Mellanox Technologies. All rights reserved. | ||
| 6 | * Copyright (c) 2004 Voltaire, Inc. All rights reserved. | ||
| 7 | * | ||
| 8 | * This software is available to you under a choice of one of two | ||
| 9 | * licenses. You may choose to be licensed under the terms of the GNU | ||
| 10 | * General Public License (GPL) Version 2, available from the file | ||
| 11 | * COPYING in the main directory of this source tree, or the | ||
| 12 | * OpenIB.org BSD license below: | ||
| 13 | * | ||
| 14 | * Redistribution and use in source and binary forms, with or | ||
| 15 | * without modification, are permitted provided that the following | ||
| 16 | * conditions are met: | ||
| 17 | * | ||
| 18 | * - Redistributions of source code must retain the above | ||
| 19 | * copyright notice, this list of conditions and the following | ||
| 20 | * disclaimer. | ||
| 21 | * | ||
| 22 | * - Redistributions in binary form must reproduce the above | ||
| 23 | * copyright notice, this list of conditions and the following | ||
| 24 | * disclaimer in the documentation and/or other materials | ||
| 25 | * provided with the distribution. | ||
| 26 | * | ||
| 27 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, | ||
| 28 | * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF | ||
| 29 | * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND | ||
| 30 | * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS | ||
| 31 | * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN | ||
| 32 | * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN | ||
| 33 | * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE | ||
| 34 | * SOFTWARE. | ||
| 35 | */ | ||
| 36 | |||
| 37 | #include <linux/init.h> | ||
| 38 | #include <linux/hardirq.h> | ||
| 39 | |||
| 40 | #include <linux/mlx4/cmd.h> | ||
| 41 | |||
| 42 | #include "mlx4.h" | ||
| 43 | #include "icm.h" | ||
| 44 | |||
| 45 | struct mlx4_cq_context { | ||
| 46 | __be32 flags; | ||
| 47 | u16 reserved1[3]; | ||
| 48 | __be16 page_offset; | ||
| 49 | __be32 logsize_usrpage; | ||
| 50 | u8 reserved2; | ||
| 51 | u8 cq_period; | ||
| 52 | u8 reserved3; | ||
| 53 | u8 cq_max_count; | ||
| 54 | u8 reserved4[3]; | ||
| 55 | u8 comp_eqn; | ||
| 56 | u8 log_page_size; | ||
| 57 | u8 reserved5[2]; | ||
| 58 | u8 mtt_base_addr_h; | ||
| 59 | __be32 mtt_base_addr_l; | ||
| 60 | __be32 last_notified_index; | ||
| 61 | __be32 solicit_producer_index; | ||
| 62 | __be32 consumer_index; | ||
| 63 | __be32 producer_index; | ||
| 64 | u8 reserved6[2]; | ||
| 65 | __be64 db_rec_addr; | ||
| 66 | }; | ||
| 67 | |||
| 68 | #define MLX4_CQ_STATUS_OK ( 0 << 28) | ||
| 69 | #define MLX4_CQ_STATUS_OVERFLOW ( 9 << 28) | ||
| 70 | #define MLX4_CQ_STATUS_WRITE_FAIL (10 << 28) | ||
| 71 | #define MLX4_CQ_FLAG_CC ( 1 << 18) | ||
| 72 | #define MLX4_CQ_FLAG_OI ( 1 << 17) | ||
| 73 | #define MLX4_CQ_STATE_ARMED ( 9 << 8) | ||
| 74 | #define MLX4_CQ_STATE_ARMED_SOL ( 6 << 8) | ||
| 75 | #define MLX4_EQ_STATE_FIRED (10 << 8) | ||
| 76 | |||
| 77 | void mlx4_cq_completion(struct mlx4_dev *dev, u32 cqn) | ||
| 78 | { | ||
| 79 | struct mlx4_cq *cq; | ||
| 80 | |||
| 81 | cq = radix_tree_lookup(&mlx4_priv(dev)->cq_table.tree, | ||
| 82 | cqn & (dev->caps.num_cqs - 1)); | ||
| 83 | if (!cq) { | ||
| 84 | mlx4_warn(dev, "Completion event for bogus CQ %08x\n", cqn); | ||
| 85 | return; | ||
| 86 | } | ||
| 87 | |||
| 88 | ++cq->arm_sn; | ||
| 89 | |||
| 90 | cq->comp(cq); | ||
| 91 | } | ||
| 92 | |||
| 93 | void mlx4_cq_event(struct mlx4_dev *dev, u32 cqn, int event_type) | ||
| 94 | { | ||
| 95 | struct mlx4_cq_table *cq_table = &mlx4_priv(dev)->cq_table; | ||
| 96 | struct mlx4_cq *cq; | ||
| 97 | |||
| 98 | spin_lock(&cq_table->lock); | ||
| 99 | |||
| 100 | cq = radix_tree_lookup(&cq_table->tree, cqn & (dev->caps.num_cqs - 1)); | ||
| 101 | if (cq) | ||
| 102 | atomic_inc(&cq->refcount); | ||
| 103 | |||
| 104 | spin_unlock(&cq_table->lock); | ||
| 105 | |||
| 106 | if (!cq) { | ||
| 107 | mlx4_warn(dev, "Async event for bogus CQ %08x\n", cqn); | ||
| 108 | return; | ||
| 109 | } | ||
| 110 | |||
| 111 | cq->event(cq, event_type); | ||
| 112 | |||
| 113 | if (atomic_dec_and_test(&cq->refcount)) | ||
| 114 | complete(&cq->free); | ||
| 115 | } | ||
| 116 | |||
| 117 | static int mlx4_SW2HW_CQ(struct mlx4_dev *dev, struct mlx4_cmd_mailbox *mailbox, | ||
| 118 | int cq_num) | ||
| 119 | { | ||
| 120 | return mlx4_cmd(dev, mailbox->dma, cq_num, 0, MLX4_CMD_SW2HW_CQ, | ||
| 121 | MLX4_CMD_TIME_CLASS_A); | ||
| 122 | } | ||
| 123 | |||
| 124 | static int mlx4_HW2SW_CQ(struct mlx4_dev *dev, struct mlx4_cmd_mailbox *mailbox, | ||
| 125 | int cq_num) | ||
| 126 | { | ||
| 127 | return mlx4_cmd_box(dev, 0, mailbox ? mailbox->dma : 0, cq_num, | ||
| 128 | mailbox ? 0 : 1, MLX4_CMD_HW2SW_CQ, | ||
| 129 | MLX4_CMD_TIME_CLASS_A); | ||
| 130 | } | ||
| 131 | |||
| 132 | int mlx4_cq_alloc(struct mlx4_dev *dev, int nent, struct mlx4_mtt *mtt, | ||
| 133 | struct mlx4_uar *uar, u64 db_rec, struct mlx4_cq *cq) | ||
| 134 | { | ||
| 135 | struct mlx4_priv *priv = mlx4_priv(dev); | ||
| 136 | struct mlx4_cq_table *cq_table = &priv->cq_table; | ||
| 137 | struct mlx4_cmd_mailbox *mailbox; | ||
| 138 | struct mlx4_cq_context *cq_context; | ||
| 139 | u64 mtt_addr; | ||
| 140 | int err; | ||
| 141 | |||
| 142 | cq->cqn = mlx4_bitmap_alloc(&cq_table->bitmap); | ||
| 143 | if (cq->cqn == -1) | ||
| 144 | return -ENOMEM; | ||
| 145 | |||
| 146 | err = mlx4_table_get(dev, &cq_table->table, cq->cqn); | ||
| 147 | if (err) | ||
| 148 | goto err_out; | ||
| 149 | |||
| 150 | err = mlx4_table_get(dev, &cq_table->cmpt_table, cq->cqn); | ||
| 151 | if (err) | ||
| 152 | goto err_put; | ||
| 153 | |||
| 154 | spin_lock_irq(&cq_table->lock); | ||
| 155 | err = radix_tree_insert(&cq_table->tree, cq->cqn, cq); | ||
| 156 | spin_unlock_irq(&cq_table->lock); | ||
| 157 | if (err) | ||
| 158 | goto err_cmpt_put; | ||
| 159 | |||
| 160 | mailbox = mlx4_alloc_cmd_mailbox(dev); | ||
| 161 | if (IS_ERR(mailbox)) { | ||
| 162 | err = PTR_ERR(mailbox); | ||
| 163 | goto err_radix; | ||
| 164 | } | ||
| 165 | |||
| 166 | cq_context = mailbox->buf; | ||
| 167 | memset(cq_context, 0, sizeof *cq_context); | ||
| 168 | |||
| 169 | cq_context->logsize_usrpage = cpu_to_be32((ilog2(nent) << 24) | uar->index); | ||
| 170 | cq_context->comp_eqn = priv->eq_table.eq[MLX4_EQ_COMP].eqn; | ||
| 171 | cq_context->log_page_size = mtt->page_shift - MLX4_ICM_PAGE_SHIFT; | ||
| 172 | |||
| 173 | mtt_addr = mlx4_mtt_addr(dev, mtt); | ||
| 174 | cq_context->mtt_base_addr_h = mtt_addr >> 32; | ||
| 175 | cq_context->mtt_base_addr_l = cpu_to_be32(mtt_addr & 0xffffffff); | ||
| 176 | cq_context->db_rec_addr = cpu_to_be64(db_rec); | ||
| 177 | |||
| 178 | err = mlx4_SW2HW_CQ(dev, mailbox, cq->cqn); | ||
| 179 | mlx4_free_cmd_mailbox(dev, mailbox); | ||
| 180 | if (err) | ||
| 181 | goto err_radix; | ||
| 182 | |||
| 183 | cq->cons_index = 0; | ||
| 184 | cq->arm_sn = 1; | ||
| 185 | cq->uar = uar; | ||
| 186 | atomic_set(&cq->refcount, 1); | ||
| 187 | init_completion(&cq->free); | ||
| 188 | |||
| 189 | return 0; | ||
| 190 | |||
| 191 | err_radix: | ||
| 192 | spin_lock_irq(&cq_table->lock); | ||
| 193 | radix_tree_delete(&cq_table->tree, cq->cqn); | ||
| 194 | spin_unlock_irq(&cq_table->lock); | ||
| 195 | |||
| 196 | err_cmpt_put: | ||
| 197 | mlx4_table_put(dev, &cq_table->cmpt_table, cq->cqn); | ||
| 198 | |||
| 199 | err_put: | ||
| 200 | mlx4_table_put(dev, &cq_table->table, cq->cqn); | ||
| 201 | |||
| 202 | err_out: | ||
| 203 | mlx4_bitmap_free(&cq_table->bitmap, cq->cqn); | ||
| 204 | |||
| 205 | return err; | ||
| 206 | } | ||
| 207 | EXPORT_SYMBOL_GPL(mlx4_cq_alloc); | ||
| 208 | |||
| 209 | void mlx4_cq_free(struct mlx4_dev *dev, struct mlx4_cq *cq) | ||
| 210 | { | ||
| 211 | struct mlx4_priv *priv = mlx4_priv(dev); | ||
| 212 | struct mlx4_cq_table *cq_table = &priv->cq_table; | ||
| 213 | int err; | ||
| 214 | |||
| 215 | err = mlx4_HW2SW_CQ(dev, NULL, cq->cqn); | ||
| 216 | if (err) | ||
| 217 | mlx4_warn(dev, "HW2SW_CQ failed (%d) for CQN %06x\n", err, cq->cqn); | ||
| 218 | |||
| 219 | synchronize_irq(priv->eq_table.eq[MLX4_EQ_COMP].irq); | ||
| 220 | |||
| 221 | spin_lock_irq(&cq_table->lock); | ||
| 222 | radix_tree_delete(&cq_table->tree, cq->cqn); | ||
| 223 | spin_unlock_irq(&cq_table->lock); | ||
| 224 | |||
| 225 | if (atomic_dec_and_test(&cq->refcount)) | ||
| 226 | complete(&cq->free); | ||
| 227 | wait_for_completion(&cq->free); | ||
| 228 | |||
| 229 | mlx4_table_put(dev, &cq_table->table, cq->cqn); | ||
| 230 | mlx4_bitmap_free(&cq_table->bitmap, cq->cqn); | ||
| 231 | } | ||
| 232 | EXPORT_SYMBOL_GPL(mlx4_cq_free); | ||
| 233 | |||
| 234 | int __devinit mlx4_init_cq_table(struct mlx4_dev *dev) | ||
| 235 | { | ||
| 236 | struct mlx4_cq_table *cq_table = &mlx4_priv(dev)->cq_table; | ||
| 237 | int err; | ||
| 238 | |||
| 239 | spin_lock_init(&cq_table->lock); | ||
| 240 | INIT_RADIX_TREE(&cq_table->tree, GFP_ATOMIC); | ||
| 241 | |||
| 242 | err = mlx4_bitmap_init(&cq_table->bitmap, dev->caps.num_cqs, | ||
| 243 | dev->caps.num_cqs - 1, dev->caps.reserved_cqs); | ||
| 244 | if (err) | ||
| 245 | return err; | ||
| 246 | |||
| 247 | return 0; | ||
| 248 | } | ||
| 249 | |||
| 250 | void mlx4_cleanup_cq_table(struct mlx4_dev *dev) | ||
| 251 | { | ||
| 252 | /* Nothing to do to clean up radix_tree */ | ||
| 253 | mlx4_bitmap_cleanup(&mlx4_priv(dev)->cq_table.bitmap); | ||
| 254 | } | ||
diff --git a/drivers/net/mlx4/eq.c b/drivers/net/mlx4/eq.c new file mode 100644 index 000000000000..acf1c801a1b8 --- /dev/null +++ b/drivers/net/mlx4/eq.c | |||
| @@ -0,0 +1,696 @@ | |||
| 1 | /* | ||
| 2 | * Copyright (c) 2005 Mellanox Technologies. All rights reserved. | ||
| 3 | * Copyright (c) 2005, 2006, 2007 Cisco Systems, 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 | |||
| 34 | #include <linux/init.h> | ||
| 35 | #include <linux/interrupt.h> | ||
| 36 | |||
| 37 | #include <linux/mlx4/cmd.h> | ||
| 38 | |||
| 39 | #include "mlx4.h" | ||
| 40 | #include "fw.h" | ||
| 41 | |||
| 42 | enum { | ||
| 43 | MLX4_NUM_ASYNC_EQE = 0x100, | ||
| 44 | MLX4_NUM_SPARE_EQE = 0x80, | ||
| 45 | MLX4_EQ_ENTRY_SIZE = 0x20 | ||
| 46 | }; | ||
| 47 | |||
| 48 | /* | ||
| 49 | * Must be packed because start is 64 bits but only aligned to 32 bits. | ||
| 50 | */ | ||
| 51 | struct mlx4_eq_context { | ||
| 52 | __be32 flags; | ||
| 53 | u16 reserved1[3]; | ||
| 54 | __be16 page_offset; | ||
| 55 | u8 log_eq_size; | ||
| 56 | u8 reserved2[4]; | ||
| 57 | u8 eq_period; | ||
| 58 | u8 reserved3; | ||
| 59 | u8 eq_max_count; | ||
| 60 | u8 reserved4[3]; | ||
| 61 | u8 intr; | ||
| 62 | u8 log_page_size; | ||
| 63 | u8 reserved5[2]; | ||
| 64 | u8 mtt_base_addr_h; | ||
| 65 | __be32 mtt_base_addr_l; | ||
| 66 | u32 reserved6[2]; | ||
| 67 | __be32 consumer_index; | ||
| 68 | __be32 producer_index; | ||
| 69 | u32 reserved7[4]; | ||
| 70 | }; | ||
| 71 | |||
| 72 | #define MLX4_EQ_STATUS_OK ( 0 << 28) | ||
| 73 | #define MLX4_EQ_STATUS_WRITE_FAIL (10 << 28) | ||
| 74 | #define MLX4_EQ_OWNER_SW ( 0 << 24) | ||
| 75 | #define MLX4_EQ_OWNER_HW ( 1 << 24) | ||
| 76 | #define MLX4_EQ_FLAG_EC ( 1 << 18) | ||
| 77 | #define MLX4_EQ_FLAG_OI ( 1 << 17) | ||
| 78 | #define MLX4_EQ_STATE_ARMED ( 9 << 8) | ||
| 79 | #define MLX4_EQ_STATE_FIRED (10 << 8) | ||
| 80 | #define MLX4_EQ_STATE_ALWAYS_ARMED (11 << 8) | ||
| 81 | |||
| 82 | #define MLX4_ASYNC_EVENT_MASK ((1ull << MLX4_EVENT_TYPE_PATH_MIG) | \ | ||
| 83 | (1ull << MLX4_EVENT_TYPE_COMM_EST) | \ | ||
| 84 | (1ull << MLX4_EVENT_TYPE_SQ_DRAINED) | \ | ||
| 85 | (1ull << MLX4_EVENT_TYPE_CQ_ERROR) | \ | ||
| 86 | (1ull << MLX4_EVENT_TYPE_WQ_CATAS_ERROR) | \ | ||
| 87 | (1ull << MLX4_EVENT_TYPE_EEC_CATAS_ERROR) | \ | ||
| 88 | (1ull << MLX4_EVENT_TYPE_PATH_MIG_FAILED) | \ | ||
| 89 | (1ull << MLX4_EVENT_TYPE_WQ_INVAL_REQ_ERROR) | \ | ||
| 90 | (1ull << MLX4_EVENT_TYPE_WQ_ACCESS_ERROR) | \ | ||
| 91 | (1ull << MLX4_EVENT_TYPE_LOCAL_CATAS_ERROR) | \ | ||
| 92 | (1ull << MLX4_EVENT_TYPE_PORT_CHANGE) | \ | ||
| 93 | (1ull << MLX4_EVENT_TYPE_ECC_DETECT) | \ | ||
| 94 | (1ull << MLX4_EVENT_TYPE_SRQ_CATAS_ERROR) | \ | ||
| 95 | (1ull << MLX4_EVENT_TYPE_SRQ_QP_LAST_WQE) | \ | ||
| 96 | (1ull << MLX4_EVENT_TYPE_SRQ_LIMIT) | \ | ||
| 97 | (1ull << MLX4_EVENT_TYPE_CMD)) | ||
| 98 | #define MLX4_CATAS_EVENT_MASK (1ull << MLX4_EVENT_TYPE_LOCAL_CATAS_ERROR) | ||
| 99 | |||
| 100 | struct mlx4_eqe { | ||
| 101 | u8 reserved1; | ||
| 102 | u8 type; | ||
| 103 | u8 reserved2; | ||
| 104 | u8 subtype; | ||
| 105 | union { | ||
| 106 | u32 raw[6]; | ||
| 107 | struct { | ||
| 108 | __be32 cqn; | ||
| 109 | } __attribute__((packed)) comp; | ||
| 110 | struct { | ||
| 111 | u16 reserved1; | ||
| 112 | __be16 token; | ||
| 113 | u32 reserved2; | ||
| 114 | u8 reserved3[3]; | ||
| 115 | u8 status; | ||
| 116 | __be64 out_param; | ||
| 117 | } __attribute__((packed)) cmd; | ||
| 118 | struct { | ||
| 119 | __be32 qpn; | ||
| 120 | } __attribute__((packed)) qp; | ||
| 121 | struct { | ||
| 122 | __be32 srqn; | ||
| 123 | } __attribute__((packed)) srq; | ||
| 124 | struct { | ||
| 125 | __be32 cqn; | ||
| 126 | u32 reserved1; | ||
| 127 | u8 reserved2[3]; | ||
| 128 | u8 syndrome; | ||
| 129 | } __attribute__((packed)) cq_err; | ||
| 130 | struct { | ||
| 131 | u32 reserved1[2]; | ||
| 132 | __be32 port; | ||
| 133 | } __attribute__((packed)) port_change; | ||
| 134 | } event; | ||
| 135 | u8 reserved3[3]; | ||
| 136 | u8 owner; | ||
| 137 | } __attribute__((packed)); | ||
| 138 | |||
| 139 | static void eq_set_ci(struct mlx4_eq *eq, int req_not) | ||
| 140 | { | ||
| 141 | __raw_writel((__force u32) cpu_to_be32((eq->cons_index & 0xffffff) | | ||
| 142 | req_not << 31), | ||
| 143 | eq->doorbell); | ||
| 144 | /* We still want ordering, just not swabbing, so add a barrier */ | ||
| 145 | mb(); | ||
| 146 | } | ||
| 147 | |||
| 148 | static struct mlx4_eqe *get_eqe(struct mlx4_eq *eq, u32 entry) | ||
| 149 | { | ||
| 150 | unsigned long off = (entry & (eq->nent - 1)) * MLX4_EQ_ENTRY_SIZE; | ||
| 151 | return eq->page_list[off / PAGE_SIZE].buf + off % PAGE_SIZE; | ||
| 152 | } | ||
| 153 | |||
| 154 | static struct mlx4_eqe *next_eqe_sw(struct mlx4_eq *eq) | ||
| 155 | { | ||
| 156 | struct mlx4_eqe *eqe = get_eqe(eq, eq->cons_index); | ||
| 157 | return !!(eqe->owner & 0x80) ^ !!(eq->cons_index & eq->nent) ? NULL : eqe; | ||
| 158 | } | ||
| 159 | |||
| 160 | static int mlx4_eq_int(struct mlx4_dev *dev, struct mlx4_eq *eq) | ||
| 161 | { | ||
| 162 | struct mlx4_eqe *eqe; | ||
| 163 | int cqn; | ||
| 164 | int eqes_found = 0; | ||
| 165 | int set_ci = 0; | ||
| 166 | |||
| 167 | while ((eqe = next_eqe_sw(eq))) { | ||
| 168 | /* | ||
| 169 | * Make sure we read EQ entry contents after we've | ||
| 170 | * checked the ownership bit. | ||
| 171 | */ | ||
| 172 | rmb(); | ||
| 173 | |||
| 174 | switch (eqe->type) { | ||
| 175 | case MLX4_EVENT_TYPE_COMP: | ||
| 176 | cqn = be32_to_cpu(eqe->event.comp.cqn) & 0xffffff; | ||
| 177 | mlx4_cq_completion(dev, cqn); | ||
| 178 | break; | ||
| 179 | |||
| 180 | case MLX4_EVENT_TYPE_PATH_MIG: | ||
| 181 | case MLX4_EVENT_TYPE_COMM_EST: | ||
| 182 | case MLX4_EVENT_TYPE_SQ_DRAINED: | ||
| 183 | case MLX4_EVENT_TYPE_SRQ_QP_LAST_WQE: | ||
| 184 | case MLX4_EVENT_TYPE_WQ_CATAS_ERROR: | ||
| 185 | case MLX4_EVENT_TYPE_PATH_MIG_FAILED: | ||
| 186 | case MLX4_EVENT_TYPE_WQ_INVAL_REQ_ERROR: | ||
| 187 | case MLX4_EVENT_TYPE_WQ_ACCESS_ERROR: | ||
| 188 | mlx4_qp_event(dev, be32_to_cpu(eqe->event.qp.qpn) & 0xffffff, | ||
| 189 | eqe->type); | ||
| 190 | break; | ||
| 191 | |||
| 192 | case MLX4_EVENT_TYPE_SRQ_LIMIT: | ||
| 193 | case MLX4_EVENT_TYPE_SRQ_CATAS_ERROR: | ||
| 194 | mlx4_srq_event(dev, be32_to_cpu(eqe->event.srq.srqn) & 0xffffff, | ||
| 195 | eqe->type); | ||
| 196 | break; | ||
| 197 | |||
| 198 | case MLX4_EVENT_TYPE_CMD: | ||
| 199 | mlx4_cmd_event(dev, | ||
| 200 | be16_to_cpu(eqe->event.cmd.token), | ||
| 201 | eqe->event.cmd.status, | ||
| 202 | be64_to_cpu(eqe->event.cmd.out_param)); | ||
| 203 | break; | ||
| 204 | |||
| 205 | case MLX4_EVENT_TYPE_PORT_CHANGE: | ||
| 206 | mlx4_dispatch_event(dev, eqe->type, eqe->subtype, | ||
| 207 | be32_to_cpu(eqe->event.port_change.port) >> 28); | ||
| 208 | break; | ||
| 209 | |||
| 210 | case MLX4_EVENT_TYPE_CQ_ERROR: | ||
| 211 | mlx4_warn(dev, "CQ %s on CQN %06x\n", | ||
| 212 | eqe->event.cq_err.syndrome == 1 ? | ||
| 213 | "overrun" : "access violation", | ||
| 214 | be32_to_cpu(eqe->event.cq_err.cqn) & 0xffffff); | ||
| 215 | mlx4_cq_event(dev, be32_to_cpu(eqe->event.cq_err.cqn), | ||
| 216 | eqe->type); | ||
| 217 | break; | ||
| 218 | |||
| 219 | case MLX4_EVENT_TYPE_EQ_OVERFLOW: | ||
| 220 | mlx4_warn(dev, "EQ overrun on EQN %d\n", eq->eqn); | ||
| 221 | break; | ||
| 222 | |||
| 223 | case MLX4_EVENT_TYPE_EEC_CATAS_ERROR: | ||
| 224 | case MLX4_EVENT_TYPE_ECC_DETECT: | ||
| 225 | default: | ||
| 226 | mlx4_warn(dev, "Unhandled event %02x(%02x) on EQ %d at index %u\n", | ||
| 227 | eqe->type, eqe->subtype, eq->eqn, eq->cons_index); | ||
| 228 | break; | ||
| 229 | }; | ||
| 230 | |||
| 231 | ++eq->cons_index; | ||
| 232 | eqes_found = 1; | ||
| 233 | ++set_ci; | ||
| 234 | |||
| 235 | /* | ||
| 236 | * The HCA will think the queue has overflowed if we | ||
| 237 | * don't tell it we've been processing events. We | ||
| 238 | * create our EQs with MLX4_NUM_SPARE_EQE extra | ||
| 239 | * entries, so we must update our consumer index at | ||
| 240 | * least that often. | ||
| 241 | */ | ||
| 242 | if (unlikely(set_ci >= MLX4_NUM_SPARE_EQE)) { | ||
| 243 | /* | ||
| 244 | * Conditional on hca_type is OK here because | ||
| 245 | * this is a rare case, not the fast path. | ||
| 246 | */ | ||
| 247 | eq_set_ci(eq, 0); | ||
| 248 | set_ci = 0; | ||
| 249 | } | ||
| 250 | } | ||
| 251 | |||
| 252 | eq_set_ci(eq, 1); | ||
| 253 | |||
| 254 | return eqes_found; | ||
| 255 | } | ||
| 256 | |||
| 257 | static irqreturn_t mlx4_interrupt(int irq, void *dev_ptr) | ||
| 258 | { | ||
| 259 | struct mlx4_dev *dev = dev_ptr; | ||
| 260 | struct mlx4_priv *priv = mlx4_priv(dev); | ||
| 261 | int work = 0; | ||
| 262 | int i; | ||
| 263 | |||
| 264 | writel(priv->eq_table.clr_mask, priv->eq_table.clr_int); | ||
| 265 | |||
| 266 | for (i = 0; i < MLX4_EQ_CATAS; ++i) | ||
| 267 | work |= mlx4_eq_int(dev, &priv->eq_table.eq[i]); | ||
| 268 | |||
| 269 | return IRQ_RETVAL(work); | ||
| 270 | } | ||
| 271 | |||
| 272 | static irqreturn_t mlx4_msi_x_interrupt(int irq, void *eq_ptr) | ||
| 273 | { | ||
| 274 | struct mlx4_eq *eq = eq_ptr; | ||
| 275 | struct mlx4_dev *dev = eq->dev; | ||
| 276 | |||
| 277 | mlx4_eq_int(dev, eq); | ||
| 278 | |||
| 279 | /* MSI-X vectors always belong to us */ | ||
| 280 | return IRQ_HANDLED; | ||
| 281 | } | ||
| 282 | |||
| 283 | static irqreturn_t mlx4_catas_interrupt(int irq, void *dev_ptr) | ||
| 284 | { | ||
| 285 | mlx4_handle_catas_err(dev_ptr); | ||
| 286 | |||
| 287 | /* MSI-X vectors always belong to us */ | ||
| 288 | return IRQ_HANDLED; | ||
| 289 | } | ||
| 290 | |||
| 291 | static int mlx4_MAP_EQ(struct mlx4_dev *dev, u64 event_mask, int unmap, | ||
| 292 | int eq_num) | ||
| 293 | { | ||
| 294 | return mlx4_cmd(dev, event_mask, (unmap << 31) | eq_num, | ||
| 295 | 0, MLX4_CMD_MAP_EQ, MLX4_CMD_TIME_CLASS_B); | ||
| 296 | } | ||
| 297 | |||
| 298 | static int mlx4_SW2HW_EQ(struct mlx4_dev *dev, struct mlx4_cmd_mailbox *mailbox, | ||
| 299 | int eq_num) | ||
| 300 | { | ||
| 301 | return mlx4_cmd(dev, mailbox->dma, eq_num, 0, MLX4_CMD_SW2HW_EQ, | ||
| 302 | MLX4_CMD_TIME_CLASS_A); | ||
| 303 | } | ||
| 304 | |||
| 305 | static int mlx4_HW2SW_EQ(struct mlx4_dev *dev, struct mlx4_cmd_mailbox *mailbox, | ||
| 306 | int eq_num) | ||
| 307 | { | ||
| 308 | return mlx4_cmd_box(dev, 0, mailbox->dma, eq_num, 0, MLX4_CMD_HW2SW_EQ, | ||
| 309 | MLX4_CMD_TIME_CLASS_A); | ||
| 310 | } | ||
| 311 | |||
| 312 | static void __devinit __iomem *mlx4_get_eq_uar(struct mlx4_dev *dev, | ||
| 313 | struct mlx4_eq *eq) | ||
| 314 | { | ||
| 315 | struct mlx4_priv *priv = mlx4_priv(dev); | ||
| 316 | int index; | ||
| 317 | |||
| 318 | index = eq->eqn / 4 - dev->caps.reserved_eqs / 4; | ||
| 319 | |||
| 320 | if (!priv->eq_table.uar_map[index]) { | ||
| 321 | priv->eq_table.uar_map[index] = | ||
| 322 | ioremap(pci_resource_start(dev->pdev, 2) + | ||
| 323 | ((eq->eqn / 4) << PAGE_SHIFT), | ||
| 324 | PAGE_SIZE); | ||
| 325 | if (!priv->eq_table.uar_map[index]) { | ||
| 326 | mlx4_err(dev, "Couldn't map EQ doorbell for EQN 0x%06x\n", | ||
| 327 | eq->eqn); | ||
| 328 | return NULL; | ||
| 329 | } | ||
| 330 | } | ||
| 331 | |||
| 332 | return priv->eq_table.uar_map[index] + 0x800 + 8 * (eq->eqn % 4); | ||
| 333 | } | ||
| 334 | |||
| 335 | static int __devinit mlx4_create_eq(struct mlx4_dev *dev, int nent, | ||
| 336 | u8 intr, struct mlx4_eq *eq) | ||
| 337 | { | ||
| 338 | struct mlx4_priv *priv = mlx4_priv(dev); | ||
| 339 | struct mlx4_cmd_mailbox *mailbox; | ||
| 340 | struct mlx4_eq_context *eq_context; | ||
| 341 | int npages; | ||
| 342 | u64 *dma_list = NULL; | ||
| 343 | dma_addr_t t; | ||
| 344 | u64 mtt_addr; | ||
| 345 | int err = -ENOMEM; | ||
| 346 | int i; | ||
| 347 | |||
| 348 | eq->dev = dev; | ||
| 349 | eq->nent = roundup_pow_of_two(max(nent, 2)); | ||
| 350 | npages = PAGE_ALIGN(eq->nent * MLX4_EQ_ENTRY_SIZE) / PAGE_SIZE; | ||
| 351 | |||
| 352 | eq->page_list = kmalloc(npages * sizeof *eq->page_list, | ||
| 353 | GFP_KERNEL); | ||
| 354 | if (!eq->page_list) | ||
| 355 | goto err_out; | ||
| 356 | |||
| 357 | for (i = 0; i < npages; ++i) | ||
| 358 | eq->page_list[i].buf = NULL; | ||
| 359 | |||
| 360 | dma_list = kmalloc(npages * sizeof *dma_list, GFP_KERNEL); | ||
| 361 | if (!dma_list) | ||
| 362 | goto err_out_free; | ||
| 363 | |||
| 364 | mailbox = mlx4_alloc_cmd_mailbox(dev); | ||
| 365 | if (IS_ERR(mailbox)) | ||
| 366 | goto err_out_free; | ||
| 367 | eq_context = mailbox->buf; | ||
| 368 | |||
| 369 | for (i = 0; i < npages; ++i) { | ||
| 370 | eq->page_list[i].buf = dma_alloc_coherent(&dev->pdev->dev, | ||
| 371 | PAGE_SIZE, &t, GFP_KERNEL); | ||
| 372 | if (!eq->page_list[i].buf) | ||
| 373 | goto err_out_free_pages; | ||
| 374 | |||
| 375 | dma_list[i] = t; | ||
| 376 | eq->page_list[i].map = t; | ||
| 377 | |||
| 378 | memset(eq->page_list[i].buf, 0, PAGE_SIZE); | ||
| 379 | } | ||
| 380 | |||
| 381 | eq->eqn = mlx4_bitmap_alloc(&priv->eq_table.bitmap); | ||
| 382 | if (eq->eqn == -1) | ||
| 383 | goto err_out_free_pages; | ||
| 384 | |||
| 385 | eq->doorbell = mlx4_get_eq_uar(dev, eq); | ||
| 386 | if (!eq->doorbell) { | ||
| 387 | err = -ENOMEM; | ||
| 388 | goto err_out_free_eq; | ||
| 389 | } | ||
| 390 | |||
| 391 | err = mlx4_mtt_init(dev, npages, PAGE_SHIFT, &eq->mtt); | ||
| 392 | if (err) | ||
| 393 | goto err_out_free_eq; | ||
| 394 | |||
| 395 | err = mlx4_write_mtt(dev, &eq->mtt, 0, npages, dma_list); | ||
| 396 | if (err) | ||
| 397 | goto err_out_free_mtt; | ||
| 398 | |||
| 399 | memset(eq_context, 0, sizeof *eq_context); | ||
| 400 | eq_context->flags = cpu_to_be32(MLX4_EQ_STATUS_OK | | ||
| 401 | MLX4_EQ_STATE_ARMED); | ||
| 402 | eq_context->log_eq_size = ilog2(eq->nent); | ||
| 403 | eq_context->intr = intr; | ||
| 404 | eq_context->log_page_size = PAGE_SHIFT - MLX4_ICM_PAGE_SHIFT; | ||
| 405 | |||
| 406 | mtt_addr = mlx4_mtt_addr(dev, &eq->mtt); | ||
| 407 | eq_context->mtt_base_addr_h = mtt_addr >> 32; | ||
| 408 | eq_context->mtt_base_addr_l = cpu_to_be32(mtt_addr & 0xffffffff); | ||
| 409 | |||
| 410 | err = mlx4_SW2HW_EQ(dev, mailbox, eq->eqn); | ||
| 411 | if (err) { | ||
| 412 | mlx4_warn(dev, "SW2HW_EQ failed (%d)\n", err); | ||
| 413 | goto err_out_free_mtt; | ||
| 414 | } | ||
| 415 | |||
| 416 | kfree(dma_list); | ||
| 417 | mlx4_free_cmd_mailbox(dev, mailbox); | ||
| 418 | |||
| 419 | eq->cons_index = 0; | ||
| 420 | |||
| 421 | return err; | ||
| 422 | |||
| 423 | err_out_free_mtt: | ||
| 424 | mlx4_mtt_cleanup(dev, &eq->mtt); | ||
| 425 | |||
| 426 | err_out_free_eq: | ||
| 427 | mlx4_bitmap_free(&priv->eq_table.bitmap, eq->eqn); | ||
| 428 | |||
| 429 | err_out_free_pages: | ||
| 430 | for (i = 0; i < npages; ++i) | ||
| 431 | if (eq->page_list[i].buf) | ||
| 432 | dma_free_coherent(&dev->pdev->dev, PAGE_SIZE, | ||
| 433 | eq->page_list[i].buf, | ||
| 434 | eq->page_list[i].map); | ||
| 435 | |||
| 436 | mlx4_free_cmd_mailbox(dev, mailbox); | ||
| 437 | |||
| 438 | err_out_free: | ||
| 439 | kfree(eq->page_list); | ||
| 440 | kfree(dma_list); | ||
| 441 | |||
| 442 | err_out: | ||
| 443 | return err; | ||
| 444 | } | ||
| 445 | |||
| 446 | static void mlx4_free_eq(struct mlx4_dev *dev, | ||
| 447 | struct mlx4_eq *eq) | ||
| 448 | { | ||
| 449 | struct mlx4_priv *priv = mlx4_priv(dev); | ||
| 450 | struct mlx4_cmd_mailbox *mailbox; | ||
| 451 | int err; | ||
| 452 | int npages = PAGE_ALIGN(MLX4_EQ_ENTRY_SIZE * eq->nent) / PAGE_SIZE; | ||
| 453 | int i; | ||
| 454 | |||
| 455 | mailbox = mlx4_alloc_cmd_mailbox(dev); | ||
| 456 | if (IS_ERR(mailbox)) | ||
| 457 | return; | ||
| 458 | |||
| 459 | err = mlx4_HW2SW_EQ(dev, mailbox, eq->eqn); | ||
| 460 | if (err) | ||
| 461 | mlx4_warn(dev, "HW2SW_EQ failed (%d)\n", err); | ||
| 462 | |||
| 463 | if (0) { | ||
| 464 | mlx4_dbg(dev, "Dumping EQ context %02x:\n", eq->eqn); | ||
| 465 | for (i = 0; i < sizeof (struct mlx4_eq_context) / 4; ++i) { | ||
| 466 | if (i % 4 == 0) | ||
| 467 | printk("[%02x] ", i * 4); | ||
| 468 | printk(" %08x", be32_to_cpup(mailbox->buf + i * 4)); | ||
| 469 | if ((i + 1) % 4 == 0) | ||
| 470 | printk("\n"); | ||
| 471 | } | ||
| 472 | } | ||
| 473 | |||
| 474 | mlx4_mtt_cleanup(dev, &eq->mtt); | ||
| 475 | for (i = 0; i < npages; ++i) | ||
| 476 | pci_free_consistent(dev->pdev, PAGE_SIZE, | ||
| 477 | eq->page_list[i].buf, | ||
| 478 | eq->page_list[i].map); | ||
| 479 | |||
| 480 | kfree(eq->page_list); | ||
| 481 | mlx4_bitmap_free(&priv->eq_table.bitmap, eq->eqn); | ||
| 482 | mlx4_free_cmd_mailbox(dev, mailbox); | ||
| 483 | } | ||
| 484 | |||
| 485 | static void mlx4_free_irqs(struct mlx4_dev *dev) | ||
| 486 | { | ||
| 487 | struct mlx4_eq_table *eq_table = &mlx4_priv(dev)->eq_table; | ||
| 488 | int i; | ||
| 489 | |||
| 490 | if (eq_table->have_irq) | ||
| 491 | free_irq(dev->pdev->irq, dev); | ||
| 492 | for (i = 0; i < MLX4_NUM_EQ; ++i) | ||
| 493 | if (eq_table->eq[i].have_irq) | ||
| 494 | free_irq(eq_table->eq[i].irq, eq_table->eq + i); | ||
| 495 | } | ||
| 496 | |||
| 497 | static int __devinit mlx4_map_clr_int(struct mlx4_dev *dev) | ||
| 498 | { | ||
| 499 | struct mlx4_priv *priv = mlx4_priv(dev); | ||
| 500 | |||
| 501 | priv->clr_base = ioremap(pci_resource_start(dev->pdev, priv->fw.clr_int_bar) + | ||
| 502 | priv->fw.clr_int_base, MLX4_CLR_INT_SIZE); | ||
| 503 | if (!priv->clr_base) { | ||
| 504 | mlx4_err(dev, "Couldn't map interrupt clear register, aborting.\n"); | ||
| 505 | return -ENOMEM; | ||
| 506 | } | ||
| 507 | |||
| 508 | return 0; | ||
| 509 | } | ||
| 510 | |||
| 511 | static void mlx4_unmap_clr_int(struct mlx4_dev *dev) | ||
| 512 | { | ||
| 513 | struct mlx4_priv *priv = mlx4_priv(dev); | ||
| 514 | |||
| 515 | iounmap(priv->clr_base); | ||
| 516 | } | ||
| 517 | |||
| 518 | int __devinit mlx4_map_eq_icm(struct mlx4_dev *dev, u64 icm_virt) | ||
| 519 | { | ||
| 520 | struct mlx4_priv *priv = mlx4_priv(dev); | ||
| 521 | int ret; | ||
| 522 | |||
| 523 | /* | ||
| 524 | * We assume that mapping one page is enough for the whole EQ | ||
| 525 | * context table. This is fine with all current HCAs, because | ||
| 526 | * we only use 32 EQs and each EQ uses 64 bytes of context | ||
| 527 | * memory, or 1 KB total. | ||
| 528 | */ | ||
| 529 | priv->eq_table.icm_virt = icm_virt; | ||
| 530 | priv->eq_table.icm_page = alloc_page(GFP_HIGHUSER); | ||
| 531 | if (!priv->eq_table.icm_page) | ||
| 532 | return -ENOMEM; | ||
| 533 | priv->eq_table.icm_dma = pci_map_page(dev->pdev, priv->eq_table.icm_page, 0, | ||
| 534 | PAGE_SIZE, PCI_DMA_BIDIRECTIONAL); | ||
| 535 | if (pci_dma_mapping_error(priv->eq_table.icm_dma)) { | ||
| 536 | __free_page(priv->eq_table.icm_page); | ||
| 537 | return -ENOMEM; | ||
| 538 | } | ||
| 539 | |||
| 540 | ret = mlx4_MAP_ICM_page(dev, priv->eq_table.icm_dma, icm_virt); | ||
| 541 | if (ret) { | ||
| 542 | pci_unmap_page(dev->pdev, priv->eq_table.icm_dma, PAGE_SIZE, | ||
| 543 | PCI_DMA_BIDIRECTIONAL); | ||
| 544 | __free_page(priv->eq_table.icm_page); | ||
| 545 | } | ||
| 546 | |||
| 547 | return ret; | ||
| 548 | } | ||
| 549 | |||
| 550 | void mlx4_unmap_eq_icm(struct mlx4_dev *dev) | ||
| 551 | { | ||
| 552 | struct mlx4_priv *priv = mlx4_priv(dev); | ||
| 553 | |||
| 554 | mlx4_UNMAP_ICM(dev, priv->eq_table.icm_virt, 1); | ||
| 555 | pci_unmap_page(dev->pdev, priv->eq_table.icm_dma, PAGE_SIZE, | ||
| 556 | PCI_DMA_BIDIRECTIONAL); | ||
| 557 | __free_page(priv->eq_table.icm_page); | ||
| 558 | } | ||
| 559 | |||
| 560 | int __devinit mlx4_init_eq_table(struct mlx4_dev *dev) | ||
| 561 | { | ||
| 562 | struct mlx4_priv *priv = mlx4_priv(dev); | ||
| 563 | int err; | ||
| 564 | int i; | ||
| 565 | |||
| 566 | err = mlx4_bitmap_init(&priv->eq_table.bitmap, dev->caps.num_eqs, | ||
| 567 | dev->caps.num_eqs - 1, dev->caps.reserved_eqs); | ||
| 568 | if (err) | ||
| 569 | return err; | ||
| 570 | |||
| 571 | for (i = 0; i < ARRAY_SIZE(priv->eq_table.uar_map); ++i) | ||
| 572 | priv->eq_table.uar_map[i] = NULL; | ||
| 573 | |||
| 574 | err = mlx4_map_clr_int(dev); | ||
| 575 | if (err) | ||
| 576 | goto err_out_free; | ||
| 577 | |||
| 578 | priv->eq_table.clr_mask = | ||
| 579 | swab32(1 << (priv->eq_table.inta_pin & 31)); | ||
| 580 | priv->eq_table.clr_int = priv->clr_base + | ||
| 581 | (priv->eq_table.inta_pin < 32 ? 4 : 0); | ||
| 582 | |||
| 583 | err = mlx4_create_eq(dev, dev->caps.num_cqs + MLX4_NUM_SPARE_EQE, | ||
| 584 | (dev->flags & MLX4_FLAG_MSI_X) ? MLX4_EQ_COMP : 0, | ||
| 585 | &priv->eq_table.eq[MLX4_EQ_COMP]); | ||
| 586 | if (err) | ||
| 587 | goto err_out_unmap; | ||
| 588 | |||
| 589 | err = mlx4_create_eq(dev, MLX4_NUM_ASYNC_EQE + MLX4_NUM_SPARE_EQE, | ||
| 590 | (dev->flags & MLX4_FLAG_MSI_X) ? MLX4_EQ_ASYNC : 0, | ||
| 591 | &priv->eq_table.eq[MLX4_EQ_ASYNC]); | ||
| 592 | if (err) | ||
| 593 | goto err_out_comp; | ||
| 594 | |||
| 595 | if (dev->flags & MLX4_FLAG_MSI_X) { | ||
| 596 | static const char *eq_name[] = { | ||
| 597 | [MLX4_EQ_COMP] = DRV_NAME " (comp)", | ||
| 598 | [MLX4_EQ_ASYNC] = DRV_NAME " (async)", | ||
| 599 | [MLX4_EQ_CATAS] = DRV_NAME " (catas)" | ||
| 600 | }; | ||
| 601 | |||
| 602 | err = mlx4_create_eq(dev, 1, MLX4_EQ_CATAS, | ||
| 603 | &priv->eq_table.eq[MLX4_EQ_CATAS]); | ||
| 604 | if (err) | ||
| 605 | goto err_out_async; | ||
| 606 | |||
| 607 | for (i = 0; i < MLX4_EQ_CATAS; ++i) { | ||
| 608 | err = request_irq(priv->eq_table.eq[i].irq, | ||
| 609 | mlx4_msi_x_interrupt, | ||
| 610 | 0, eq_name[i], priv->eq_table.eq + i); | ||
| 611 | if (err) | ||
| 612 | goto err_out_catas; | ||
| 613 | |||
| 614 | priv->eq_table.eq[i].have_irq = 1; | ||
| 615 | } | ||
| 616 | |||
| 617 | err = request_irq(priv->eq_table.eq[MLX4_EQ_CATAS].irq, | ||
| 618 | mlx4_catas_interrupt, 0, | ||
| 619 | eq_name[MLX4_EQ_CATAS], dev); | ||
| 620 | if (err) | ||
| 621 | goto err_out_catas; | ||
| 622 | |||
| 623 | priv->eq_table.eq[MLX4_EQ_CATAS].have_irq = 1; | ||
| 624 | } else { | ||
| 625 | err = request_irq(dev->pdev->irq, mlx4_interrupt, | ||
| 626 | SA_SHIRQ, DRV_NAME, dev); | ||
| 627 | if (err) | ||
| 628 | goto err_out_async; | ||
| 629 | |||
| 630 | priv->eq_table.have_irq = 1; | ||
| 631 | } | ||
| 632 | |||
| 633 | err = mlx4_MAP_EQ(dev, MLX4_ASYNC_EVENT_MASK, 0, | ||
| 634 | priv->eq_table.eq[MLX4_EQ_ASYNC].eqn); | ||
| 635 | if (err) | ||
| 636 | mlx4_warn(dev, "MAP_EQ for async EQ %d failed (%d)\n", | ||
| 637 | priv->eq_table.eq[MLX4_EQ_ASYNC].eqn, err); | ||
| 638 | |||
| 639 | for (i = 0; i < MLX4_EQ_CATAS; ++i) | ||
| 640 | eq_set_ci(&priv->eq_table.eq[i], 1); | ||
| 641 | |||
| 642 | if (dev->flags & MLX4_FLAG_MSI_X) { | ||
| 643 | err = mlx4_MAP_EQ(dev, MLX4_CATAS_EVENT_MASK, 0, | ||
| 644 | priv->eq_table.eq[MLX4_EQ_CATAS].eqn); | ||
| 645 | if (err) | ||
| 646 | mlx4_warn(dev, "MAP_EQ for catas EQ %d failed (%d)\n", | ||
| 647 | priv->eq_table.eq[MLX4_EQ_CATAS].eqn, err); | ||
| 648 | } | ||
| 649 | |||
| 650 | return 0; | ||
| 651 | |||
| 652 | err_out_catas: | ||
| 653 | mlx4_free_eq(dev, &priv->eq_table.eq[MLX4_EQ_CATAS]); | ||
| 654 | |||
| 655 | err_out_async: | ||
| 656 | mlx4_free_eq(dev, &priv->eq_table.eq[MLX4_EQ_ASYNC]); | ||
| 657 | |||
| 658 | err_out_comp: | ||
| 659 | mlx4_free_eq(dev, &priv->eq_table.eq[MLX4_EQ_COMP]); | ||
| 660 | |||
| 661 | err_out_unmap: | ||
| 662 | mlx4_unmap_clr_int(dev); | ||
| 663 | mlx4_free_irqs(dev); | ||
| 664 | |||
| 665 | err_out_free: | ||
| 666 | mlx4_bitmap_cleanup(&priv->eq_table.bitmap); | ||
| 667 | return err; | ||
| 668 | } | ||
| 669 | |||
| 670 | void mlx4_cleanup_eq_table(struct mlx4_dev *dev) | ||
| 671 | { | ||
| 672 | struct mlx4_priv *priv = mlx4_priv(dev); | ||
| 673 | int i; | ||
| 674 | |||
| 675 | if (dev->flags & MLX4_FLAG_MSI_X) | ||
| 676 | mlx4_MAP_EQ(dev, MLX4_CATAS_EVENT_MASK, 1, | ||
| 677 | priv->eq_table.eq[MLX4_EQ_CATAS].eqn); | ||
| 678 | |||
| 679 | mlx4_MAP_EQ(dev, MLX4_ASYNC_EVENT_MASK, 1, | ||
| 680 | priv->eq_table.eq[MLX4_EQ_ASYNC].eqn); | ||
| 681 | |||
| 682 | mlx4_free_irqs(dev); | ||
| 683 | |||
| 684 | for (i = 0; i < MLX4_EQ_CATAS; ++i) | ||
| 685 | mlx4_free_eq(dev, &priv->eq_table.eq[i]); | ||
| 686 | if (dev->flags & MLX4_FLAG_MSI_X) | ||
| 687 | mlx4_free_eq(dev, &priv->eq_table.eq[MLX4_EQ_CATAS]); | ||
| 688 | |||
| 689 | mlx4_unmap_clr_int(dev); | ||
| 690 | |||
| 691 | for (i = 0; i < ARRAY_SIZE(priv->eq_table.uar_map); ++i) | ||
| 692 | if (priv->eq_table.uar_map[i]) | ||
| 693 | iounmap(priv->eq_table.uar_map[i]); | ||
| 694 | |||
| 695 | mlx4_bitmap_cleanup(&priv->eq_table.bitmap); | ||
| 696 | } | ||
diff --git a/drivers/net/mlx4/fw.c b/drivers/net/mlx4/fw.c new file mode 100644 index 000000000000..c42717313663 --- /dev/null +++ b/drivers/net/mlx4/fw.c | |||
| @@ -0,0 +1,775 @@ | |||
| 1 | /* | ||
| 2 | * Copyright (c) 2004, 2005 Topspin Communications. All rights reserved. | ||
| 3 | * Copyright (c) 2005 Mellanox Technologies. All rights reserved. | ||
| 4 | * Copyright (c) 2005, 2006, 2007 Cisco Systems, Inc. All rights reserved. | ||
| 5 | * | ||
| 6 | * This software is available to you under a choice of one of two | ||
| 7 | * licenses. You may choose to be licensed under the terms of the GNU | ||
| 8 | * General Public License (GPL) Version 2, available from the file | ||
| 9 | * COPYING in the main directory of this source tree, or the | ||
| 10 | * OpenIB.org BSD license below: | ||
| 11 | * | ||
| 12 | * Redistribution and use in source and binary forms, with or | ||
| 13 | * without modification, are permitted provided that the following | ||
| 14 | * conditions are met: | ||
| 15 | * | ||
| 16 | * - Redistributions of source code must retain the above | ||
| 17 | * copyright notice, this list of conditions and the following | ||
| 18 | * disclaimer. | ||
| 19 | * | ||
| 20 | * - Redistributions in binary form must reproduce the above | ||
| 21 | * copyright notice, this list of conditions and the following | ||
| 22 | * disclaimer in the documentation and/or other materials | ||
| 23 | * provided with the distribution. | ||
| 24 | * | ||
| 25 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, | ||
| 26 | * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF | ||
| 27 | * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND | ||
| 28 | * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS | ||
| 29 | * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN | ||
| 30 | * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN | ||
| 31 | * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE | ||
| 32 | * SOFTWARE. | ||
| 33 | */ | ||
| 34 | |||
| 35 | #include <linux/mlx4/cmd.h> | ||
| 36 | |||
| 37 | #include "fw.h" | ||
| 38 | #include "icm.h" | ||
| 39 | |||
| 40 | extern void __buggy_use_of_MLX4_GET(void); | ||
| 41 | extern void __buggy_use_of_MLX4_PUT(void); | ||
| 42 | |||
| 43 | #define MLX4_GET(dest, source, offset) \ | ||
| 44 | do { \ | ||
| 45 | void *__p = (char *) (source) + (offset); \ | ||
| 46 | switch (sizeof (dest)) { \ | ||
| 47 | case 1: (dest) = *(u8 *) __p; break; \ | ||
| 48 | case 2: (dest) = be16_to_cpup(__p); break; \ | ||
| 49 | case 4: (dest) = be32_to_cpup(__p); break; \ | ||
| 50 | case 8: (dest) = be64_to_cpup(__p); break; \ | ||
| 51 | default: __buggy_use_of_MLX4_GET(); \ | ||
| 52 | } \ | ||
| 53 | } while (0) | ||
| 54 | |||
| 55 | #define MLX4_PUT(dest, source, offset) \ | ||
| 56 | do { \ | ||
| 57 | void *__d = ((char *) (dest) + (offset)); \ | ||
| 58 | switch (sizeof(source)) { \ | ||
| 59 | case 1: *(u8 *) __d = (source); break; \ | ||
| 60 | case 2: *(__be16 *) __d = cpu_to_be16(source); break; \ | ||
| 61 | case 4: *(__be32 *) __d = cpu_to_be32(source); break; \ | ||
| 62 | case 8: *(__be64 *) __d = cpu_to_be64(source); break; \ | ||
| 63 | default: __buggy_use_of_MLX4_PUT(); \ | ||
| 64 | } \ | ||
| 65 | } while (0) | ||
| 66 | |||
| 67 | static void dump_dev_cap_flags(struct mlx4_dev *dev, u32 flags) | ||
| 68 | { | ||
| 69 | static const char *fname[] = { | ||
| 70 | [ 0] = "RC transport", | ||
| 71 | [ 1] = "UC transport", | ||
| 72 | [ 2] = "UD transport", | ||
| 73 | [ 3] = "SRC transport", | ||
| 74 | [ 4] = "reliable multicast", | ||
| 75 | [ 5] = "FCoIB support", | ||
| 76 | [ 6] = "SRQ support", | ||
| 77 | [ 7] = "IPoIB checksum offload", | ||
| 78 | [ 8] = "P_Key violation counter", | ||
| 79 | [ 9] = "Q_Key violation counter", | ||
| 80 | [10] = "VMM", | ||
| 81 | [16] = "MW support", | ||
| 82 | [17] = "APM support", | ||
| 83 | [18] = "Atomic ops support", | ||
| 84 | [19] = "Raw multicast support", | ||
| 85 | [20] = "Address vector port checking support", | ||
| 86 | [21] = "UD multicast support", | ||
| 87 | [24] = "Demand paging support", | ||
| 88 | [25] = "Router support" | ||
| 89 | }; | ||
| 90 | int i; | ||
| 91 | |||
| 92 | mlx4_dbg(dev, "DEV_CAP flags:\n"); | ||
| 93 | for (i = 0; i < 32; ++i) | ||
| 94 | if (fname[i] && (flags & (1 << i))) | ||
| 95 | mlx4_dbg(dev, " %s\n", fname[i]); | ||
| 96 | } | ||
| 97 | |||
| 98 | int mlx4_QUERY_DEV_CAP(struct mlx4_dev *dev, struct mlx4_dev_cap *dev_cap) | ||
| 99 | { | ||
| 100 | struct mlx4_cmd_mailbox *mailbox; | ||
| 101 | u32 *outbox; | ||
| 102 | u8 field; | ||
| 103 | u16 size; | ||
| 104 | u16 stat_rate; | ||
| 105 | int err; | ||
| 106 | |||
| 107 | #define QUERY_DEV_CAP_OUT_SIZE 0x100 | ||
| 108 | #define QUERY_DEV_CAP_MAX_SRQ_SZ_OFFSET 0x10 | ||
| 109 | #define QUERY_DEV_CAP_MAX_QP_SZ_OFFSET 0x11 | ||
| 110 | #define QUERY_DEV_CAP_RSVD_QP_OFFSET 0x12 | ||
| 111 | #define QUERY_DEV_CAP_MAX_QP_OFFSET 0x13 | ||
| 112 | #define QUERY_DEV_CAP_RSVD_SRQ_OFFSET 0x14 | ||
| 113 | #define QUERY_DEV_CAP_MAX_SRQ_OFFSET 0x15 | ||
| 114 | #define QUERY_DEV_CAP_RSVD_EEC_OFFSET 0x16 | ||
| 115 | #define QUERY_DEV_CAP_MAX_EEC_OFFSET 0x17 | ||
| 116 | #define QUERY_DEV_CAP_MAX_CQ_SZ_OFFSET 0x19 | ||
| 117 | #define QUERY_DEV_CAP_RSVD_CQ_OFFSET 0x1a | ||
| 118 | #define QUERY_DEV_CAP_MAX_CQ_OFFSET 0x1b | ||
| 119 | #define QUERY_DEV_CAP_MAX_MPT_OFFSET 0x1d | ||
| 120 | #define QUERY_DEV_CAP_RSVD_EQ_OFFSET 0x1e | ||
| 121 | #define QUERY_DEV_CAP_MAX_EQ_OFFSET 0x1f | ||
| 122 | #define QUERY_DEV_CAP_RSVD_MTT_OFFSET 0x20 | ||
| 123 | #define QUERY_DEV_CAP_MAX_MRW_SZ_OFFSET 0x21 | ||
| 124 | #define QUERY_DEV_CAP_RSVD_MRW_OFFSET 0x22 | ||
| 125 | #define QUERY_DEV_CAP_MAX_MTT_SEG_OFFSET 0x23 | ||
| 126 | #define QUERY_DEV_CAP_MAX_AV_OFFSET 0x27 | ||
| 127 | #define QUERY_DEV_CAP_MAX_REQ_QP_OFFSET 0x29 | ||
| 128 | #define QUERY_DEV_CAP_MAX_RES_QP_OFFSET 0x2b | ||
| 129 | #define QUERY_DEV_CAP_MAX_RDMA_OFFSET 0x2f | ||
| 130 | #define QUERY_DEV_CAP_RSZ_SRQ_OFFSET 0x33 | ||
| 131 | #define QUERY_DEV_CAP_ACK_DELAY_OFFSET 0x35 | ||
| 132 | #define QUERY_DEV_CAP_MTU_WIDTH_OFFSET 0x36 | ||
| 133 | #define QUERY_DEV_CAP_VL_PORT_OFFSET 0x37 | ||
| 134 | #define QUERY_DEV_CAP_MAX_GID_OFFSET 0x3b | ||
| 135 | #define QUERY_DEV_CAP_RATE_SUPPORT_OFFSET 0x3c | ||
| 136 | #define QUERY_DEV_CAP_MAX_PKEY_OFFSET 0x3f | ||
| 137 | #define QUERY_DEV_CAP_FLAGS_OFFSET 0x44 | ||
| 138 | #define QUERY_DEV_CAP_RSVD_UAR_OFFSET 0x48 | ||
| 139 | #define QUERY_DEV_CAP_UAR_SZ_OFFSET 0x49 | ||
| 140 | #define QUERY_DEV_CAP_PAGE_SZ_OFFSET 0x4b | ||
| 141 | #define QUERY_DEV_CAP_BF_OFFSET 0x4c | ||
| 142 | #define QUERY_DEV_CAP_LOG_BF_REG_SZ_OFFSET 0x4d | ||
| 143 | #define QUERY_DEV_CAP_LOG_MAX_BF_REGS_PER_PAGE_OFFSET 0x4e | ||
| 144 | #define QUERY_DEV_CAP_LOG_MAX_BF_PAGES_OFFSET 0x4f | ||
| 145 | #define QUERY_DEV_CAP_MAX_SG_SQ_OFFSET 0x51 | ||
| 146 | #define QUERY_DEV_CAP_MAX_DESC_SZ_SQ_OFFSET 0x52 | ||
| 147 | #define QUERY_DEV_CAP_MAX_SG_RQ_OFFSET 0x55 | ||
| 148 | #define QUERY_DEV_CAP_MAX_DESC_SZ_RQ_OFFSET 0x56 | ||
| 149 | #define QUERY_DEV_CAP_MAX_QP_MCG_OFFSET 0x61 | ||
| 150 | #define QUERY_DEV_CAP_RSVD_MCG_OFFSET 0x62 | ||
| 151 | #define QUERY_DEV_CAP_MAX_MCG_OFFSET 0x63 | ||
| 152 | #define QUERY_DEV_CAP_RSVD_PD_OFFSET 0x64 | ||
| 153 | #define QUERY_DEV_CAP_MAX_PD_OFFSET 0x65 | ||
| 154 | #define QUERY_DEV_CAP_RDMARC_ENTRY_SZ_OFFSET 0x80 | ||
| 155 | #define QUERY_DEV_CAP_QPC_ENTRY_SZ_OFFSET 0x82 | ||
| 156 | #define QUERY_DEV_CAP_AUX_ENTRY_SZ_OFFSET 0x84 | ||
| 157 | #define QUERY_DEV_CAP_ALTC_ENTRY_SZ_OFFSET 0x86 | ||
| 158 | #define QUERY_DEV_CAP_EQC_ENTRY_SZ_OFFSET 0x88 | ||
| 159 | #define QUERY_DEV_CAP_CQC_ENTRY_SZ_OFFSET 0x8a | ||
| 160 | #define QUERY_DEV_CAP_SRQ_ENTRY_SZ_OFFSET 0x8c | ||
| 161 | #define QUERY_DEV_CAP_C_MPT_ENTRY_SZ_OFFSET 0x8e | ||
| 162 | #define QUERY_DEV_CAP_MTT_ENTRY_SZ_OFFSET 0x90 | ||
| 163 | #define QUERY_DEV_CAP_D_MPT_ENTRY_SZ_OFFSET 0x92 | ||
| 164 | #define QUERY_DEV_CAP_BMME_FLAGS_OFFSET 0x97 | ||
| 165 | #define QUERY_DEV_CAP_RSVD_LKEY_OFFSET 0x98 | ||
| 166 | #define QUERY_DEV_CAP_MAX_ICM_SZ_OFFSET 0xa0 | ||
| 167 | |||
| 168 | mailbox = mlx4_alloc_cmd_mailbox(dev); | ||
| 169 | if (IS_ERR(mailbox)) | ||
| 170 | return PTR_ERR(mailbox); | ||
| 171 | outbox = mailbox->buf; | ||
| 172 | |||
| 173 | err = mlx4_cmd_box(dev, 0, mailbox->dma, 0, 0, MLX4_CMD_QUERY_DEV_CAP, | ||
| 174 | MLX4_CMD_TIME_CLASS_A); | ||
| 175 | |||
| 176 | if (err) | ||
| 177 | goto out; | ||
| 178 | |||
| 179 | MLX4_GET(field, outbox, QUERY_DEV_CAP_RSVD_QP_OFFSET); | ||
| 180 | dev_cap->reserved_qps = 1 << (field & 0xf); | ||
| 181 | MLX4_GET(field, outbox, QUERY_DEV_CAP_MAX_QP_OFFSET); | ||
| 182 | dev_cap->max_qps = 1 << (field & 0x1f); | ||
| 183 | MLX4_GET(field, outbox, QUERY_DEV_CAP_RSVD_SRQ_OFFSET); | ||
| 184 | dev_cap->reserved_srqs = 1 << (field >> 4); | ||
| 185 | MLX4_GET(field, outbox, QUERY_DEV_CAP_MAX_SRQ_OFFSET); | ||
| 186 | dev_cap->max_srqs = 1 << (field & 0x1f); | ||
| 187 | MLX4_GET(field, outbox, QUERY_DEV_CAP_MAX_CQ_SZ_OFFSET); | ||
| 188 | dev_cap->max_cq_sz = 1 << field; | ||
| 189 | MLX4_GET(field, outbox, QUERY_DEV_CAP_RSVD_CQ_OFFSET); | ||
| 190 | dev_cap->reserved_cqs = 1 << (field & 0xf); | ||
| 191 | MLX4_GET(field, outbox, QUERY_DEV_CAP_MAX_CQ_OFFSET); | ||
| 192 | dev_cap->max_cqs = 1 << (field & 0x1f); | ||
| 193 | MLX4_GET(field, outbox, QUERY_DEV_CAP_MAX_MPT_OFFSET); | ||
| 194 | dev_cap->max_mpts = 1 << (field & 0x3f); | ||
| 195 | MLX4_GET(field, outbox, QUERY_DEV_CAP_RSVD_EQ_OFFSET); | ||
| 196 | dev_cap->reserved_eqs = 1 << (field & 0xf); | ||
| 197 | MLX4_GET(field, outbox, QUERY_DEV_CAP_MAX_EQ_OFFSET); | ||
| 198 | dev_cap->max_eqs = 1 << (field & 0x7); | ||
| 199 | MLX4_GET(field, outbox, QUERY_DEV_CAP_RSVD_MTT_OFFSET); | ||
| 200 | dev_cap->reserved_mtts = 1 << (field >> 4); | ||
| 201 | MLX4_GET(field, outbox, QUERY_DEV_CAP_MAX_MRW_SZ_OFFSET); | ||
| 202 | dev_cap->max_mrw_sz = 1 << field; | ||
| 203 | MLX4_GET(field, outbox, QUERY_DEV_CAP_RSVD_MRW_OFFSET); | ||
| 204 | dev_cap->reserved_mrws = 1 << (field & 0xf); | ||
| 205 | MLX4_GET(field, outbox, QUERY_DEV_CAP_MAX_MTT_SEG_OFFSET); | ||
| 206 | dev_cap->max_mtt_seg = 1 << (field & 0x3f); | ||
| 207 | MLX4_GET(field, outbox, QUERY_DEV_CAP_MAX_REQ_QP_OFFSET); | ||
| 208 | dev_cap->max_requester_per_qp = 1 << (field & 0x3f); | ||
| 209 | MLX4_GET(field, outbox, QUERY_DEV_CAP_MAX_RES_QP_OFFSET); | ||
| 210 | dev_cap->max_responder_per_qp = 1 << (field & 0x3f); | ||
| 211 | MLX4_GET(field, outbox, QUERY_DEV_CAP_MAX_RDMA_OFFSET); | ||
| 212 | dev_cap->max_rdma_global = 1 << (field & 0x3f); | ||
| 213 | MLX4_GET(field, outbox, QUERY_DEV_CAP_ACK_DELAY_OFFSET); | ||
| 214 | dev_cap->local_ca_ack_delay = field & 0x1f; | ||
| 215 | MLX4_GET(field, outbox, QUERY_DEV_CAP_MTU_WIDTH_OFFSET); | ||
| 216 | dev_cap->max_mtu = field >> 4; | ||
| 217 | dev_cap->max_port_width = field & 0xf; | ||
| 218 | MLX4_GET(field, outbox, QUERY_DEV_CAP_VL_PORT_OFFSET); | ||
| 219 | dev_cap->max_vl = field >> 4; | ||
| 220 | dev_cap->num_ports = field & 0xf; | ||
| 221 | MLX4_GET(field, outbox, QUERY_DEV_CAP_MAX_GID_OFFSET); | ||
| 222 | dev_cap->max_gids = 1 << (field & 0xf); | ||
| 223 | MLX4_GET(stat_rate, outbox, QUERY_DEV_CAP_RATE_SUPPORT_OFFSET); | ||
| 224 | dev_cap->stat_rate_support = stat_rate; | ||
| 225 | MLX4_GET(field, outbox, QUERY_DEV_CAP_MAX_PKEY_OFFSET); | ||
| 226 | dev_cap->max_pkeys = 1 << (field & 0xf); | ||
| 227 | MLX4_GET(dev_cap->flags, outbox, QUERY_DEV_CAP_FLAGS_OFFSET); | ||
| 228 | MLX4_GET(field, outbox, QUERY_DEV_CAP_RSVD_UAR_OFFSET); | ||
| 229 | dev_cap->reserved_uars = field >> 4; | ||
| 230 | MLX4_GET(field, outbox, QUERY_DEV_CAP_UAR_SZ_OFFSET); | ||
| 231 | dev_cap->uar_size = 1 << ((field & 0x3f) + 20); | ||
| 232 | MLX4_GET(field, outbox, QUERY_DEV_CAP_PAGE_SZ_OFFSET); | ||
| 233 | dev_cap->min_page_sz = 1 << field; | ||
| 234 | |||
| 235 | MLX4_GET(field, outbox, QUERY_DEV_CAP_BF_OFFSET); | ||
| 236 | if (field & 0x80) { | ||
| 237 | MLX4_GET(field, outbox, QUERY_DEV_CAP_LOG_BF_REG_SZ_OFFSET); | ||
| 238 | dev_cap->bf_reg_size = 1 << (field & 0x1f); | ||
| 239 | MLX4_GET(field, outbox, QUERY_DEV_CAP_LOG_MAX_BF_REGS_PER_PAGE_OFFSET); | ||
| 240 | dev_cap->bf_regs_per_page = 1 << (field & 0x3f); | ||
| 241 | mlx4_dbg(dev, "BlueFlame available (reg size %d, regs/page %d)\n", | ||
| 242 | dev_cap->bf_reg_size, dev_cap->bf_regs_per_page); | ||
| 243 | } else { | ||
| 244 | dev_cap->bf_reg_size = 0; | ||
| 245 | mlx4_dbg(dev, "BlueFlame not available\n"); | ||
| 246 | } | ||
| 247 | |||
| 248 | MLX4_GET(field, outbox, QUERY_DEV_CAP_MAX_SG_SQ_OFFSET); | ||
| 249 | dev_cap->max_sq_sg = field; | ||
| 250 | MLX4_GET(size, outbox, QUERY_DEV_CAP_MAX_DESC_SZ_SQ_OFFSET); | ||
| 251 | dev_cap->max_sq_desc_sz = size; | ||
| 252 | |||
| 253 | MLX4_GET(field, outbox, QUERY_DEV_CAP_MAX_QP_MCG_OFFSET); | ||
| 254 | dev_cap->max_qp_per_mcg = 1 << field; | ||
| 255 | MLX4_GET(field, outbox, QUERY_DEV_CAP_RSVD_MCG_OFFSET); | ||
| 256 | dev_cap->reserved_mgms = field & 0xf; | ||
| 257 | MLX4_GET(field, outbox, QUERY_DEV_CAP_MAX_MCG_OFFSET); | ||
| 258 | dev_cap->max_mcgs = 1 << field; | ||
| 259 | MLX4_GET(field, outbox, QUERY_DEV_CAP_RSVD_PD_OFFSET); | ||
| 260 | dev_cap->reserved_pds = field >> 4; | ||
| 261 | MLX4_GET(field, outbox, QUERY_DEV_CAP_MAX_PD_OFFSET); | ||
| 262 | dev_cap->max_pds = 1 << (field & 0x3f); | ||
| 263 | |||
| 264 | MLX4_GET(size, outbox, QUERY_DEV_CAP_RDMARC_ENTRY_SZ_OFFSET); | ||
| 265 | dev_cap->rdmarc_entry_sz = size; | ||
| 266 | MLX4_GET(size, outbox, QUERY_DEV_CAP_QPC_ENTRY_SZ_OFFSET); | ||
| 267 | dev_cap->qpc_entry_sz = size; | ||
| 268 | MLX4_GET(size, outbox, QUERY_DEV_CAP_AUX_ENTRY_SZ_OFFSET); | ||
| 269 | dev_cap->aux_entry_sz = size; | ||
| 270 | MLX4_GET(size, outbox, QUERY_DEV_CAP_ALTC_ENTRY_SZ_OFFSET); | ||
| 271 | dev_cap->altc_entry_sz = size; | ||
| 272 | MLX4_GET(size, outbox, QUERY_DEV_CAP_EQC_ENTRY_SZ_OFFSET); | ||
| 273 | dev_cap->eqc_entry_sz = size; | ||
| 274 | MLX4_GET(size, outbox, QUERY_DEV_CAP_CQC_ENTRY_SZ_OFFSET); | ||
| 275 | dev_cap->cqc_entry_sz = size; | ||
| 276 | MLX4_GET(size, outbox, QUERY_DEV_CAP_SRQ_ENTRY_SZ_OFFSET); | ||
| 277 | dev_cap->srq_entry_sz = size; | ||
| 278 | MLX4_GET(size, outbox, QUERY_DEV_CAP_C_MPT_ENTRY_SZ_OFFSET); | ||
| 279 | dev_cap->cmpt_entry_sz = size; | ||
| 280 | MLX4_GET(size, outbox, QUERY_DEV_CAP_MTT_ENTRY_SZ_OFFSET); | ||
| 281 | dev_cap->mtt_entry_sz = size; | ||
| 282 | MLX4_GET(size, outbox, QUERY_DEV_CAP_D_MPT_ENTRY_SZ_OFFSET); | ||
| 283 | dev_cap->dmpt_entry_sz = size; | ||
| 284 | |||
| 285 | MLX4_GET(field, outbox, QUERY_DEV_CAP_MAX_SRQ_SZ_OFFSET); | ||
| 286 | dev_cap->max_srq_sz = 1 << field; | ||
| 287 | MLX4_GET(field, outbox, QUERY_DEV_CAP_MAX_QP_SZ_OFFSET); | ||
| 288 | dev_cap->max_qp_sz = 1 << field; | ||
| 289 | MLX4_GET(field, outbox, QUERY_DEV_CAP_RSZ_SRQ_OFFSET); | ||
| 290 | dev_cap->resize_srq = field & 1; | ||
| 291 | MLX4_GET(field, outbox, QUERY_DEV_CAP_MAX_SG_RQ_OFFSET); | ||
| 292 | dev_cap->max_rq_sg = field; | ||
| 293 | MLX4_GET(size, outbox, QUERY_DEV_CAP_MAX_DESC_SZ_RQ_OFFSET); | ||
| 294 | dev_cap->max_rq_desc_sz = size; | ||
| 295 | |||
| 296 | MLX4_GET(dev_cap->bmme_flags, outbox, | ||
| 297 | QUERY_DEV_CAP_BMME_FLAGS_OFFSET); | ||
| 298 | MLX4_GET(dev_cap->reserved_lkey, outbox, | ||
| 299 | QUERY_DEV_CAP_RSVD_LKEY_OFFSET); | ||
| 300 | MLX4_GET(dev_cap->max_icm_sz, outbox, | ||
| 301 | QUERY_DEV_CAP_MAX_ICM_SZ_OFFSET); | ||
| 302 | |||
| 303 | if (dev_cap->bmme_flags & 1) | ||
| 304 | mlx4_dbg(dev, "Base MM extensions: yes " | ||
| 305 | "(flags %d, rsvd L_Key %08x)\n", | ||
| 306 | dev_cap->bmme_flags, dev_cap->reserved_lkey); | ||
| 307 | else | ||
| 308 | mlx4_dbg(dev, "Base MM extensions: no\n"); | ||
| 309 | |||
| 310 | /* | ||
| 311 | * Each UAR has 4 EQ doorbells; so if a UAR is reserved, then | ||
| 312 | * we can't use any EQs whose doorbell falls on that page, | ||
| 313 | * even if the EQ itself isn't reserved. | ||
| 314 | */ | ||
| 315 | dev_cap->reserved_eqs = max(dev_cap->reserved_uars * 4, | ||
| 316 | dev_cap->reserved_eqs); | ||
| 317 | |||
| 318 | mlx4_dbg(dev, "Max ICM size %lld MB\n", | ||
| 319 | (unsigned long long) dev_cap->max_icm_sz >> 20); | ||
| 320 | mlx4_dbg(dev, "Max QPs: %d, reserved QPs: %d, entry size: %d\n", | ||
| 321 | dev_cap->max_qps, dev_cap->reserved_qps, dev_cap->qpc_entry_sz); | ||
| 322 | mlx4_dbg(dev, "Max SRQs: %d, reserved SRQs: %d, entry size: %d\n", | ||
| 323 | dev_cap->max_srqs, dev_cap->reserved_srqs, dev_cap->srq_entry_sz); | ||
| 324 | mlx4_dbg(dev, "Max CQs: %d, reserved CQs: %d, entry size: %d\n", | ||
| 325 | dev_cap->max_cqs, dev_cap->reserved_cqs, dev_cap->cqc_entry_sz); | ||
| 326 | mlx4_dbg(dev, "Max EQs: %d, reserved EQs: %d, entry size: %d\n", | ||
| 327 | dev_cap->max_eqs, dev_cap->reserved_eqs, dev_cap->eqc_entry_sz); | ||
| 328 | mlx4_dbg(dev, "reserved MPTs: %d, reserved MTTs: %d\n", | ||
| 329 | dev_cap->reserved_mrws, dev_cap->reserved_mtts); | ||
| 330 | mlx4_dbg(dev, "Max PDs: %d, reserved PDs: %d, reserved UARs: %d\n", | ||
| 331 | dev_cap->max_pds, dev_cap->reserved_pds, dev_cap->reserved_uars); | ||
| 332 | mlx4_dbg(dev, "Max QP/MCG: %d, reserved MGMs: %d\n", | ||
| 333 | dev_cap->max_pds, dev_cap->reserved_mgms); | ||
| 334 | mlx4_dbg(dev, "Max CQEs: %d, max WQEs: %d, max SRQ WQEs: %d\n", | ||
| 335 | dev_cap->max_cq_sz, dev_cap->max_qp_sz, dev_cap->max_srq_sz); | ||
| 336 | mlx4_dbg(dev, "Local CA ACK delay: %d, max MTU: %d, port width cap: %d\n", | ||
| 337 | dev_cap->local_ca_ack_delay, 128 << dev_cap->max_mtu, | ||
| 338 | dev_cap->max_port_width); | ||
| 339 | mlx4_dbg(dev, "Max SQ desc size: %d, max SQ S/G: %d\n", | ||
| 340 | dev_cap->max_sq_desc_sz, dev_cap->max_sq_sg); | ||
| 341 | mlx4_dbg(dev, "Max RQ desc size: %d, max RQ S/G: %d\n", | ||
| 342 | dev_cap->max_rq_desc_sz, dev_cap->max_rq_sg); | ||
| 343 | |||
| 344 | dump_dev_cap_flags(dev, dev_cap->flags); | ||
| 345 | |||
| 346 | out: | ||
| 347 | mlx4_free_cmd_mailbox(dev, mailbox); | ||
| 348 | return err; | ||
| 349 | } | ||
| 350 | |||
| 351 | int mlx4_map_cmd(struct mlx4_dev *dev, u16 op, struct mlx4_icm *icm, u64 virt) | ||
| 352 | { | ||
| 353 | struct mlx4_cmd_mailbox *mailbox; | ||
| 354 | struct mlx4_icm_iter iter; | ||
| 355 | __be64 *pages; | ||
| 356 | int lg; | ||
| 357 | int nent = 0; | ||
| 358 | int i; | ||
| 359 | int err = 0; | ||
| 360 | int ts = 0, tc = 0; | ||
| 361 | |||
| 362 | mailbox = mlx4_alloc_cmd_mailbox(dev); | ||
| 363 | if (IS_ERR(mailbox)) | ||
| 364 | return PTR_ERR(mailbox); | ||
| 365 | memset(mailbox->buf, 0, MLX4_MAILBOX_SIZE); | ||
| 366 | pages = mailbox->buf; | ||
| 367 | |||
| 368 | for (mlx4_icm_first(icm, &iter); | ||
| 369 | !mlx4_icm_last(&iter); | ||
| 370 | mlx4_icm_next(&iter)) { | ||
| 371 | /* | ||
| 372 | * We have to pass pages that are aligned to their | ||
| 373 | * size, so find the least significant 1 in the | ||
| 374 | * address or size and use that as our log2 size. | ||
| 375 | */ | ||
| 376 | lg = ffs(mlx4_icm_addr(&iter) | mlx4_icm_size(&iter)) - 1; | ||
| 377 | if (lg < MLX4_ICM_PAGE_SHIFT) { | ||
| 378 | mlx4_warn(dev, "Got FW area not aligned to %d (%llx/%lx).\n", | ||
| 379 | MLX4_ICM_PAGE_SIZE, | ||
| 380 | (unsigned long long) mlx4_icm_addr(&iter), | ||
| 381 | mlx4_icm_size(&iter)); | ||
| 382 | err = -EINVAL; | ||
| 383 | goto out; | ||
| 384 | } | ||
| 385 | |||
| 386 | for (i = 0; i < mlx4_icm_size(&iter) >> lg; ++i) { | ||
| 387 | if (virt != -1) { | ||
| 388 | pages[nent * 2] = cpu_to_be64(virt); | ||
| 389 | virt += 1 << lg; | ||
| 390 | } | ||
| 391 | |||
| 392 | pages[nent * 2 + 1] = | ||
| 393 | cpu_to_be64((mlx4_icm_addr(&iter) + (i << lg)) | | ||
| 394 | (lg - MLX4_ICM_PAGE_SHIFT)); | ||
| 395 | ts += 1 << (lg - 10); | ||
| 396 | ++tc; | ||
| 397 | |||
| 398 | if (++nent == MLX4_MAILBOX_SIZE / 16) { | ||
| 399 | err = mlx4_cmd(dev, mailbox->dma, nent, 0, op, | ||
| 400 | MLX4_CMD_TIME_CLASS_B); | ||
| 401 | if (err) | ||
| 402 | goto out; | ||
| 403 | nent = 0; | ||
| 404 | } | ||
| 405 | } | ||
| 406 | } | ||
| 407 | |||
| 408 | if (nent) | ||
| 409 | err = mlx4_cmd(dev, mailbox->dma, nent, 0, op, MLX4_CMD_TIME_CLASS_B); | ||
| 410 | if (err) | ||
| 411 | goto out; | ||
| 412 | |||
| 413 | switch (op) { | ||
| 414 | case MLX4_CMD_MAP_FA: | ||
| 415 | mlx4_dbg(dev, "Mapped %d chunks/%d KB for FW.\n", tc, ts); | ||
| 416 | break; | ||
| 417 | case MLX4_CMD_MAP_ICM_AUX: | ||
| 418 | mlx4_dbg(dev, "Mapped %d chunks/%d KB for ICM aux.\n", tc, ts); | ||
| 419 | break; | ||
| 420 | case MLX4_CMD_MAP_ICM: | ||
| 421 | mlx4_dbg(dev, "Mapped %d chunks/%d KB at %llx for ICM.\n", | ||
| 422 | tc, ts, (unsigned long long) virt - (ts << 10)); | ||
| 423 | break; | ||
| 424 | } | ||
| 425 | |||
| 426 | out: | ||
| 427 | mlx4_free_cmd_mailbox(dev, mailbox); | ||
| 428 | return err; | ||
| 429 | } | ||
| 430 | |||
| 431 | int mlx4_MAP_FA(struct mlx4_dev *dev, struct mlx4_icm *icm) | ||
| 432 | { | ||
| 433 | return mlx4_map_cmd(dev, MLX4_CMD_MAP_FA, icm, -1); | ||
| 434 | } | ||
| 435 | |||
| 436 | int mlx4_UNMAP_FA(struct mlx4_dev *dev) | ||
| 437 | { | ||
| 438 | return mlx4_cmd(dev, 0, 0, 0, MLX4_CMD_UNMAP_FA, MLX4_CMD_TIME_CLASS_B); | ||
| 439 | } | ||
| 440 | |||
| 441 | |||
| 442 | int mlx4_RUN_FW(struct mlx4_dev *dev) | ||
| 443 | { | ||
| 444 | return mlx4_cmd(dev, 0, 0, 0, MLX4_CMD_RUN_FW, MLX4_CMD_TIME_CLASS_A); | ||
| 445 | } | ||
| 446 | |||
| 447 | int mlx4_QUERY_FW(struct mlx4_dev *dev) | ||
| 448 | { | ||
| 449 | struct mlx4_fw *fw = &mlx4_priv(dev)->fw; | ||
| 450 | struct mlx4_cmd *cmd = &mlx4_priv(dev)->cmd; | ||
| 451 | struct mlx4_cmd_mailbox *mailbox; | ||
| 452 | u32 *outbox; | ||
| 453 | int err = 0; | ||
| 454 | u64 fw_ver; | ||
| 455 | u8 lg; | ||
| 456 | |||
| 457 | #define QUERY_FW_OUT_SIZE 0x100 | ||
| 458 | #define QUERY_FW_VER_OFFSET 0x00 | ||
| 459 | #define QUERY_FW_MAX_CMD_OFFSET 0x0f | ||
| 460 | #define QUERY_FW_ERR_START_OFFSET 0x30 | ||
| 461 | #define QUERY_FW_ERR_SIZE_OFFSET 0x38 | ||
| 462 | #define QUERY_FW_ERR_BAR_OFFSET 0x3c | ||
| 463 | |||
| 464 | #define QUERY_FW_SIZE_OFFSET 0x00 | ||
| 465 | #define QUERY_FW_CLR_INT_BASE_OFFSET 0x20 | ||
| 466 | #define QUERY_FW_CLR_INT_BAR_OFFSET 0x28 | ||
| 467 | |||
| 468 | mailbox = mlx4_alloc_cmd_mailbox(dev); | ||
| 469 | if (IS_ERR(mailbox)) | ||
| 470 | return PTR_ERR(mailbox); | ||
| 471 | outbox = mailbox->buf; | ||
| 472 | |||
| 473 | err = mlx4_cmd_box(dev, 0, mailbox->dma, 0, 0, MLX4_CMD_QUERY_FW, | ||
| 474 | MLX4_CMD_TIME_CLASS_A); | ||
| 475 | if (err) | ||
| 476 | goto out; | ||
| 477 | |||
| 478 | MLX4_GET(fw_ver, outbox, QUERY_FW_VER_OFFSET); | ||
| 479 | /* | ||
| 480 | * FW subminor version is at more signifant bits than minor | ||
| 481 | * version, so swap here. | ||
| 482 | */ | ||
| 483 | dev->caps.fw_ver = (fw_ver & 0xffff00000000ull) | | ||
| 484 | ((fw_ver & 0xffff0000ull) >> 16) | | ||
| 485 | ((fw_ver & 0x0000ffffull) << 16); | ||
| 486 | |||
| 487 | MLX4_GET(lg, outbox, QUERY_FW_MAX_CMD_OFFSET); | ||
| 488 | cmd->max_cmds = 1 << lg; | ||
| 489 | |||
| 490 | mlx4_dbg(dev, "FW version %d.%d.%03d, max commands %d\n", | ||
| 491 | (int) (dev->caps.fw_ver >> 32), | ||
| 492 | (int) (dev->caps.fw_ver >> 16) & 0xffff, | ||
| 493 | (int) dev->caps.fw_ver & 0xffff, | ||
| 494 | cmd->max_cmds); | ||
| 495 | |||
| 496 | MLX4_GET(fw->catas_offset, outbox, QUERY_FW_ERR_START_OFFSET); | ||
| 497 | MLX4_GET(fw->catas_size, outbox, QUERY_FW_ERR_SIZE_OFFSET); | ||
| 498 | MLX4_GET(fw->catas_bar, outbox, QUERY_FW_ERR_BAR_OFFSET); | ||
| 499 | fw->catas_bar = (fw->catas_bar >> 6) * 2; | ||
| 500 | |||
| 501 | mlx4_dbg(dev, "Catastrophic error buffer at 0x%llx, size 0x%x, BAR %d\n", | ||
| 502 | (unsigned long long) fw->catas_offset, fw->catas_size, fw->catas_bar); | ||
| 503 | |||
| 504 | MLX4_GET(fw->fw_pages, outbox, QUERY_FW_SIZE_OFFSET); | ||
| 505 | MLX4_GET(fw->clr_int_base, outbox, QUERY_FW_CLR_INT_BASE_OFFSET); | ||
| 506 | MLX4_GET(fw->clr_int_bar, outbox, QUERY_FW_CLR_INT_BAR_OFFSET); | ||
| 507 | fw->clr_int_bar = (fw->clr_int_bar >> 6) * 2; | ||
| 508 | |||
| 509 | mlx4_dbg(dev, "FW size %d KB\n", fw->fw_pages >> 2); | ||
| 510 | |||
| 511 | /* | ||
| 512 | * Round up number of system pages needed in case | ||
| 513 | * MLX4_ICM_PAGE_SIZE < PAGE_SIZE. | ||
| 514 | */ | ||
| 515 | fw->fw_pages = | ||
| 516 | ALIGN(fw->fw_pages, PAGE_SIZE / MLX4_ICM_PAGE_SIZE) >> | ||
| 517 | (PAGE_SHIFT - MLX4_ICM_PAGE_SHIFT); | ||
| 518 | |||
| 519 | mlx4_dbg(dev, "Clear int @ %llx, BAR %d\n", | ||
| 520 | (unsigned long long) fw->clr_int_base, fw->clr_int_bar); | ||
| 521 | |||
| 522 | out: | ||
| 523 | mlx4_free_cmd_mailbox(dev, mailbox); | ||
| 524 | return err; | ||
| 525 | } | ||
| 526 | |||
| 527 | static void get_board_id(void *vsd, char *board_id) | ||
| 528 | { | ||
| 529 | int i; | ||
| 530 | |||
| 531 | #define VSD_OFFSET_SIG1 0x00 | ||
| 532 | #define VSD_OFFSET_SIG2 0xde | ||
| 533 | #define VSD_OFFSET_MLX_BOARD_ID 0xd0 | ||
| 534 | #define VSD_OFFSET_TS_BOARD_ID 0x20 | ||
| 535 | |||
| 536 | #define VSD_SIGNATURE_TOPSPIN 0x5ad | ||
| 537 | |||
| 538 | memset(board_id, 0, MLX4_BOARD_ID_LEN); | ||
| 539 | |||
| 540 | if (be16_to_cpup(vsd + VSD_OFFSET_SIG1) == VSD_SIGNATURE_TOPSPIN && | ||
| 541 | be16_to_cpup(vsd + VSD_OFFSET_SIG2) == VSD_SIGNATURE_TOPSPIN) { | ||
| 542 | strlcpy(board_id, vsd + VSD_OFFSET_TS_BOARD_ID, MLX4_BOARD_ID_LEN); | ||
| 543 | } else { | ||
| 544 | /* | ||
| 545 | * The board ID is a string but the firmware byte | ||
| 546 | * swaps each 4-byte word before passing it back to | ||
| 547 | * us. Therefore we need to swab it before printing. | ||
| 548 | */ | ||
| 549 | for (i = 0; i < 4; ++i) | ||
| 550 | ((u32 *) board_id)[i] = | ||
| 551 | swab32(*(u32 *) (vsd + VSD_OFFSET_MLX_BOARD_ID + i * 4)); | ||
| 552 | } | ||
| 553 | } | ||
| 554 | |||
| 555 | int mlx4_QUERY_ADAPTER(struct mlx4_dev *dev, struct mlx4_adapter *adapter) | ||
| 556 | { | ||
| 557 | struct mlx4_cmd_mailbox *mailbox; | ||
| 558 | u32 *outbox; | ||
| 559 | int err; | ||
| 560 | |||
| 561 | #define QUERY_ADAPTER_OUT_SIZE 0x100 | ||
| 562 | #define QUERY_ADAPTER_VENDOR_ID_OFFSET 0x00 | ||
| 563 | #define QUERY_ADAPTER_DEVICE_ID_OFFSET 0x04 | ||
| 564 | #define QUERY_ADAPTER_REVISION_ID_OFFSET 0x08 | ||
| 565 | #define QUERY_ADAPTER_INTA_PIN_OFFSET 0x10 | ||
| 566 | #define QUERY_ADAPTER_VSD_OFFSET 0x20 | ||
| 567 | |||
| 568 | mailbox = mlx4_alloc_cmd_mailbox(dev); | ||
| 569 | if (IS_ERR(mailbox)) | ||
| 570 | return PTR_ERR(mailbox); | ||
| 571 | outbox = mailbox->buf; | ||
| 572 | |||
| 573 | err = mlx4_cmd_box(dev, 0, mailbox->dma, 0, 0, MLX4_CMD_QUERY_ADAPTER, | ||
| 574 | MLX4_CMD_TIME_CLASS_A); | ||
| 575 | if (err) | ||
| 576 | goto out; | ||
| 577 | |||
| 578 | MLX4_GET(adapter->vendor_id, outbox, QUERY_ADAPTER_VENDOR_ID_OFFSET); | ||
| 579 | MLX4_GET(adapter->device_id, outbox, QUERY_ADAPTER_DEVICE_ID_OFFSET); | ||
| 580 | MLX4_GET(adapter->revision_id, outbox, QUERY_ADAPTER_REVISION_ID_OFFSET); | ||
| 581 | MLX4_GET(adapter->inta_pin, outbox, QUERY_ADAPTER_INTA_PIN_OFFSET); | ||
| 582 | |||
| 583 | get_board_id(outbox + QUERY_ADAPTER_VSD_OFFSET / 4, | ||
| 584 | adapter->board_id); | ||
| 585 | |||
| 586 | out: | ||
| 587 | mlx4_free_cmd_mailbox(dev, mailbox); | ||
| 588 | return err; | ||
| 589 | } | ||
| 590 | |||
| 591 | int mlx4_INIT_HCA(struct mlx4_dev *dev, struct mlx4_init_hca_param *param) | ||
| 592 | { | ||
| 593 | struct mlx4_cmd_mailbox *mailbox; | ||
| 594 | __be32 *inbox; | ||
| 595 | int err; | ||
| 596 | |||
| 597 | #define INIT_HCA_IN_SIZE 0x200 | ||
| 598 | #define INIT_HCA_VERSION_OFFSET 0x000 | ||
| 599 | #define INIT_HCA_VERSION 2 | ||
| 600 | #define INIT_HCA_FLAGS_OFFSET 0x014 | ||
| 601 | #define INIT_HCA_QPC_OFFSET 0x020 | ||
| 602 | #define INIT_HCA_QPC_BASE_OFFSET (INIT_HCA_QPC_OFFSET + 0x10) | ||
| 603 | #define INIT_HCA_LOG_QP_OFFSET (INIT_HCA_QPC_OFFSET + 0x17) | ||
| 604 | #define INIT_HCA_SRQC_BASE_OFFSET (INIT_HCA_QPC_OFFSET + 0x28) | ||
| 605 | #define INIT_HCA_LOG_SRQ_OFFSET (INIT_HCA_QPC_OFFSET + 0x2f) | ||
| 606 | #define INIT_HCA_CQC_BASE_OFFSET (INIT_HCA_QPC_OFFSET + 0x30) | ||
| 607 | #define INIT_HCA_LOG_CQ_OFFSET (INIT_HCA_QPC_OFFSET + 0x37) | ||
| 608 | #define INIT_HCA_ALTC_BASE_OFFSET (INIT_HCA_QPC_OFFSET + 0x40) | ||
| 609 | #define INIT_HCA_AUXC_BASE_OFFSET (INIT_HCA_QPC_OFFSET + 0x50) | ||
| 610 | #define INIT_HCA_EQC_BASE_OFFSET (INIT_HCA_QPC_OFFSET + 0x60) | ||
| 611 | #define INIT_HCA_LOG_EQ_OFFSET (INIT_HCA_QPC_OFFSET + 0x67) | ||
| 612 | #define INIT_HCA_RDMARC_BASE_OFFSET (INIT_HCA_QPC_OFFSET + 0x70) | ||
| 613 | #define INIT_HCA_LOG_RD_OFFSET (INIT_HCA_QPC_OFFSET + 0x77) | ||
| 614 | #define INIT_HCA_MCAST_OFFSET 0x0c0 | ||
| 615 | #define INIT_HCA_MC_BASE_OFFSET (INIT_HCA_MCAST_OFFSET + 0x00) | ||
| 616 | #define INIT_HCA_LOG_MC_ENTRY_SZ_OFFSET (INIT_HCA_MCAST_OFFSET + 0x12) | ||
| 617 | #define INIT_HCA_LOG_MC_HASH_SZ_OFFSET (INIT_HCA_MCAST_OFFSET + 0x16) | ||
| 618 | #define INIT_HCA_LOG_MC_TABLE_SZ_OFFSET (INIT_HCA_MCAST_OFFSET + 0x1b) | ||
| 619 | #define INIT_HCA_TPT_OFFSET 0x0f0 | ||
| 620 | #define INIT_HCA_DMPT_BASE_OFFSET (INIT_HCA_TPT_OFFSET + 0x00) | ||
| 621 | #define INIT_HCA_LOG_MPT_SZ_OFFSET (INIT_HCA_TPT_OFFSET + 0x0b) | ||
| 622 | #define INIT_HCA_MTT_BASE_OFFSET (INIT_HCA_TPT_OFFSET + 0x10) | ||
| 623 | #define INIT_HCA_CMPT_BASE_OFFSET (INIT_HCA_TPT_OFFSET + 0x18) | ||
| 624 | #define INIT_HCA_UAR_OFFSET 0x120 | ||
| 625 | #define INIT_HCA_LOG_UAR_SZ_OFFSET (INIT_HCA_UAR_OFFSET + 0x0a) | ||
| 626 | #define INIT_HCA_UAR_PAGE_SZ_OFFSET (INIT_HCA_UAR_OFFSET + 0x0b) | ||
| 627 | |||
| 628 | mailbox = mlx4_alloc_cmd_mailbox(dev); | ||
| 629 | if (IS_ERR(mailbox)) | ||
| 630 | return PTR_ERR(mailbox); | ||
| 631 | inbox = mailbox->buf; | ||
| 632 | |||
| 633 | memset(inbox, 0, INIT_HCA_IN_SIZE); | ||
| 634 | |||
| 635 | *((u8 *) mailbox->buf + INIT_HCA_VERSION_OFFSET) = INIT_HCA_VERSION; | ||
| 636 | |||
| 637 | #if defined(__LITTLE_ENDIAN) | ||
| 638 | *(inbox + INIT_HCA_FLAGS_OFFSET / 4) &= ~cpu_to_be32(1 << 1); | ||
| 639 | #elif defined(__BIG_ENDIAN) | ||
| 640 | *(inbox + INIT_HCA_FLAGS_OFFSET / 4) |= cpu_to_be32(1 << 1); | ||
| 641 | #else | ||
| 642 | #error Host endianness not defined | ||
| 643 | #endif | ||
| 644 | /* Check port for UD address vector: */ | ||
| 645 | *(inbox + INIT_HCA_FLAGS_OFFSET / 4) |= cpu_to_be32(1); | ||
| 646 | |||
| 647 | /* QPC/EEC/CQC/EQC/RDMARC attributes */ | ||
| 648 | |||
| 649 | MLX4_PUT(inbox, param->qpc_base, INIT_HCA_QPC_BASE_OFFSET); | ||
| 650 | MLX4_PUT(inbox, param->log_num_qps, INIT_HCA_LOG_QP_OFFSET); | ||
| 651 | MLX4_PUT(inbox, param->srqc_base, INIT_HCA_SRQC_BASE_OFFSET); | ||
| 652 | MLX4_PUT(inbox, param->log_num_srqs, INIT_HCA_LOG_SRQ_OFFSET); | ||
| 653 | MLX4_PUT(inbox, param->cqc_base, INIT_HCA_CQC_BASE_OFFSET); | ||
| 654 | MLX4_PUT(inbox, param->log_num_cqs, INIT_HCA_LOG_CQ_OFFSET); | ||
| 655 | MLX4_PUT(inbox, param->altc_base, INIT_HCA_ALTC_BASE_OFFSET); | ||
| 656 | MLX4_PUT(inbox, param->auxc_base, INIT_HCA_AUXC_BASE_OFFSET); | ||
| 657 | MLX4_PUT(inbox, param->eqc_base, INIT_HCA_EQC_BASE_OFFSET); | ||
| 658 | MLX4_PUT(inbox, param->log_num_eqs, INIT_HCA_LOG_EQ_OFFSET); | ||
| 659 | MLX4_PUT(inbox, param->rdmarc_base, INIT_HCA_RDMARC_BASE_OFFSET); | ||
| 660 | MLX4_PUT(inbox, param->log_rd_per_qp, INIT_HCA_LOG_RD_OFFSET); | ||
| 661 | |||
| 662 | /* multicast attributes */ | ||
| 663 | |||
| 664 | MLX4_PUT(inbox, param->mc_base, INIT_HCA_MC_BASE_OFFSET); | ||
| 665 | MLX4_PUT(inbox, param->log_mc_entry_sz, INIT_HCA_LOG_MC_ENTRY_SZ_OFFSET); | ||
| 666 | MLX4_PUT(inbox, param->log_mc_hash_sz, INIT_HCA_LOG_MC_HASH_SZ_OFFSET); | ||
| 667 | MLX4_PUT(inbox, param->log_mc_table_sz, INIT_HCA_LOG_MC_TABLE_SZ_OFFSET); | ||
| 668 | |||
| 669 | /* TPT attributes */ | ||
| 670 | |||
| 671 | MLX4_PUT(inbox, param->dmpt_base, INIT_HCA_DMPT_BASE_OFFSET); | ||
| 672 | MLX4_PUT(inbox, param->log_mpt_sz, INIT_HCA_LOG_MPT_SZ_OFFSET); | ||
| 673 | MLX4_PUT(inbox, param->mtt_base, INIT_HCA_MTT_BASE_OFFSET); | ||
| 674 | MLX4_PUT(inbox, param->cmpt_base, INIT_HCA_CMPT_BASE_OFFSET); | ||
| 675 | |||
| 676 | /* UAR attributes */ | ||
| 677 | |||
| 678 | MLX4_PUT(inbox, (u8) (PAGE_SHIFT - 12), INIT_HCA_UAR_PAGE_SZ_OFFSET); | ||
| 679 | MLX4_PUT(inbox, param->log_uar_sz, INIT_HCA_LOG_UAR_SZ_OFFSET); | ||
| 680 | |||
| 681 | err = mlx4_cmd(dev, mailbox->dma, 0, 0, MLX4_CMD_INIT_HCA, 1000); | ||
| 682 | |||
| 683 | if (err) | ||
| 684 | mlx4_err(dev, "INIT_HCA returns %d\n", err); | ||
| 685 | |||
| 686 | mlx4_free_cmd_mailbox(dev, mailbox); | ||
| 687 | return err; | ||
| 688 | } | ||
| 689 | |||
| 690 | int mlx4_INIT_PORT(struct mlx4_dev *dev, struct mlx4_init_port_param *param, int port) | ||
| 691 | { | ||
| 692 | struct mlx4_cmd_mailbox *mailbox; | ||
| 693 | u32 *inbox; | ||
| 694 | int err; | ||
| 695 | u32 flags; | ||
| 696 | |||
| 697 | #define INIT_PORT_IN_SIZE 256 | ||
| 698 | #define INIT_PORT_FLAGS_OFFSET 0x00 | ||
| 699 | #define INIT_PORT_FLAG_SIG (1 << 18) | ||
| 700 | #define INIT_PORT_FLAG_NG (1 << 17) | ||
| 701 | #define INIT_PORT_FLAG_G0 (1 << 16) | ||
| 702 | #define INIT_PORT_VL_SHIFT 4 | ||
| 703 | #define INIT_PORT_PORT_WIDTH_SHIFT 8 | ||
| 704 | #define INIT_PORT_MTU_OFFSET 0x04 | ||
| 705 | #define INIT_PORT_MAX_GID_OFFSET 0x06 | ||
| 706 | #define INIT_PORT_MAX_PKEY_OFFSET 0x0a | ||
| 707 | #define INIT_PORT_GUID0_OFFSET 0x10 | ||
| 708 | #define INIT_PORT_NODE_GUID_OFFSET 0x18 | ||
| 709 | #define INIT_PORT_SI_GUID_OFFSET 0x20 | ||
| 710 | |||
| 711 | mailbox = mlx4_alloc_cmd_mailbox(dev); | ||
| 712 | if (IS_ERR(mailbox)) | ||
| 713 | return PTR_ERR(mailbox); | ||
| 714 | inbox = mailbox->buf; | ||
| 715 | |||
| 716 | memset(inbox, 0, INIT_PORT_IN_SIZE); | ||
| 717 | |||
| 718 | flags = 0; | ||
| 719 | flags |= param->set_guid0 ? INIT_PORT_FLAG_G0 : 0; | ||
| 720 | flags |= param->set_node_guid ? INIT_PORT_FLAG_NG : 0; | ||
| 721 | flags |= param->set_si_guid ? INIT_PORT_FLAG_SIG : 0; | ||
| 722 | flags |= (param->vl_cap & 0xf) << INIT_PORT_VL_SHIFT; | ||
| 723 | flags |= (param->port_width_cap & 0xf) << INIT_PORT_PORT_WIDTH_SHIFT; | ||
| 724 | MLX4_PUT(inbox, flags, INIT_PORT_FLAGS_OFFSET); | ||
| 725 | |||
| 726 | MLX4_PUT(inbox, param->mtu, INIT_PORT_MTU_OFFSET); | ||
| 727 | MLX4_PUT(inbox, param->max_gid, INIT_PORT_MAX_GID_OFFSET); | ||
| 728 | MLX4_PUT(inbox, param->max_pkey, INIT_PORT_MAX_PKEY_OFFSET); | ||
| 729 | MLX4_PUT(inbox, param->guid0, INIT_PORT_GUID0_OFFSET); | ||
| 730 | MLX4_PUT(inbox, param->node_guid, INIT_PORT_NODE_GUID_OFFSET); | ||
| 731 | MLX4_PUT(inbox, param->si_guid, INIT_PORT_SI_GUID_OFFSET); | ||
| 732 | |||
| 733 | err = mlx4_cmd(dev, mailbox->dma, port, 0, MLX4_CMD_INIT_PORT, | ||
| 734 | MLX4_CMD_TIME_CLASS_A); | ||
| 735 | |||
| 736 | mlx4_free_cmd_mailbox(dev, mailbox); | ||
| 737 | |||
| 738 | return err; | ||
| 739 | } | ||
| 740 | EXPORT_SYMBOL_GPL(mlx4_INIT_PORT); | ||
| 741 | |||
| 742 | int mlx4_CLOSE_PORT(struct mlx4_dev *dev, int port) | ||
| 743 | { | ||
| 744 | return mlx4_cmd(dev, 0, port, 0, MLX4_CMD_CLOSE_PORT, 1000); | ||
| 745 | } | ||
| 746 | EXPORT_SYMBOL_GPL(mlx4_CLOSE_PORT); | ||
| 747 | |||
| 748 | int mlx4_CLOSE_HCA(struct mlx4_dev *dev, int panic) | ||
| 749 | { | ||
| 750 | return mlx4_cmd(dev, 0, 0, panic, MLX4_CMD_CLOSE_HCA, 1000); | ||
| 751 | } | ||
| 752 | |||
| 753 | int mlx4_SET_ICM_SIZE(struct mlx4_dev *dev, u64 icm_size, u64 *aux_pages) | ||
| 754 | { | ||
| 755 | int ret = mlx4_cmd_imm(dev, icm_size, aux_pages, 0, 0, | ||
| 756 | MLX4_CMD_SET_ICM_SIZE, | ||
| 757 | MLX4_CMD_TIME_CLASS_A); | ||
| 758 | if (ret) | ||
| 759 | return ret; | ||
| 760 | |||
| 761 | /* | ||
| 762 | * Round up number of system pages needed in case | ||
| 763 | * MLX4_ICM_PAGE_SIZE < PAGE_SIZE. | ||
| 764 | */ | ||
| 765 | *aux_pages = ALIGN(*aux_pages, PAGE_SIZE / MLX4_ICM_PAGE_SIZE) >> | ||
| 766 | (PAGE_SHIFT - MLX4_ICM_PAGE_SHIFT); | ||
| 767 | |||
| 768 | return 0; | ||
| 769 | } | ||
| 770 | |||
| 771 | int mlx4_NOP(struct mlx4_dev *dev) | ||
| 772 | { | ||
| 773 | /* Input modifier of 0x1f means "finish as soon as possible." */ | ||
| 774 | return mlx4_cmd(dev, 0, 0x1f, 0, MLX4_CMD_NOP, 100); | ||
| 775 | } | ||
diff --git a/drivers/net/mlx4/fw.h b/drivers/net/mlx4/fw.h new file mode 100644 index 000000000000..2616fa53d4d0 --- /dev/null +++ b/drivers/net/mlx4/fw.h | |||
| @@ -0,0 +1,167 @@ | |||
| 1 | /* | ||
| 2 | * Copyright (c) 2004, 2005 Topspin Communications. All rights reserved. | ||
| 3 | * Copyright (c) 2005 Mellanox Technologies. All rights reserved. | ||
| 4 | * Copyright (c) 2006, 2007 Cisco Systems. All rights reserved. | ||
| 5 | * | ||
| 6 | * This software is available to you under a choice of one of two | ||
| 7 | * licenses. You may choose to be licensed under the terms of the GNU | ||
| 8 | * General Public License (GPL) Version 2, available from the file | ||
| 9 | * COPYING in the main directory of this source tree, or the | ||
| 10 | * OpenIB.org BSD license below: | ||
| 11 | * | ||
| 12 | * Redistribution and use in source and binary forms, with or | ||
| 13 | * without modification, are permitted provided that the following | ||
| 14 | * conditions are met: | ||
| 15 | * | ||
| 16 | * - Redistributions of source code must retain the above | ||
| 17 | * copyright notice, this list of conditions and the following | ||
| 18 | * disclaimer. | ||
| 19 | * | ||
| 20 | * - Redistributions in binary form must reproduce the above | ||
| 21 | * copyright notice, this list of conditions and the following | ||
| 22 | * disclaimer in the documentation and/or other materials | ||
| 23 | * provided with the distribution. | ||
| 24 | * | ||
| 25 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, | ||
| 26 | * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF | ||
| 27 | * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND | ||
| 28 | * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS | ||
| 29 | * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN | ||
| 30 | * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN | ||
| 31 | * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE | ||
| 32 | * SOFTWARE. | ||
| 33 | */ | ||
| 34 | |||
| 35 | #ifndef MLX4_FW_H | ||
| 36 | #define MLX4_FW_H | ||
| 37 | |||
| 38 | #include "mlx4.h" | ||
| 39 | #include "icm.h" | ||
| 40 | |||
| 41 | struct mlx4_dev_cap { | ||
| 42 | int max_srq_sz; | ||
| 43 | int max_qp_sz; | ||
| 44 | int reserved_qps; | ||
| 45 | int max_qps; | ||
| 46 | int reserved_srqs; | ||
| 47 | int max_srqs; | ||
| 48 | int max_cq_sz; | ||
| 49 | int reserved_cqs; | ||
| 50 | int max_cqs; | ||
| 51 | int max_mpts; | ||
| 52 | int reserved_eqs; | ||
| 53 | int max_eqs; | ||
| 54 | int reserved_mtts; | ||
| 55 | int max_mrw_sz; | ||
| 56 | int reserved_mrws; | ||
| 57 | int max_mtt_seg; | ||
| 58 | int max_requester_per_qp; | ||
| 59 | int max_responder_per_qp; | ||
| 60 | int max_rdma_global; | ||
| 61 | int local_ca_ack_delay; | ||
| 62 | int max_mtu; | ||
| 63 | int max_port_width; | ||
| 64 | int max_vl; | ||
| 65 | int num_ports; | ||
| 66 | int max_gids; | ||
| 67 | u16 stat_rate_support; | ||
| 68 | int max_pkeys; | ||
| 69 | u32 flags; | ||
| 70 | int reserved_uars; | ||
| 71 | int uar_size; | ||
| 72 | int min_page_sz; | ||
| 73 | int bf_reg_size; | ||
| 74 | int bf_regs_per_page; | ||
| 75 | int max_sq_sg; | ||
| 76 | int max_sq_desc_sz; | ||
| 77 | int max_rq_sg; | ||
| 78 | int max_rq_desc_sz; | ||
| 79 | int max_qp_per_mcg; | ||
| 80 | int reserved_mgms; | ||
| 81 | int max_mcgs; | ||
| 82 | int reserved_pds; | ||
| 83 | int max_pds; | ||
| 84 | int qpc_entry_sz; | ||
| 85 | int rdmarc_entry_sz; | ||
| 86 | int altc_entry_sz; | ||
| 87 | int aux_entry_sz; | ||
| 88 | int srq_entry_sz; | ||
| 89 | int cqc_entry_sz; | ||
| 90 | int eqc_entry_sz; | ||
| 91 | int dmpt_entry_sz; | ||
| 92 | int cmpt_entry_sz; | ||
| 93 | int mtt_entry_sz; | ||
| 94 | int resize_srq; | ||
| 95 | u8 bmme_flags; | ||
| 96 | u32 reserved_lkey; | ||
| 97 | u64 max_icm_sz; | ||
| 98 | }; | ||
| 99 | |||
| 100 | struct mlx4_adapter { | ||
| 101 | u32 vendor_id; | ||
| 102 | u32 device_id; | ||
| 103 | u32 revision_id; | ||
| 104 | char board_id[MLX4_BOARD_ID_LEN]; | ||
| 105 | u8 inta_pin; | ||
| 106 | }; | ||
| 107 | |||
| 108 | struct mlx4_init_hca_param { | ||
| 109 | u64 qpc_base; | ||
| 110 | u64 rdmarc_base; | ||
| 111 | u64 auxc_base; | ||
| 112 | u64 altc_base; | ||
| 113 | u64 srqc_base; | ||
| 114 | u64 cqc_base; | ||
| 115 | u64 eqc_base; | ||
| 116 | u64 mc_base; | ||
| 117 | u64 dmpt_base; | ||
| 118 | u64 cmpt_base; | ||
| 119 | u64 mtt_base; | ||
| 120 | u16 log_mc_entry_sz; | ||
| 121 | u16 log_mc_hash_sz; | ||
| 122 | u8 log_num_qps; | ||
| 123 | u8 log_num_srqs; | ||
| 124 | u8 log_num_cqs; | ||
| 125 | u8 log_num_eqs; | ||
| 126 | u8 log_rd_per_qp; | ||
| 127 | u8 log_mc_table_sz; | ||
| 128 | u8 log_mpt_sz; | ||
| 129 | u8 log_uar_sz; | ||
| 130 | }; | ||
| 131 | |||
| 132 | struct mlx4_init_ib_param { | ||
| 133 | int port_width; | ||
| 134 | int vl_cap; | ||
| 135 | int mtu_cap; | ||
| 136 | u16 gid_cap; | ||
| 137 | u16 pkey_cap; | ||
| 138 | int set_guid0; | ||
| 139 | u64 guid0; | ||
| 140 | int set_node_guid; | ||
| 141 | u64 node_guid; | ||
| 142 | int set_si_guid; | ||
| 143 | u64 si_guid; | ||
| 144 | }; | ||
| 145 | |||
| 146 | struct mlx4_set_ib_param { | ||
| 147 | int set_si_guid; | ||
| 148 | int reset_qkey_viol; | ||
| 149 | u64 si_guid; | ||
| 150 | u32 cap_mask; | ||
| 151 | }; | ||
| 152 | |||
| 153 | int mlx4_QUERY_DEV_CAP(struct mlx4_dev *dev, struct mlx4_dev_cap *dev_cap); | ||
| 154 | int mlx4_MAP_FA(struct mlx4_dev *dev, struct mlx4_icm *icm); | ||
| 155 | int mlx4_UNMAP_FA(struct mlx4_dev *dev); | ||
| 156 | int mlx4_RUN_FW(struct mlx4_dev *dev); | ||
| 157 | int mlx4_QUERY_FW(struct mlx4_dev *dev); | ||
| 158 | int mlx4_QUERY_ADAPTER(struct mlx4_dev *dev, struct mlx4_adapter *adapter); | ||
| 159 | int mlx4_INIT_HCA(struct mlx4_dev *dev, struct mlx4_init_hca_param *param); | ||
| 160 | int mlx4_CLOSE_HCA(struct mlx4_dev *dev, int panic); | ||
| 161 | int mlx4_map_cmd(struct mlx4_dev *dev, u16 op, struct mlx4_icm *icm, u64 virt); | ||
| 162 | int mlx4_SET_ICM_SIZE(struct mlx4_dev *dev, u64 icm_size, u64 *aux_pages); | ||
| 163 | int mlx4_MAP_ICM_AUX(struct mlx4_dev *dev, struct mlx4_icm *icm); | ||
| 164 | int mlx4_UNMAP_ICM_AUX(struct mlx4_dev *dev); | ||
| 165 | int mlx4_NOP(struct mlx4_dev *dev); | ||
| 166 | |||
| 167 | #endif /* MLX4_FW_H */ | ||
diff --git a/drivers/net/mlx4/icm.c b/drivers/net/mlx4/icm.c new file mode 100644 index 000000000000..e96feaed6ed4 --- /dev/null +++ b/drivers/net/mlx4/icm.c | |||
| @@ -0,0 +1,379 @@ | |||
| 1 | /* | ||
| 2 | * Copyright (c) 2005 Mellanox Technologies. All rights reserved. | ||
| 3 | * Copyright (c) 2006, 2007 Cisco Systems, 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 | |||
| 34 | #include <linux/init.h> | ||
| 35 | #include <linux/errno.h> | ||
| 36 | |||
| 37 | #include <linux/mlx4/cmd.h> | ||
| 38 | |||
| 39 | #include "mlx4.h" | ||
| 40 | #include "icm.h" | ||
| 41 | #include "fw.h" | ||
| 42 | |||
| 43 | /* | ||
| 44 | * We allocate in as big chunks as we can, up to a maximum of 256 KB | ||
| 45 | * per chunk. | ||
| 46 | */ | ||
| 47 | enum { | ||
| 48 | MLX4_ICM_ALLOC_SIZE = 1 << 18, | ||
| 49 | MLX4_TABLE_CHUNK_SIZE = 1 << 18 | ||
| 50 | }; | ||
| 51 | |||
| 52 | void mlx4_free_icm(struct mlx4_dev *dev, struct mlx4_icm *icm) | ||
| 53 | { | ||
| 54 | struct mlx4_icm_chunk *chunk, *tmp; | ||
| 55 | int i; | ||
| 56 | |||
| 57 | list_for_each_entry_safe(chunk, tmp, &icm->chunk_list, list) { | ||
| 58 | if (chunk->nsg > 0) | ||
| 59 | pci_unmap_sg(dev->pdev, chunk->mem, chunk->npages, | ||
| 60 | PCI_DMA_BIDIRECTIONAL); | ||
| 61 | |||
| 62 | for (i = 0; i < chunk->npages; ++i) | ||
| 63 | __free_pages(chunk->mem[i].page, | ||
| 64 | get_order(chunk->mem[i].length)); | ||
| 65 | |||
| 66 | kfree(chunk); | ||
| 67 | } | ||
| 68 | |||
| 69 | kfree(icm); | ||
| 70 | } | ||
| 71 | |||
| 72 | struct mlx4_icm *mlx4_alloc_icm(struct mlx4_dev *dev, int npages, | ||
| 73 | gfp_t gfp_mask) | ||
| 74 | { | ||
| 75 | struct mlx4_icm *icm; | ||
| 76 | struct mlx4_icm_chunk *chunk = NULL; | ||
| 77 | int cur_order; | ||
| 78 | |||
| 79 | icm = kmalloc(sizeof *icm, gfp_mask & ~(__GFP_HIGHMEM | __GFP_NOWARN)); | ||
| 80 | if (!icm) | ||
| 81 | return icm; | ||
| 82 | |||
| 83 | icm->refcount = 0; | ||
| 84 | INIT_LIST_HEAD(&icm->chunk_list); | ||
| 85 | |||
| 86 | cur_order = get_order(MLX4_ICM_ALLOC_SIZE); | ||
| 87 | |||
| 88 | while (npages > 0) { | ||
| 89 | if (!chunk) { | ||
| 90 | chunk = kmalloc(sizeof *chunk, | ||
| 91 | gfp_mask & ~(__GFP_HIGHMEM | __GFP_NOWARN)); | ||
| 92 | if (!chunk) | ||
| 93 | goto fail; | ||
| 94 | |||
| 95 | chunk->npages = 0; | ||
| 96 | chunk->nsg = 0; | ||
| 97 | list_add_tail(&chunk->list, &icm->chunk_list); | ||
| 98 | } | ||
| 99 | |||
| 100 | while (1 << cur_order > npages) | ||
| 101 | --cur_order; | ||
| 102 | |||
| 103 | chunk->mem[chunk->npages].page = alloc_pages(gfp_mask, cur_order); | ||
| 104 | if (chunk->mem[chunk->npages].page) { | ||
| 105 | chunk->mem[chunk->npages].length = PAGE_SIZE << cur_order; | ||
| 106 | chunk->mem[chunk->npages].offset = 0; | ||
| 107 | |||
| 108 | if (++chunk->npages == MLX4_ICM_CHUNK_LEN) { | ||
| 109 | chunk->nsg = pci_map_sg(dev->pdev, chunk->mem, | ||
| 110 | chunk->npages, | ||
| 111 | PCI_DMA_BIDIRECTIONAL); | ||
| 112 | |||
| 113 | if (chunk->nsg <= 0) | ||
| 114 | goto fail; | ||
| 115 | |||
| 116 | chunk = NULL; | ||
| 117 | } | ||
| 118 | |||
| 119 | npages -= 1 << cur_order; | ||
| 120 | } else { | ||
| 121 | --cur_order; | ||
| 122 | if (cur_order < 0) | ||
| 123 | goto fail; | ||
| 124 | } | ||
| 125 | } | ||
| 126 | |||
| 127 | if (chunk) { | ||
| 128 | chunk->nsg = pci_map_sg(dev->pdev, chunk->mem, | ||
| 129 | chunk->npages, | ||
| 130 | PCI_DMA_BIDIRECTIONAL); | ||
| 131 | |||
| 132 | if (chunk->nsg <= 0) | ||
| 133 | goto fail; | ||
| 134 | } | ||
| 135 | |||
| 136 | return icm; | ||
| 137 | |||
| 138 | fail: | ||
| 139 | mlx4_free_icm(dev, icm); | ||
| 140 | return NULL; | ||
| 141 | } | ||
| 142 | |||
| 143 | static int mlx4_MAP_ICM(struct mlx4_dev *dev, struct mlx4_icm *icm, u64 virt) | ||
| 144 | { | ||
| 145 | return mlx4_map_cmd(dev, MLX4_CMD_MAP_ICM, icm, virt); | ||
| 146 | } | ||
| 147 | |||
| 148 | int mlx4_UNMAP_ICM(struct mlx4_dev *dev, u64 virt, u32 page_count) | ||
| 149 | { | ||
| 150 | return mlx4_cmd(dev, virt, page_count, 0, MLX4_CMD_UNMAP_ICM, | ||
| 151 | MLX4_CMD_TIME_CLASS_B); | ||
| 152 | } | ||
| 153 | |||
| 154 | int mlx4_MAP_ICM_page(struct mlx4_dev *dev, u64 dma_addr, u64 virt) | ||
| 155 | { | ||
| 156 | struct mlx4_cmd_mailbox *mailbox; | ||
| 157 | __be64 *inbox; | ||
| 158 | int err; | ||
| 159 | |||
| 160 | mailbox = mlx4_alloc_cmd_mailbox(dev); | ||
| 161 | if (IS_ERR(mailbox)) | ||
| 162 | return PTR_ERR(mailbox); | ||
| 163 | inbox = mailbox->buf; | ||
| 164 | |||
| 165 | inbox[0] = cpu_to_be64(virt); | ||
| 166 | inbox[1] = cpu_to_be64(dma_addr); | ||
| 167 | |||
| 168 | err = mlx4_cmd(dev, mailbox->dma, 1, 0, MLX4_CMD_MAP_ICM, | ||
| 169 | MLX4_CMD_TIME_CLASS_B); | ||
| 170 | |||
| 171 | mlx4_free_cmd_mailbox(dev, mailbox); | ||
| 172 | |||
| 173 | if (!err) | ||
| 174 | mlx4_dbg(dev, "Mapped page at %llx to %llx for ICM.\n", | ||
| 175 | (unsigned long long) dma_addr, (unsigned long long) virt); | ||
| 176 | |||
| 177 | return err; | ||
| 178 | } | ||
| 179 | |||
| 180 | int mlx4_MAP_ICM_AUX(struct mlx4_dev *dev, struct mlx4_icm *icm) | ||
| 181 | { | ||
| 182 | return mlx4_map_cmd(dev, MLX4_CMD_MAP_ICM_AUX, icm, -1); | ||
| 183 | } | ||
| 184 | |||
| 185 | int mlx4_UNMAP_ICM_AUX(struct mlx4_dev *dev) | ||
| 186 | { | ||
| 187 | return mlx4_cmd(dev, 0, 0, 0, MLX4_CMD_UNMAP_ICM_AUX, MLX4_CMD_TIME_CLASS_B); | ||
| 188 | } | ||
| 189 | |||
| 190 | int mlx4_table_get(struct mlx4_dev *dev, struct mlx4_icm_table *table, int obj) | ||
| 191 | { | ||
| 192 | int i = (obj & (table->num_obj - 1)) / (MLX4_TABLE_CHUNK_SIZE / table->obj_size); | ||
| 193 | int ret = 0; | ||
| 194 | |||
| 195 | mutex_lock(&table->mutex); | ||
| 196 | |||
| 197 | if (table->icm[i]) { | ||
| 198 | ++table->icm[i]->refcount; | ||
| 199 | goto out; | ||
| 200 | } | ||
| 201 | |||
| 202 | table->icm[i] = mlx4_alloc_icm(dev, MLX4_TABLE_CHUNK_SIZE >> PAGE_SHIFT, | ||
| 203 | (table->lowmem ? GFP_KERNEL : GFP_HIGHUSER) | | ||
| 204 | __GFP_NOWARN); | ||
| 205 | if (!table->icm[i]) { | ||
| 206 | ret = -ENOMEM; | ||
| 207 | goto out; | ||
| 208 | } | ||
| 209 | |||
| 210 | if (mlx4_MAP_ICM(dev, table->icm[i], table->virt + | ||
| 211 | (u64) i * MLX4_TABLE_CHUNK_SIZE)) { | ||
| 212 | mlx4_free_icm(dev, table->icm[i]); | ||
| 213 | table->icm[i] = NULL; | ||
| 214 | ret = -ENOMEM; | ||
| 215 | goto out; | ||
| 216 | } | ||
| 217 | |||
| 218 | ++table->icm[i]->refcount; | ||
| 219 | |||
| 220 | out: | ||
| 221 | mutex_unlock(&table->mutex); | ||
| 222 | return ret; | ||
| 223 | } | ||
| 224 | |||
| 225 | void mlx4_table_put(struct mlx4_dev *dev, struct mlx4_icm_table *table, int obj) | ||
| 226 | { | ||
| 227 | int i; | ||
| 228 | |||
| 229 | i = (obj & (table->num_obj - 1)) / (MLX4_TABLE_CHUNK_SIZE / table->obj_size); | ||
| 230 | |||
| 231 | mutex_lock(&table->mutex); | ||
| 232 | |||
| 233 | if (--table->icm[i]->refcount == 0) { | ||
| 234 | mlx4_UNMAP_ICM(dev, table->virt + i * MLX4_TABLE_CHUNK_SIZE, | ||
| 235 | MLX4_TABLE_CHUNK_SIZE / MLX4_ICM_PAGE_SIZE); | ||
| 236 | mlx4_free_icm(dev, table->icm[i]); | ||
| 237 | table->icm[i] = NULL; | ||
| 238 | } | ||
| 239 | |||
| 240 | mutex_unlock(&table->mutex); | ||
| 241 | } | ||
| 242 | |||
| 243 | void *mlx4_table_find(struct mlx4_icm_table *table, int obj) | ||
| 244 | { | ||
| 245 | int idx, offset, i; | ||
| 246 | struct mlx4_icm_chunk *chunk; | ||
| 247 | struct mlx4_icm *icm; | ||
| 248 | struct page *page = NULL; | ||
| 249 | |||
| 250 | if (!table->lowmem) | ||
| 251 | return NULL; | ||
| 252 | |||
| 253 | mutex_lock(&table->mutex); | ||
| 254 | |||
| 255 | idx = obj & (table->num_obj - 1); | ||
| 256 | icm = table->icm[idx / (MLX4_TABLE_CHUNK_SIZE / table->obj_size)]; | ||
| 257 | offset = idx % (MLX4_TABLE_CHUNK_SIZE / table->obj_size); | ||
| 258 | |||
| 259 | if (!icm) | ||
| 260 | goto out; | ||
| 261 | |||
| 262 | list_for_each_entry(chunk, &icm->chunk_list, list) { | ||
| 263 | for (i = 0; i < chunk->npages; ++i) { | ||
| 264 | if (chunk->mem[i].length > offset) { | ||
| 265 | page = chunk->mem[i].page; | ||
| 266 | goto out; | ||
| 267 | } | ||
| 268 | offset -= chunk->mem[i].length; | ||
| 269 | } | ||
| 270 | } | ||
| 271 | |||
| 272 | out: | ||
| 273 | mutex_unlock(&table->mutex); | ||
| 274 | return page ? lowmem_page_address(page) + offset : NULL; | ||
| 275 | } | ||
| 276 | |||
| 277 | int mlx4_table_get_range(struct mlx4_dev *dev, struct mlx4_icm_table *table, | ||
| 278 | int start, int end) | ||
| 279 | { | ||
| 280 | int inc = MLX4_TABLE_CHUNK_SIZE / table->obj_size; | ||
| 281 | int i, err; | ||
| 282 | |||
| 283 | for (i = start; i <= end; i += inc) { | ||
| 284 | err = mlx4_table_get(dev, table, i); | ||
| 285 | if (err) | ||
| 286 | goto fail; | ||
| 287 | } | ||
| 288 | |||
| 289 | return 0; | ||
| 290 | |||
| 291 | fail: | ||
| 292 | while (i > start) { | ||
| 293 | i -= inc; | ||
| 294 | mlx4_table_put(dev, table, i); | ||
| 295 | } | ||
| 296 | |||
| 297 | return err; | ||
| 298 | } | ||
| 299 | |||
| 300 | void mlx4_table_put_range(struct mlx4_dev *dev, struct mlx4_icm_table *table, | ||
| 301 | int start, int end) | ||
| 302 | { | ||
| 303 | int i; | ||
| 304 | |||
| 305 | for (i = start; i <= end; i += MLX4_TABLE_CHUNK_SIZE / table->obj_size) | ||
| 306 | mlx4_table_put(dev, table, i); | ||
| 307 | } | ||
| 308 | |||
| 309 | int mlx4_init_icm_table(struct mlx4_dev *dev, struct mlx4_icm_table *table, | ||
| 310 | u64 virt, int obj_size, int nobj, int reserved, | ||
| 311 | int use_lowmem) | ||
| 312 | { | ||
| 313 | int obj_per_chunk; | ||
| 314 | int num_icm; | ||
| 315 | unsigned chunk_size; | ||
| 316 | int i; | ||
| 317 | |||
| 318 | obj_per_chunk = MLX4_TABLE_CHUNK_SIZE / obj_size; | ||
| 319 | num_icm = (nobj + obj_per_chunk - 1) / obj_per_chunk; | ||
| 320 | |||
| 321 | table->icm = kcalloc(num_icm, sizeof *table->icm, GFP_KERNEL); | ||
| 322 | if (!table->icm) | ||
| 323 | return -ENOMEM; | ||
| 324 | table->virt = virt; | ||
| 325 | table->num_icm = num_icm; | ||
| 326 | table->num_obj = nobj; | ||
| 327 | table->obj_size = obj_size; | ||
| 328 | table->lowmem = use_lowmem; | ||
| 329 | mutex_init(&table->mutex); | ||
| 330 | |||
| 331 | for (i = 0; i * MLX4_TABLE_CHUNK_SIZE < reserved * obj_size; ++i) { | ||
| 332 | chunk_size = MLX4_TABLE_CHUNK_SIZE; | ||
| 333 | if ((i + 1) * MLX4_TABLE_CHUNK_SIZE > nobj * obj_size) | ||
| 334 | chunk_size = PAGE_ALIGN(nobj * obj_size - i * MLX4_TABLE_CHUNK_SIZE); | ||
| 335 | |||
| 336 | table->icm[i] = mlx4_alloc_icm(dev, chunk_size >> PAGE_SHIFT, | ||
| 337 | (use_lowmem ? GFP_KERNEL : GFP_HIGHUSER) | | ||
| 338 | __GFP_NOWARN); | ||
| 339 | if (!table->icm[i]) | ||
| 340 | goto err; | ||
| 341 | if (mlx4_MAP_ICM(dev, table->icm[i], virt + i * MLX4_TABLE_CHUNK_SIZE)) { | ||
| 342 | mlx4_free_icm(dev, table->icm[i]); | ||
| 343 | table->icm[i] = NULL; | ||
| 344 | goto err; | ||
| 345 | } | ||
| 346 | |||
| 347 | /* | ||
| 348 | * Add a reference to this ICM chunk so that it never | ||
| 349 | * gets freed (since it contains reserved firmware objects). | ||
| 350 | */ | ||
| 351 | ++table->icm[i]->refcount; | ||
| 352 | } | ||
| 353 | |||
| 354 | return 0; | ||
| 355 | |||
| 356 | err: | ||
| 357 | for (i = 0; i < num_icm; ++i) | ||
| 358 | if (table->icm[i]) { | ||
| 359 | mlx4_UNMAP_ICM(dev, virt + i * MLX4_TABLE_CHUNK_SIZE, | ||
| 360 | MLX4_TABLE_CHUNK_SIZE / MLX4_ICM_PAGE_SIZE); | ||
| 361 | mlx4_free_icm(dev, table->icm[i]); | ||
| 362 | } | ||
| 363 | |||
| 364 | return -ENOMEM; | ||
| 365 | } | ||
| 366 | |||
| 367 | void mlx4_cleanup_icm_table(struct mlx4_dev *dev, struct mlx4_icm_table *table) | ||
| 368 | { | ||
| 369 | int i; | ||
| 370 | |||
| 371 | for (i = 0; i < table->num_icm; ++i) | ||
| 372 | if (table->icm[i]) { | ||
| 373 | mlx4_UNMAP_ICM(dev, table->virt + i * MLX4_TABLE_CHUNK_SIZE, | ||
| 374 | MLX4_TABLE_CHUNK_SIZE / MLX4_ICM_PAGE_SIZE); | ||
| 375 | mlx4_free_icm(dev, table->icm[i]); | ||
| 376 | } | ||
| 377 | |||
| 378 | kfree(table->icm); | ||
| 379 | } | ||
diff --git a/drivers/net/mlx4/icm.h b/drivers/net/mlx4/icm.h new file mode 100644 index 000000000000..bea223d879a5 --- /dev/null +++ b/drivers/net/mlx4/icm.h | |||
| @@ -0,0 +1,135 @@ | |||
| 1 | /* | ||
| 2 | * Copyright (c) 2005 Mellanox Technologies. All rights reserved. | ||
| 3 | * Copyright (c) 2006, 2007 Cisco Systems, 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 | |||
| 34 | #ifndef MLX4_ICM_H | ||
| 35 | #define MLX4_ICM_H | ||
| 36 | |||
| 37 | #include <linux/list.h> | ||
| 38 | #include <linux/pci.h> | ||
| 39 | #include <linux/mutex.h> | ||
| 40 | |||
| 41 | #define MLX4_ICM_CHUNK_LEN \ | ||
| 42 | ((256 - sizeof (struct list_head) - 2 * sizeof (int)) / \ | ||
| 43 | (sizeof (struct scatterlist))) | ||
| 44 | |||
| 45 | enum { | ||
| 46 | MLX4_ICM_PAGE_SHIFT = 12, | ||
| 47 | MLX4_ICM_PAGE_SIZE = 1 << MLX4_ICM_PAGE_SHIFT, | ||
| 48 | }; | ||
| 49 | |||
| 50 | struct mlx4_icm_chunk { | ||
| 51 | struct list_head list; | ||
| 52 | int npages; | ||
| 53 | int nsg; | ||
| 54 | struct scatterlist mem[MLX4_ICM_CHUNK_LEN]; | ||
| 55 | }; | ||
| 56 | |||
| 57 | struct mlx4_icm { | ||
| 58 | struct list_head chunk_list; | ||
| 59 | int refcount; | ||
| 60 | }; | ||
| 61 | |||
| 62 | struct mlx4_icm_iter { | ||
| 63 | struct mlx4_icm *icm; | ||
| 64 | struct mlx4_icm_chunk *chunk; | ||
| 65 | int page_idx; | ||
| 66 | }; | ||
| 67 | |||
| 68 | struct mlx4_dev; | ||
| 69 | |||
| 70 | struct mlx4_icm *mlx4_alloc_icm(struct mlx4_dev *dev, int npages, gfp_t gfp_mask); | ||
| 71 | void mlx4_free_icm(struct mlx4_dev *dev, struct mlx4_icm *icm); | ||
| 72 | |||
| 73 | int mlx4_table_get(struct mlx4_dev *dev, struct mlx4_icm_table *table, int obj); | ||
| 74 | void mlx4_table_put(struct mlx4_dev *dev, struct mlx4_icm_table *table, int obj); | ||
| 75 | int mlx4_table_get_range(struct mlx4_dev *dev, struct mlx4_icm_table *table, | ||
| 76 | int start, int end); | ||
| 77 | void mlx4_table_put_range(struct mlx4_dev *dev, struct mlx4_icm_table *table, | ||
| 78 | int start, int end); | ||
| 79 | int mlx4_init_icm_table(struct mlx4_dev *dev, struct mlx4_icm_table *table, | ||
| 80 | u64 virt, int obj_size, int nobj, int reserved, | ||
| 81 | int use_lowmem); | ||
| 82 | void mlx4_cleanup_icm_table(struct mlx4_dev *dev, struct mlx4_icm_table *table); | ||
| 83 | int mlx4_table_get(struct mlx4_dev *dev, struct mlx4_icm_table *table, int obj); | ||
| 84 | void mlx4_table_put(struct mlx4_dev *dev, struct mlx4_icm_table *table, int obj); | ||
| 85 | void *mlx4_table_find(struct mlx4_icm_table *table, int obj); | ||
| 86 | int mlx4_table_get_range(struct mlx4_dev *dev, struct mlx4_icm_table *table, | ||
| 87 | int start, int end); | ||
| 88 | void mlx4_table_put_range(struct mlx4_dev *dev, struct mlx4_icm_table *table, | ||
| 89 | int start, int end); | ||
| 90 | |||
| 91 | static inline void mlx4_icm_first(struct mlx4_icm *icm, | ||
| 92 | struct mlx4_icm_iter *iter) | ||
| 93 | { | ||
| 94 | iter->icm = icm; | ||
| 95 | iter->chunk = list_empty(&icm->chunk_list) ? | ||
| 96 | NULL : list_entry(icm->chunk_list.next, | ||
| 97 | struct mlx4_icm_chunk, list); | ||
| 98 | iter->page_idx = 0; | ||
| 99 | } | ||
| 100 | |||
| 101 | static inline int mlx4_icm_last(struct mlx4_icm_iter *iter) | ||
| 102 | { | ||
| 103 | return !iter->chunk; | ||
| 104 | } | ||
| 105 | |||
| 106 | static inline void mlx4_icm_next(struct mlx4_icm_iter *iter) | ||
| 107 | { | ||
| 108 | if (++iter->page_idx >= iter->chunk->nsg) { | ||
| 109 | if (iter->chunk->list.next == &iter->icm->chunk_list) { | ||
| 110 | iter->chunk = NULL; | ||
| 111 | return; | ||
| 112 | } | ||
| 113 | |||
| 114 | iter->chunk = list_entry(iter->chunk->list.next, | ||
| 115 | struct mlx4_icm_chunk, list); | ||
| 116 | iter->page_idx = 0; | ||
| 117 | } | ||
| 118 | } | ||
| 119 | |||
| 120 | static inline dma_addr_t mlx4_icm_addr(struct mlx4_icm_iter *iter) | ||
| 121 | { | ||
| 122 | return sg_dma_address(&iter->chunk->mem[iter->page_idx]); | ||
| 123 | } | ||
| 124 | |||
| 125 | static inline unsigned long mlx4_icm_size(struct mlx4_icm_iter *iter) | ||
| 126 | { | ||
| 127 | return sg_dma_len(&iter->chunk->mem[iter->page_idx]); | ||
| 128 | } | ||
| 129 | |||
| 130 | int mlx4_UNMAP_ICM(struct mlx4_dev *dev, u64 virt, u32 page_count); | ||
| 131 | int mlx4_MAP_ICM_page(struct mlx4_dev *dev, u64 dma_addr, u64 virt); | ||
| 132 | int mlx4_MAP_ICM_AUX(struct mlx4_dev *dev, struct mlx4_icm *icm); | ||
| 133 | int mlx4_UNMAP_ICM_AUX(struct mlx4_dev *dev); | ||
| 134 | |||
| 135 | #endif /* MLX4_ICM_H */ | ||
diff --git a/drivers/net/mlx4/intf.c b/drivers/net/mlx4/intf.c new file mode 100644 index 000000000000..65854f9e9c76 --- /dev/null +++ b/drivers/net/mlx4/intf.c | |||
| @@ -0,0 +1,165 @@ | |||
| 1 | /* | ||
| 2 | * Copyright (c) 2006, 2007 Cisco Systems, Inc. All rights reserved. | ||
| 3 | * | ||
| 4 | * This software is available to you under a choice of one of two | ||
| 5 | * licenses. You may choose to be licensed under the terms of the GNU | ||
| 6 | * General Public License (GPL) Version 2, available from the file | ||
| 7 | * COPYING in the main directory of this source tree, or the | ||
| 8 | * OpenIB.org BSD license below: | ||
| 9 | * | ||
| 10 | * Redistribution and use in source and binary forms, with or | ||
| 11 | * without modification, are permitted provided that the following | ||
| 12 | * conditions are met: | ||
| 13 | * | ||
| 14 | * - Redistributions of source code must retain the above | ||
| 15 | * copyright notice, this list of conditions and the following | ||
| 16 | * disclaimer. | ||
| 17 | * | ||
| 18 | * - Redistributions in binary form must reproduce the above | ||
| 19 | * copyright notice, this list of conditions and the following | ||
| 20 | * disclaimer in the documentation and/or other materials | ||
| 21 | * provided with the distribution. | ||
| 22 | * | ||
| 23 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, | ||
| 24 | * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF | ||
| 25 | * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND | ||
| 26 | * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS | ||
| 27 | * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN | ||
| 28 | * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN | ||
| 29 | * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE | ||
| 30 | * SOFTWARE. | ||
| 31 | */ | ||
| 32 | |||
| 33 | #include <linux/mlx4/driver.h> | ||
| 34 | |||
| 35 | #include "mlx4.h" | ||
| 36 | |||
| 37 | struct mlx4_device_context { | ||
| 38 | struct list_head list; | ||
| 39 | struct mlx4_interface *intf; | ||
| 40 | void *context; | ||
| 41 | }; | ||
| 42 | |||
| 43 | static LIST_HEAD(intf_list); | ||
| 44 | static LIST_HEAD(dev_list); | ||
| 45 | static DEFINE_MUTEX(intf_mutex); | ||
| 46 | |||
| 47 | static void mlx4_add_device(struct mlx4_interface *intf, struct mlx4_priv *priv) | ||
| 48 | { | ||
| 49 | struct mlx4_device_context *dev_ctx; | ||
| 50 | |||
| 51 | dev_ctx = kmalloc(sizeof *dev_ctx, GFP_KERNEL); | ||
| 52 | if (!dev_ctx) | ||
| 53 | return; | ||
| 54 | |||
| 55 | dev_ctx->intf = intf; | ||
| 56 | dev_ctx->context = intf->add(&priv->dev); | ||
| 57 | |||
| 58 | if (dev_ctx->context) { | ||
| 59 | spin_lock_irq(&priv->ctx_lock); | ||
| 60 | list_add_tail(&dev_ctx->list, &priv->ctx_list); | ||
| 61 | spin_unlock_irq(&priv->ctx_lock); | ||
| 62 | } else | ||
| 63 | kfree(dev_ctx); | ||
| 64 | } | ||
| 65 | |||
| 66 | static void mlx4_remove_device(struct mlx4_interface *intf, struct mlx4_priv *priv) | ||
| 67 | { | ||
| 68 | struct mlx4_device_context *dev_ctx; | ||
| 69 | |||
| 70 | list_for_each_entry(dev_ctx, &priv->ctx_list, list) | ||
| 71 | if (dev_ctx->intf == intf) { | ||
| 72 | spin_lock_irq(&priv->ctx_lock); | ||
| 73 | list_del(&dev_ctx->list); | ||
| 74 | spin_unlock_irq(&priv->ctx_lock); | ||
| 75 | |||
| 76 | intf->remove(&priv->dev, dev_ctx->context); | ||
| 77 | kfree(dev_ctx); | ||
| 78 | return; | ||
| 79 | } | ||
| 80 | } | ||
| 81 | |||
| 82 | int mlx4_register_interface(struct mlx4_interface *intf) | ||
| 83 | { | ||
| 84 | struct mlx4_priv *priv; | ||
| 85 | |||
| 86 | if (!intf->add || !intf->remove) | ||
| 87 | return -EINVAL; | ||
| 88 | |||
| 89 | mutex_lock(&intf_mutex); | ||
| 90 | |||
| 91 | list_add_tail(&intf->list, &intf_list); | ||
| 92 | list_for_each_entry(priv, &dev_list, dev_list) | ||
| 93 | mlx4_add_device(intf, priv); | ||
| 94 | |||
| 95 | mutex_unlock(&intf_mutex); | ||
| 96 | |||
| 97 | return 0; | ||
| 98 | } | ||
| 99 | EXPORT_SYMBOL_GPL(mlx4_register_interface); | ||
| 100 | |||
| 101 | void mlx4_unregister_interface(struct mlx4_interface *intf) | ||
| 102 | { | ||
| 103 | struct mlx4_priv *priv; | ||
| 104 | |||
| 105 | mutex_lock(&intf_mutex); | ||
| 106 | |||
| 107 | list_for_each_entry(priv, &dev_list, dev_list) | ||
| 108 | mlx4_remove_device(intf, priv); | ||
| 109 | |||
| 110 | list_del(&intf->list); | ||
| 111 | |||
| 112 | mutex_unlock(&intf_mutex); | ||
| 113 | } | ||
| 114 | EXPORT_SYMBOL_GPL(mlx4_unregister_interface); | ||
| 115 | |||
| 116 | void mlx4_dispatch_event(struct mlx4_dev *dev, enum mlx4_event type, | ||
| 117 | int subtype, int port) | ||
| 118 | { | ||
| 119 | struct mlx4_priv *priv = mlx4_priv(dev); | ||
| 120 | struct mlx4_device_context *dev_ctx; | ||
| 121 | unsigned long flags; | ||
| 122 | |||
| 123 | spin_lock_irqsave(&priv->ctx_lock, flags); | ||
| 124 | |||
| 125 | list_for_each_entry(dev_ctx, &priv->ctx_list, list) | ||
| 126 | if (dev_ctx->intf->event) | ||
| 127 | dev_ctx->intf->event(dev, dev_ctx->context, type, | ||
| 128 | subtype, port); | ||
| 129 | |||
| 130 | spin_unlock_irqrestore(&priv->ctx_lock, flags); | ||
| 131 | } | ||
| 132 | |||
| 133 | int mlx4_register_device(struct mlx4_dev *dev) | ||
| 134 | { | ||
| 135 | struct mlx4_priv *priv = mlx4_priv(dev); | ||
| 136 | struct mlx4_interface *intf; | ||
| 137 | |||
| 138 | INIT_LIST_HEAD(&priv->ctx_list); | ||
| 139 | spin_lock_init(&priv->ctx_lock); | ||
| 140 | |||
| 141 | mutex_lock(&intf_mutex); | ||
| 142 | |||
| 143 | list_add_tail(&priv->dev_list, &dev_list); | ||
| 144 | list_for_each_entry(intf, &intf_list, list) | ||
| 145 | mlx4_add_device(intf, priv); | ||
| 146 | |||
| 147 | mutex_unlock(&intf_mutex); | ||
| 148 | |||
| 149 | return 0; | ||
| 150 | } | ||
| 151 | |||
| 152 | void mlx4_unregister_device(struct mlx4_dev *dev) | ||
| 153 | { | ||
| 154 | struct mlx4_priv *priv = mlx4_priv(dev); | ||
| 155 | struct mlx4_interface *intf; | ||
| 156 | |||
| 157 | mutex_lock(&intf_mutex); | ||
| 158 | |||
| 159 | list_for_each_entry(intf, &intf_list, list) | ||
| 160 | mlx4_remove_device(intf, priv); | ||
| 161 | |||
| 162 | list_del(&priv->dev_list); | ||
| 163 | |||
| 164 | mutex_unlock(&intf_mutex); | ||
| 165 | } | ||
diff --git a/drivers/net/mlx4/main.c b/drivers/net/mlx4/main.c new file mode 100644 index 000000000000..4debb024eaf9 --- /dev/null +++ b/drivers/net/mlx4/main.c | |||
| @@ -0,0 +1,936 @@ | |||
| 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) 2006, 2007 Cisco Systems, 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/module.h> | ||
| 37 | #include <linux/init.h> | ||
| 38 | #include <linux/errno.h> | ||
| 39 | #include <linux/pci.h> | ||
| 40 | #include <linux/dma-mapping.h> | ||
| 41 | |||
| 42 | #include <linux/mlx4/device.h> | ||
| 43 | #include <linux/mlx4/doorbell.h> | ||
| 44 | |||
| 45 | #include "mlx4.h" | ||
| 46 | #include "fw.h" | ||
| 47 | #include "icm.h" | ||
| 48 | |||
| 49 | MODULE_AUTHOR("Roland Dreier"); | ||
| 50 | MODULE_DESCRIPTION("Mellanox ConnectX HCA low-level driver"); | ||
| 51 | MODULE_LICENSE("Dual BSD/GPL"); | ||
| 52 | MODULE_VERSION(DRV_VERSION); | ||
| 53 | |||
| 54 | #ifdef CONFIG_MLX4_DEBUG | ||
| 55 | |||
| 56 | int mlx4_debug_level = 0; | ||
| 57 | module_param_named(debug_level, mlx4_debug_level, int, 0644); | ||
| 58 | MODULE_PARM_DESC(debug_level, "Enable debug tracing if > 0"); | ||
| 59 | |||
| 60 | #endif /* CONFIG_MLX4_DEBUG */ | ||
| 61 | |||
| 62 | #ifdef CONFIG_PCI_MSI | ||
| 63 | |||
| 64 | static int msi_x; | ||
| 65 | module_param(msi_x, int, 0444); | ||
| 66 | MODULE_PARM_DESC(msi_x, "attempt to use MSI-X if nonzero"); | ||
| 67 | |||
| 68 | #else /* CONFIG_PCI_MSI */ | ||
| 69 | |||
| 70 | #define msi_x (0) | ||
| 71 | |||
| 72 | #endif /* CONFIG_PCI_MSI */ | ||
| 73 | |||
| 74 | static const char mlx4_version[] __devinitdata = | ||
| 75 | DRV_NAME ": Mellanox ConnectX core driver v" | ||
| 76 | DRV_VERSION " (" DRV_RELDATE ")\n"; | ||
| 77 | |||
| 78 | static struct mlx4_profile default_profile = { | ||
| 79 | .num_qp = 1 << 16, | ||
| 80 | .num_srq = 1 << 16, | ||
| 81 | .rdmarc_per_qp = 4, | ||
| 82 | .num_cq = 1 << 16, | ||
| 83 | .num_mcg = 1 << 13, | ||
| 84 | .num_mpt = 1 << 17, | ||
| 85 | .num_mtt = 1 << 20, | ||
| 86 | }; | ||
| 87 | |||
| 88 | static int __devinit mlx4_dev_cap(struct mlx4_dev *dev, struct mlx4_dev_cap *dev_cap) | ||
| 89 | { | ||
| 90 | int err; | ||
| 91 | |||
| 92 | err = mlx4_QUERY_DEV_CAP(dev, dev_cap); | ||
| 93 | if (err) { | ||
| 94 | mlx4_err(dev, "QUERY_DEV_CAP command failed, aborting.\n"); | ||
| 95 | return err; | ||
| 96 | } | ||
| 97 | |||
| 98 | if (dev_cap->min_page_sz > PAGE_SIZE) { | ||
| 99 | mlx4_err(dev, "HCA minimum page size of %d bigger than " | ||
| 100 | "kernel PAGE_SIZE of %ld, aborting.\n", | ||
| 101 | dev_cap->min_page_sz, PAGE_SIZE); | ||
| 102 | return -ENODEV; | ||
| 103 | } | ||
| 104 | if (dev_cap->num_ports > MLX4_MAX_PORTS) { | ||
| 105 | mlx4_err(dev, "HCA has %d ports, but we only support %d, " | ||
| 106 | "aborting.\n", | ||
| 107 | dev_cap->num_ports, MLX4_MAX_PORTS); | ||
| 108 | return -ENODEV; | ||
| 109 | } | ||
| 110 | |||
| 111 | if (dev_cap->uar_size > pci_resource_len(dev->pdev, 2)) { | ||
| 112 | mlx4_err(dev, "HCA reported UAR size of 0x%x bigger than " | ||
| 113 | "PCI resource 2 size of 0x%llx, aborting.\n", | ||
| 114 | dev_cap->uar_size, | ||
| 115 | (unsigned long long) pci_resource_len(dev->pdev, 2)); | ||
| 116 | return -ENODEV; | ||
| 117 | } | ||
| 118 | |||
| 119 | dev->caps.num_ports = dev_cap->num_ports; | ||
| 120 | dev->caps.num_uars = dev_cap->uar_size / PAGE_SIZE; | ||
| 121 | dev->caps.vl_cap = dev_cap->max_vl; | ||
| 122 | dev->caps.mtu_cap = dev_cap->max_mtu; | ||
| 123 | dev->caps.gid_table_len = dev_cap->max_gids; | ||
| 124 | dev->caps.pkey_table_len = dev_cap->max_pkeys; | ||
| 125 | dev->caps.local_ca_ack_delay = dev_cap->local_ca_ack_delay; | ||
| 126 | dev->caps.bf_reg_size = dev_cap->bf_reg_size; | ||
| 127 | dev->caps.bf_regs_per_page = dev_cap->bf_regs_per_page; | ||
| 128 | dev->caps.max_sq_sg = dev_cap->max_sq_sg; | ||
| 129 | dev->caps.max_rq_sg = dev_cap->max_rq_sg; | ||
| 130 | dev->caps.max_wqes = dev_cap->max_qp_sz; | ||
| 131 | dev->caps.max_qp_init_rdma = dev_cap->max_requester_per_qp; | ||
| 132 | dev->caps.reserved_qps = dev_cap->reserved_qps; | ||
| 133 | dev->caps.max_srq_wqes = dev_cap->max_srq_sz; | ||
| 134 | dev->caps.max_srq_sge = dev_cap->max_rq_sg - 1; | ||
| 135 | dev->caps.reserved_srqs = dev_cap->reserved_srqs; | ||
| 136 | dev->caps.max_sq_desc_sz = dev_cap->max_sq_desc_sz; | ||
| 137 | dev->caps.max_rq_desc_sz = dev_cap->max_rq_desc_sz; | ||
| 138 | dev->caps.num_qp_per_mgm = MLX4_QP_PER_MGM; | ||
| 139 | /* | ||
| 140 | * Subtract 1 from the limit because we need to allocate a | ||
| 141 | * spare CQE so the HCA HW can tell the difference between an | ||
| 142 | * empty CQ and a full CQ. | ||
| 143 | */ | ||
| 144 | dev->caps.max_cqes = dev_cap->max_cq_sz - 1; | ||
| 145 | dev->caps.reserved_cqs = dev_cap->reserved_cqs; | ||
| 146 | dev->caps.reserved_eqs = dev_cap->reserved_eqs; | ||
| 147 | dev->caps.reserved_mtts = dev_cap->reserved_mtts; | ||
| 148 | dev->caps.reserved_mrws = dev_cap->reserved_mrws; | ||
| 149 | dev->caps.reserved_uars = dev_cap->reserved_uars; | ||
| 150 | dev->caps.reserved_pds = dev_cap->reserved_pds; | ||
| 151 | dev->caps.port_width_cap = dev_cap->max_port_width; | ||
| 152 | dev->caps.mtt_entry_sz = MLX4_MTT_ENTRY_PER_SEG * dev_cap->mtt_entry_sz; | ||
| 153 | dev->caps.page_size_cap = ~(u32) (dev_cap->min_page_sz - 1); | ||
| 154 | dev->caps.flags = dev_cap->flags; | ||
| 155 | dev->caps.stat_rate_support = dev_cap->stat_rate_support; | ||
| 156 | |||
| 157 | return 0; | ||
| 158 | } | ||
| 159 | |||
| 160 | static int __devinit mlx4_load_fw(struct mlx4_dev *dev) | ||
| 161 | { | ||
| 162 | struct mlx4_priv *priv = mlx4_priv(dev); | ||
| 163 | int err; | ||
| 164 | |||
| 165 | priv->fw.fw_icm = mlx4_alloc_icm(dev, priv->fw.fw_pages, | ||
| 166 | GFP_HIGHUSER | __GFP_NOWARN); | ||
| 167 | if (!priv->fw.fw_icm) { | ||
| 168 | mlx4_err(dev, "Couldn't allocate FW area, aborting.\n"); | ||
| 169 | return -ENOMEM; | ||
| 170 | } | ||
| 171 | |||
| 172 | err = mlx4_MAP_FA(dev, priv->fw.fw_icm); | ||
| 173 | if (err) { | ||
| 174 | mlx4_err(dev, "MAP_FA command failed, aborting.\n"); | ||
| 175 | goto err_free; | ||
| 176 | } | ||
| 177 | |||
| 178 | err = mlx4_RUN_FW(dev); | ||
| 179 | if (err) { | ||
| 180 | mlx4_err(dev, "RUN_FW command failed, aborting.\n"); | ||
| 181 | goto err_unmap_fa; | ||
| 182 | } | ||
| 183 | |||
| 184 | return 0; | ||
| 185 | |||
| 186 | err_unmap_fa: | ||
| 187 | mlx4_UNMAP_FA(dev); | ||
| 188 | |||
| 189 | err_free: | ||
| 190 | mlx4_free_icm(dev, priv->fw.fw_icm); | ||
| 191 | return err; | ||
| 192 | } | ||
| 193 | |||
| 194 | static int __devinit mlx4_init_cmpt_table(struct mlx4_dev *dev, u64 cmpt_base, | ||
| 195 | int cmpt_entry_sz) | ||
| 196 | { | ||
| 197 | struct mlx4_priv *priv = mlx4_priv(dev); | ||
| 198 | int err; | ||
| 199 | |||
| 200 | err = mlx4_init_icm_table(dev, &priv->qp_table.cmpt_table, | ||
| 201 | cmpt_base + | ||
| 202 | ((u64) (MLX4_CMPT_TYPE_QP * | ||
| 203 | cmpt_entry_sz) << MLX4_CMPT_SHIFT), | ||
| 204 | cmpt_entry_sz, dev->caps.num_qps, | ||
| 205 | dev->caps.reserved_qps, 0); | ||
| 206 | if (err) | ||
| 207 | goto err; | ||
| 208 | |||
| 209 | err = mlx4_init_icm_table(dev, &priv->srq_table.cmpt_table, | ||
| 210 | cmpt_base + | ||
| 211 | ((u64) (MLX4_CMPT_TYPE_SRQ * | ||
| 212 | cmpt_entry_sz) << MLX4_CMPT_SHIFT), | ||
| 213 | cmpt_entry_sz, dev->caps.num_srqs, | ||
| 214 | dev->caps.reserved_srqs, 0); | ||
| 215 | if (err) | ||
| 216 | goto err_qp; | ||
| 217 | |||
| 218 | err = mlx4_init_icm_table(dev, &priv->cq_table.cmpt_table, | ||
| 219 | cmpt_base + | ||
| 220 | ((u64) (MLX4_CMPT_TYPE_CQ * | ||
| 221 | cmpt_entry_sz) << MLX4_CMPT_SHIFT), | ||
| 222 | cmpt_entry_sz, dev->caps.num_cqs, | ||
| 223 | dev->caps.reserved_cqs, 0); | ||
| 224 | if (err) | ||
| 225 | goto err_srq; | ||
| 226 | |||
| 227 | err = mlx4_init_icm_table(dev, &priv->eq_table.cmpt_table, | ||
| 228 | cmpt_base + | ||
| 229 | ((u64) (MLX4_CMPT_TYPE_EQ * | ||
| 230 | cmpt_entry_sz) << MLX4_CMPT_SHIFT), | ||
| 231 | cmpt_entry_sz, | ||
| 232 | roundup_pow_of_two(MLX4_NUM_EQ + | ||
| 233 | dev->caps.reserved_eqs), | ||
| 234 | MLX4_NUM_EQ + dev->caps.reserved_eqs, 0); | ||
| 235 | if (err) | ||
| 236 | goto err_cq; | ||
| 237 | |||
| 238 | return 0; | ||
| 239 | |||
| 240 | err_cq: | ||
| 241 | mlx4_cleanup_icm_table(dev, &priv->cq_table.cmpt_table); | ||
| 242 | |||
| 243 | err_srq: | ||
| 244 | mlx4_cleanup_icm_table(dev, &priv->srq_table.cmpt_table); | ||
| 245 | |||
| 246 | err_qp: | ||
| 247 | mlx4_cleanup_icm_table(dev, &priv->qp_table.cmpt_table); | ||
| 248 | |||
| 249 | err: | ||
| 250 | return err; | ||
| 251 | } | ||
| 252 | |||
| 253 | static int __devinit mlx4_init_icm(struct mlx4_dev *dev, | ||
| 254 | struct mlx4_dev_cap *dev_cap, | ||
| 255 | struct mlx4_init_hca_param *init_hca, | ||
| 256 | u64 icm_size) | ||
| 257 | { | ||
| 258 | struct mlx4_priv *priv = mlx4_priv(dev); | ||
| 259 | u64 aux_pages; | ||
| 260 | int err; | ||
| 261 | |||
| 262 | err = mlx4_SET_ICM_SIZE(dev, icm_size, &aux_pages); | ||
| 263 | if (err) { | ||
| 264 | mlx4_err(dev, "SET_ICM_SIZE command failed, aborting.\n"); | ||
| 265 | return err; | ||
| 266 | } | ||
| 267 | |||
| 268 | mlx4_dbg(dev, "%lld KB of HCA context requires %lld KB aux memory.\n", | ||
| 269 | (unsigned long long) icm_size >> 10, | ||
| 270 | (unsigned long long) aux_pages << 2); | ||
| 271 | |||
| 272 | priv->fw.aux_icm = mlx4_alloc_icm(dev, aux_pages, | ||
| 273 | GFP_HIGHUSER | __GFP_NOWARN); | ||
| 274 | if (!priv->fw.aux_icm) { | ||
| 275 | mlx4_err(dev, "Couldn't allocate aux memory, aborting.\n"); | ||
| 276 | return -ENOMEM; | ||
| 277 | } | ||
| 278 | |||
| 279 | err = mlx4_MAP_ICM_AUX(dev, priv->fw.aux_icm); | ||
| 280 | if (err) { | ||
| 281 | mlx4_err(dev, "MAP_ICM_AUX command failed, aborting.\n"); | ||
| 282 | goto err_free_aux; | ||
| 283 | } | ||
| 284 | |||
| 285 | err = mlx4_init_cmpt_table(dev, init_hca->cmpt_base, dev_cap->cmpt_entry_sz); | ||
| 286 | if (err) { | ||
| 287 | mlx4_err(dev, "Failed to map cMPT context memory, aborting.\n"); | ||
| 288 | goto err_unmap_aux; | ||
| 289 | } | ||
| 290 | |||
| 291 | err = mlx4_map_eq_icm(dev, init_hca->eqc_base); | ||
| 292 | if (err) { | ||
| 293 | mlx4_err(dev, "Failed to map EQ context memory, aborting.\n"); | ||
| 294 | goto err_unmap_cmpt; | ||
| 295 | } | ||
| 296 | |||
| 297 | err = mlx4_init_icm_table(dev, &priv->mr_table.mtt_table, | ||
| 298 | init_hca->mtt_base, | ||
| 299 | dev->caps.mtt_entry_sz, | ||
| 300 | dev->caps.num_mtt_segs, | ||
| 301 | dev->caps.reserved_mtts, 1); | ||
| 302 | if (err) { | ||
| 303 | mlx4_err(dev, "Failed to map MTT context memory, aborting.\n"); | ||
| 304 | goto err_unmap_eq; | ||
| 305 | } | ||
| 306 | |||
| 307 | err = mlx4_init_icm_table(dev, &priv->mr_table.dmpt_table, | ||
| 308 | init_hca->dmpt_base, | ||
| 309 | dev_cap->dmpt_entry_sz, | ||
| 310 | dev->caps.num_mpts, | ||
| 311 | dev->caps.reserved_mrws, 1); | ||
| 312 | if (err) { | ||
| 313 | mlx4_err(dev, "Failed to map dMPT context memory, aborting.\n"); | ||
| 314 | goto err_unmap_mtt; | ||
| 315 | } | ||
| 316 | |||
| 317 | err = mlx4_init_icm_table(dev, &priv->qp_table.qp_table, | ||
| 318 | init_hca->qpc_base, | ||
| 319 | dev_cap->qpc_entry_sz, | ||
| 320 | dev->caps.num_qps, | ||
| 321 | dev->caps.reserved_qps, 0); | ||
| 322 | if (err) { | ||
| 323 | mlx4_err(dev, "Failed to map QP context memory, aborting.\n"); | ||
| 324 | goto err_unmap_dmpt; | ||
| 325 | } | ||
| 326 | |||
| 327 | err = mlx4_init_icm_table(dev, &priv->qp_table.auxc_table, | ||
| 328 | init_hca->auxc_base, | ||
| 329 | dev_cap->aux_entry_sz, | ||
| 330 | dev->caps.num_qps, | ||
| 331 | dev->caps.reserved_qps, 0); | ||
| 332 | if (err) { | ||
| 333 | mlx4_err(dev, "Failed to map AUXC context memory, aborting.\n"); | ||
| 334 | goto err_unmap_qp; | ||
| 335 | } | ||
| 336 | |||
| 337 | err = mlx4_init_icm_table(dev, &priv->qp_table.altc_table, | ||
| 338 | init_hca->altc_base, | ||
| 339 | dev_cap->altc_entry_sz, | ||
| 340 | dev->caps.num_qps, | ||
| 341 | dev->caps.reserved_qps, 0); | ||
| 342 | if (err) { | ||
| 343 | mlx4_err(dev, "Failed to map ALTC context memory, aborting.\n"); | ||
| 344 | goto err_unmap_auxc; | ||
| 345 | } | ||
| 346 | |||
| 347 | err = mlx4_init_icm_table(dev, &priv->qp_table.rdmarc_table, | ||
| 348 | init_hca->rdmarc_base, | ||
| 349 | dev_cap->rdmarc_entry_sz << priv->qp_table.rdmarc_shift, | ||
| 350 | dev->caps.num_qps, | ||
| 351 | dev->caps.reserved_qps, 0); | ||
| 352 | if (err) { | ||
| 353 | mlx4_err(dev, "Failed to map RDMARC context memory, aborting\n"); | ||
| 354 | goto err_unmap_altc; | ||
| 355 | } | ||
| 356 | |||
| 357 | err = mlx4_init_icm_table(dev, &priv->cq_table.table, | ||
| 358 | init_hca->cqc_base, | ||
| 359 | dev_cap->cqc_entry_sz, | ||
| 360 | dev->caps.num_cqs, | ||
| 361 | dev->caps.reserved_cqs, 0); | ||
| 362 | if (err) { | ||
| 363 | mlx4_err(dev, "Failed to map CQ context memory, aborting.\n"); | ||
| 364 | goto err_unmap_rdmarc; | ||
| 365 | } | ||
| 366 | |||
| 367 | err = mlx4_init_icm_table(dev, &priv->srq_table.table, | ||
| 368 | init_hca->srqc_base, | ||
| 369 | dev_cap->srq_entry_sz, | ||
| 370 | dev->caps.num_srqs, | ||
| 371 | dev->caps.reserved_srqs, 0); | ||
| 372 | if (err) { | ||
| 373 | mlx4_err(dev, "Failed to map SRQ context memory, aborting.\n"); | ||
| 374 | goto err_unmap_cq; | ||
| 375 | } | ||
| 376 | |||
| 377 | /* | ||
| 378 | * It's not strictly required, but for simplicity just map the | ||
| 379 | * whole multicast group table now. The table isn't very big | ||
| 380 | * and it's a lot easier than trying to track ref counts. | ||
| 381 | */ | ||
| 382 | err = mlx4_init_icm_table(dev, &priv->mcg_table.table, | ||
| 383 | init_hca->mc_base, MLX4_MGM_ENTRY_SIZE, | ||
| 384 | dev->caps.num_mgms + dev->caps.num_amgms, | ||
| 385 | dev->caps.num_mgms + dev->caps.num_amgms, | ||
| 386 | 0); | ||
| 387 | if (err) { | ||
| 388 | mlx4_err(dev, "Failed to map MCG context memory, aborting.\n"); | ||
| 389 | goto err_unmap_srq; | ||
| 390 | } | ||
| 391 | |||
| 392 | return 0; | ||
| 393 | |||
| 394 | err_unmap_srq: | ||
| 395 | mlx4_cleanup_icm_table(dev, &priv->srq_table.table); | ||
| 396 | |||
| 397 | err_unmap_cq: | ||
| 398 | mlx4_cleanup_icm_table(dev, &priv->cq_table.table); | ||
| 399 | |||
| 400 | err_unmap_rdmarc: | ||
| 401 | mlx4_cleanup_icm_table(dev, &priv->qp_table.rdmarc_table); | ||
| 402 | |||
| 403 | err_unmap_altc: | ||
| 404 | mlx4_cleanup_icm_table(dev, &priv->qp_table.altc_table); | ||
| 405 | |||
| 406 | err_unmap_auxc: | ||
| 407 | mlx4_cleanup_icm_table(dev, &priv->qp_table.auxc_table); | ||
| 408 | |||
| 409 | err_unmap_qp: | ||
| 410 | mlx4_cleanup_icm_table(dev, &priv->qp_table.qp_table); | ||
| 411 | |||
| 412 | err_unmap_dmpt: | ||
| 413 | mlx4_cleanup_icm_table(dev, &priv->mr_table.dmpt_table); | ||
| 414 | |||
| 415 | err_unmap_mtt: | ||
| 416 | mlx4_cleanup_icm_table(dev, &priv->mr_table.mtt_table); | ||
| 417 | |||
| 418 | err_unmap_eq: | ||
| 419 | mlx4_unmap_eq_icm(dev); | ||
| 420 | |||
| 421 | err_unmap_cmpt: | ||
| 422 | mlx4_cleanup_icm_table(dev, &priv->eq_table.cmpt_table); | ||
| 423 | mlx4_cleanup_icm_table(dev, &priv->cq_table.cmpt_table); | ||
| 424 | mlx4_cleanup_icm_table(dev, &priv->srq_table.cmpt_table); | ||
| 425 | mlx4_cleanup_icm_table(dev, &priv->qp_table.cmpt_table); | ||
| 426 | |||
| 427 | err_unmap_aux: | ||
| 428 | mlx4_UNMAP_ICM_AUX(dev); | ||
| 429 | |||
| 430 | err_free_aux: | ||
| 431 | mlx4_free_icm(dev, priv->fw.aux_icm); | ||
| 432 | |||
| 433 | return err; | ||
| 434 | } | ||
| 435 | |||
| 436 | static void mlx4_free_icms(struct mlx4_dev *dev) | ||
| 437 | { | ||
| 438 | struct mlx4_priv *priv = mlx4_priv(dev); | ||
| 439 | |||
| 440 | mlx4_cleanup_icm_table(dev, &priv->mcg_table.table); | ||
| 441 | mlx4_cleanup_icm_table(dev, &priv->srq_table.table); | ||
| 442 | mlx4_cleanup_icm_table(dev, &priv->cq_table.table); | ||
| 443 | mlx4_cleanup_icm_table(dev, &priv->qp_table.rdmarc_table); | ||
| 444 | mlx4_cleanup_icm_table(dev, &priv->qp_table.altc_table); | ||
| 445 | mlx4_cleanup_icm_table(dev, &priv->qp_table.auxc_table); | ||
| 446 | mlx4_cleanup_icm_table(dev, &priv->qp_table.qp_table); | ||
| 447 | mlx4_cleanup_icm_table(dev, &priv->mr_table.dmpt_table); | ||
| 448 | mlx4_cleanup_icm_table(dev, &priv->mr_table.mtt_table); | ||
| 449 | mlx4_cleanup_icm_table(dev, &priv->eq_table.cmpt_table); | ||
| 450 | mlx4_cleanup_icm_table(dev, &priv->cq_table.cmpt_table); | ||
| 451 | mlx4_cleanup_icm_table(dev, &priv->srq_table.cmpt_table); | ||
| 452 | mlx4_cleanup_icm_table(dev, &priv->qp_table.cmpt_table); | ||
| 453 | mlx4_unmap_eq_icm(dev); | ||
| 454 | |||
| 455 | mlx4_UNMAP_ICM_AUX(dev); | ||
| 456 | mlx4_free_icm(dev, priv->fw.aux_icm); | ||
| 457 | } | ||
| 458 | |||
| 459 | static void mlx4_close_hca(struct mlx4_dev *dev) | ||
| 460 | { | ||
| 461 | mlx4_CLOSE_HCA(dev, 0); | ||
| 462 | mlx4_free_icms(dev); | ||
| 463 | mlx4_UNMAP_FA(dev); | ||
| 464 | mlx4_free_icm(dev, mlx4_priv(dev)->fw.fw_icm); | ||
| 465 | } | ||
| 466 | |||
| 467 | static int __devinit mlx4_init_hca(struct mlx4_dev *dev) | ||
| 468 | { | ||
| 469 | struct mlx4_priv *priv = mlx4_priv(dev); | ||
| 470 | struct mlx4_adapter adapter; | ||
| 471 | struct mlx4_dev_cap dev_cap; | ||
| 472 | struct mlx4_profile profile; | ||
| 473 | struct mlx4_init_hca_param init_hca; | ||
| 474 | u64 icm_size; | ||
| 475 | int err; | ||
| 476 | |||
| 477 | err = mlx4_QUERY_FW(dev); | ||
| 478 | if (err) { | ||
| 479 | mlx4_err(dev, "QUERY_FW command failed, aborting.\n"); | ||
| 480 | return err; | ||
| 481 | } | ||
| 482 | |||
| 483 | err = mlx4_load_fw(dev); | ||
| 484 | if (err) { | ||
| 485 | mlx4_err(dev, "Failed to start FW, aborting.\n"); | ||
| 486 | return err; | ||
| 487 | } | ||
| 488 | |||
| 489 | err = mlx4_dev_cap(dev, &dev_cap); | ||
| 490 | if (err) { | ||
| 491 | mlx4_err(dev, "QUERY_DEV_CAP command failed, aborting.\n"); | ||
| 492 | goto err_stop_fw; | ||
| 493 | } | ||
| 494 | |||
| 495 | profile = default_profile; | ||
| 496 | |||
| 497 | icm_size = mlx4_make_profile(dev, &profile, &dev_cap, &init_hca); | ||
| 498 | if ((long long) icm_size < 0) { | ||
| 499 | err = icm_size; | ||
| 500 | goto err_stop_fw; | ||
| 501 | } | ||
| 502 | |||
| 503 | init_hca.log_uar_sz = ilog2(dev->caps.num_uars); | ||
| 504 | |||
| 505 | err = mlx4_init_icm(dev, &dev_cap, &init_hca, icm_size); | ||
| 506 | if (err) | ||
| 507 | goto err_stop_fw; | ||
| 508 | |||
| 509 | err = mlx4_INIT_HCA(dev, &init_hca); | ||
| 510 | if (err) { | ||
| 511 | mlx4_err(dev, "INIT_HCA command failed, aborting.\n"); | ||
| 512 | goto err_free_icm; | ||
| 513 | } | ||
| 514 | |||
| 515 | err = mlx4_QUERY_ADAPTER(dev, &adapter); | ||
| 516 | if (err) { | ||
| 517 | mlx4_err(dev, "QUERY_ADAPTER command failed, aborting.\n"); | ||
| 518 | goto err_close; | ||
| 519 | } | ||
| 520 | |||
| 521 | priv->eq_table.inta_pin = adapter.inta_pin; | ||
| 522 | priv->rev_id = adapter.revision_id; | ||
| 523 | memcpy(priv->board_id, adapter.board_id, sizeof priv->board_id); | ||
| 524 | |||
| 525 | return 0; | ||
| 526 | |||
| 527 | err_close: | ||
| 528 | mlx4_close_hca(dev); | ||
| 529 | |||
| 530 | err_free_icm: | ||
| 531 | mlx4_free_icms(dev); | ||
| 532 | |||
| 533 | err_stop_fw: | ||
| 534 | mlx4_UNMAP_FA(dev); | ||
| 535 | mlx4_free_icm(dev, priv->fw.fw_icm); | ||
| 536 | |||
| 537 | return err; | ||
| 538 | } | ||
| 539 | |||
| 540 | static int __devinit mlx4_setup_hca(struct mlx4_dev *dev) | ||
| 541 | { | ||
| 542 | struct mlx4_priv *priv = mlx4_priv(dev); | ||
| 543 | int err; | ||
| 544 | |||
| 545 | MLX4_INIT_DOORBELL_LOCK(&priv->doorbell_lock); | ||
| 546 | |||
| 547 | err = mlx4_init_uar_table(dev); | ||
| 548 | if (err) { | ||
| 549 | mlx4_err(dev, "Failed to initialize " | ||
| 550 | "user access region table, aborting.\n"); | ||
| 551 | return err; | ||
| 552 | } | ||
| 553 | |||
| 554 | err = mlx4_uar_alloc(dev, &priv->driver_uar); | ||
| 555 | if (err) { | ||
| 556 | mlx4_err(dev, "Failed to allocate driver access region, " | ||
| 557 | "aborting.\n"); | ||
| 558 | goto err_uar_table_free; | ||
| 559 | } | ||
| 560 | |||
| 561 | priv->kar = ioremap(priv->driver_uar.pfn << PAGE_SHIFT, PAGE_SIZE); | ||
| 562 | if (!priv->kar) { | ||
| 563 | mlx4_err(dev, "Couldn't map kernel access region, " | ||
| 564 | "aborting.\n"); | ||
| 565 | err = -ENOMEM; | ||
| 566 | goto err_uar_free; | ||
| 567 | } | ||
| 568 | |||
| 569 | err = mlx4_init_pd_table(dev); | ||
| 570 | if (err) { | ||
| 571 | mlx4_err(dev, "Failed to initialize " | ||
| 572 | "protection domain table, aborting.\n"); | ||
| 573 | goto err_kar_unmap; | ||
| 574 | } | ||
| 575 | |||
| 576 | err = mlx4_init_mr_table(dev); | ||
| 577 | if (err) { | ||
| 578 | mlx4_err(dev, "Failed to initialize " | ||
| 579 | "memory region table, aborting.\n"); | ||
| 580 | goto err_pd_table_free; | ||
| 581 | } | ||
| 582 | |||
| 583 | mlx4_map_catas_buf(dev); | ||
| 584 | |||
| 585 | err = mlx4_init_eq_table(dev); | ||
| 586 | if (err) { | ||
| 587 | mlx4_err(dev, "Failed to initialize " | ||
| 588 | "event queue table, aborting.\n"); | ||
| 589 | goto err_catas_buf; | ||
| 590 | } | ||
| 591 | |||
| 592 | err = mlx4_cmd_use_events(dev); | ||
| 593 | if (err) { | ||
| 594 | mlx4_err(dev, "Failed to switch to event-driven " | ||
| 595 | "firmware commands, aborting.\n"); | ||
| 596 | goto err_eq_table_free; | ||
| 597 | } | ||
| 598 | |||
| 599 | err = mlx4_NOP(dev); | ||
| 600 | if (err) { | ||
| 601 | mlx4_err(dev, "NOP command failed to generate interrupt " | ||
| 602 | "(IRQ %d), aborting.\n", | ||
| 603 | priv->eq_table.eq[MLX4_EQ_ASYNC].irq); | ||
| 604 | if (dev->flags & MLX4_FLAG_MSI_X) | ||
| 605 | mlx4_err(dev, "Try again with MSI-X disabled.\n"); | ||
| 606 | else | ||
| 607 | mlx4_err(dev, "BIOS or ACPI interrupt routing problem?\n"); | ||
| 608 | |||
| 609 | goto err_cmd_poll; | ||
| 610 | } | ||
| 611 | |||
| 612 | mlx4_dbg(dev, "NOP command IRQ test passed\n"); | ||
| 613 | |||
| 614 | err = mlx4_init_cq_table(dev); | ||
| 615 | if (err) { | ||
| 616 | mlx4_err(dev, "Failed to initialize " | ||
| 617 | "completion queue table, aborting.\n"); | ||
| 618 | goto err_cmd_poll; | ||
| 619 | } | ||
| 620 | |||
| 621 | err = mlx4_init_srq_table(dev); | ||
| 622 | if (err) { | ||
| 623 | mlx4_err(dev, "Failed to initialize " | ||
| 624 | "shared receive queue table, aborting.\n"); | ||
| 625 | goto err_cq_table_free; | ||
| 626 | } | ||
| 627 | |||
| 628 | err = mlx4_init_qp_table(dev); | ||
| 629 | if (err) { | ||
| 630 | mlx4_err(dev, "Failed to initialize " | ||
| 631 | "queue pair table, aborting.\n"); | ||
| 632 | goto err_srq_table_free; | ||
| 633 | } | ||
| 634 | |||
| 635 | err = mlx4_init_mcg_table(dev); | ||
| 636 | if (err) { | ||
| 637 | mlx4_err(dev, "Failed to initialize " | ||
| 638 | "multicast group table, aborting.\n"); | ||
| 639 | goto err_qp_table_free; | ||
| 640 | } | ||
| 641 | |||
| 642 | return 0; | ||
| 643 | |||
| 644 | err_qp_table_free: | ||
| 645 | mlx4_cleanup_qp_table(dev); | ||
| 646 | |||
| 647 | err_srq_table_free: | ||
| 648 | mlx4_cleanup_srq_table(dev); | ||
| 649 | |||
| 650 | err_cq_table_free: | ||
| 651 | mlx4_cleanup_cq_table(dev); | ||
| 652 | |||
| 653 | err_cmd_poll: | ||
| 654 | mlx4_cmd_use_polling(dev); | ||
| 655 | |||
| 656 | err_eq_table_free: | ||
| 657 | mlx4_cleanup_eq_table(dev); | ||
| 658 | |||
| 659 | err_catas_buf: | ||
| 660 | mlx4_unmap_catas_buf(dev); | ||
| 661 | mlx4_cleanup_mr_table(dev); | ||
| 662 | |||
| 663 | err_pd_table_free: | ||
| 664 | mlx4_cleanup_pd_table(dev); | ||
| 665 | |||
| 666 | err_kar_unmap: | ||
| 667 | iounmap(priv->kar); | ||
| 668 | |||
| 669 | err_uar_free: | ||
| 670 | mlx4_uar_free(dev, &priv->driver_uar); | ||
| 671 | |||
| 672 | err_uar_table_free: | ||
| 673 | mlx4_cleanup_uar_table(dev); | ||
| 674 | return err; | ||
| 675 | } | ||
| 676 | |||
| 677 | static void __devinit mlx4_enable_msi_x(struct mlx4_dev *dev) | ||
| 678 | { | ||
| 679 | struct mlx4_priv *priv = mlx4_priv(dev); | ||
| 680 | struct msix_entry entries[MLX4_NUM_EQ]; | ||
| 681 | int err; | ||
| 682 | int i; | ||
| 683 | |||
| 684 | if (msi_x) { | ||
| 685 | for (i = 0; i < MLX4_NUM_EQ; ++i) | ||
| 686 | entries[i].entry = i; | ||
| 687 | |||
| 688 | err = pci_enable_msix(dev->pdev, entries, ARRAY_SIZE(entries)); | ||
| 689 | if (err) { | ||
| 690 | if (err > 0) | ||
| 691 | mlx4_info(dev, "Only %d MSI-X vectors available, " | ||
| 692 | "not using MSI-X\n", err); | ||
| 693 | goto no_msi; | ||
| 694 | } | ||
| 695 | |||
| 696 | for (i = 0; i < MLX4_NUM_EQ; ++i) | ||
| 697 | priv->eq_table.eq[i].irq = entries[i].vector; | ||
| 698 | |||
| 699 | dev->flags |= MLX4_FLAG_MSI_X; | ||
| 700 | return; | ||
| 701 | } | ||
| 702 | |||
| 703 | no_msi: | ||
| 704 | for (i = 0; i < MLX4_NUM_EQ; ++i) | ||
| 705 | priv->eq_table.eq[i].irq = dev->pdev->irq; | ||
| 706 | } | ||
| 707 | |||
| 708 | static int __devinit mlx4_init_one(struct pci_dev *pdev, | ||
| 709 | const struct pci_device_id *id) | ||
| 710 | { | ||
| 711 | static int mlx4_version_printed; | ||
| 712 | struct mlx4_priv *priv; | ||
| 713 | struct mlx4_dev *dev; | ||
| 714 | int err; | ||
| 715 | |||
| 716 | if (!mlx4_version_printed) { | ||
| 717 | printk(KERN_INFO "%s", mlx4_version); | ||
| 718 | ++mlx4_version_printed; | ||
| 719 | } | ||
| 720 | |||
| 721 | printk(KERN_INFO PFX "Initializing %s\n", | ||
| 722 | pci_name(pdev)); | ||
| 723 | |||
| 724 | err = pci_enable_device(pdev); | ||
| 725 | if (err) { | ||
| 726 | dev_err(&pdev->dev, "Cannot enable PCI device, " | ||
| 727 | "aborting.\n"); | ||
| 728 | return err; | ||
| 729 | } | ||
| 730 | |||
| 731 | /* | ||
| 732 | * Check for BARs. We expect 0: 1MB, 2: 8MB, 4: DDR (may not | ||
| 733 | * be present) | ||
| 734 | */ | ||
| 735 | if (!(pci_resource_flags(pdev, 0) & IORESOURCE_MEM) || | ||
| 736 | pci_resource_len(pdev, 0) != 1 << 20) { | ||
| 737 | dev_err(&pdev->dev, "Missing DCS, aborting.\n"); | ||
| 738 | err = -ENODEV; | ||
| 739 | goto err_disable_pdev; | ||
| 740 | } | ||
| 741 | if (!(pci_resource_flags(pdev, 2) & IORESOURCE_MEM)) { | ||
| 742 | dev_err(&pdev->dev, "Missing UAR, aborting.\n"); | ||
| 743 | err = -ENODEV; | ||
| 744 | goto err_disable_pdev; | ||
| 745 | } | ||
| 746 | |||
| 747 | err = pci_request_region(pdev, 0, DRV_NAME); | ||
| 748 | if (err) { | ||
| 749 | dev_err(&pdev->dev, "Cannot request control region, aborting.\n"); | ||
| 750 | goto err_disable_pdev; | ||
| 751 | } | ||
| 752 | |||
| 753 | err = pci_request_region(pdev, 2, DRV_NAME); | ||
| 754 | if (err) { | ||
| 755 | dev_err(&pdev->dev, "Cannot request UAR region, aborting.\n"); | ||
| 756 | goto err_release_bar0; | ||
| 757 | } | ||
| 758 | |||
| 759 | pci_set_master(pdev); | ||
| 760 | |||
| 761 | err = pci_set_dma_mask(pdev, DMA_64BIT_MASK); | ||
| 762 | if (err) { | ||
| 763 | dev_warn(&pdev->dev, "Warning: couldn't set 64-bit PCI DMA mask.\n"); | ||
| 764 | err = pci_set_dma_mask(pdev, DMA_32BIT_MASK); | ||
| 765 | if (err) { | ||
| 766 | dev_err(&pdev->dev, "Can't set PCI DMA mask, aborting.\n"); | ||
| 767 | goto err_release_bar2; | ||
| 768 | } | ||
| 769 | } | ||
| 770 | err = pci_set_consistent_dma_mask(pdev, DMA_64BIT_MASK); | ||
| 771 | if (err) { | ||
| 772 | dev_warn(&pdev->dev, "Warning: couldn't set 64-bit " | ||
| 773 | "consistent PCI DMA mask.\n"); | ||
| 774 | err = pci_set_consistent_dma_mask(pdev, DMA_32BIT_MASK); | ||
| 775 | if (err) { | ||
| 776 | dev_err(&pdev->dev, "Can't set consistent PCI DMA mask, " | ||
| 777 | "aborting.\n"); | ||
| 778 | goto err_release_bar2; | ||
| 779 | } | ||
| 780 | } | ||
| 781 | |||
| 782 | priv = kzalloc(sizeof *priv, GFP_KERNEL); | ||
| 783 | if (!priv) { | ||
| 784 | dev_err(&pdev->dev, "Device struct alloc failed, " | ||
| 785 | "aborting.\n"); | ||
| 786 | err = -ENOMEM; | ||
| 787 | goto err_release_bar2; | ||
| 788 | } | ||
| 789 | |||
| 790 | dev = &priv->dev; | ||
| 791 | dev->pdev = pdev; | ||
| 792 | |||
| 793 | /* | ||
| 794 | * Now reset the HCA before we touch the PCI capabilities or | ||
| 795 | * attempt a firmware command, since a boot ROM may have left | ||
| 796 | * the HCA in an undefined state. | ||
| 797 | */ | ||
| 798 | err = mlx4_reset(dev); | ||
| 799 | if (err) { | ||
| 800 | mlx4_err(dev, "Failed to reset HCA, aborting.\n"); | ||
| 801 | goto err_free_dev; | ||
| 802 | } | ||
| 803 | |||
| 804 | mlx4_enable_msi_x(dev); | ||
| 805 | |||
| 806 | if (mlx4_cmd_init(dev)) { | ||
| 807 | mlx4_err(dev, "Failed to init command interface, aborting.\n"); | ||
| 808 | goto err_free_dev; | ||
| 809 | } | ||
| 810 | |||
| 811 | err = mlx4_init_hca(dev); | ||
| 812 | if (err) | ||
| 813 | goto err_cmd; | ||
| 814 | |||
| 815 | err = mlx4_setup_hca(dev); | ||
| 816 | if (err) | ||
| 817 | goto err_close; | ||
| 818 | |||
| 819 | err = mlx4_register_device(dev); | ||
| 820 | if (err) | ||
| 821 | goto err_cleanup; | ||
| 822 | |||
| 823 | pci_set_drvdata(pdev, dev); | ||
| 824 | |||
| 825 | return 0; | ||
| 826 | |||
| 827 | err_cleanup: | ||
| 828 | mlx4_cleanup_mcg_table(dev); | ||
| 829 | mlx4_cleanup_qp_table(dev); | ||
| 830 | mlx4_cleanup_srq_table(dev); | ||
| 831 | mlx4_cleanup_cq_table(dev); | ||
| 832 | mlx4_cmd_use_polling(dev); | ||
| 833 | mlx4_cleanup_eq_table(dev); | ||
| 834 | |||
| 835 | mlx4_unmap_catas_buf(dev); | ||
| 836 | |||
| 837 | mlx4_cleanup_mr_table(dev); | ||
| 838 | mlx4_cleanup_pd_table(dev); | ||
| 839 | mlx4_cleanup_uar_table(dev); | ||
| 840 | |||
| 841 | err_close: | ||
| 842 | mlx4_close_hca(dev); | ||
| 843 | |||
| 844 | err_cmd: | ||
| 845 | mlx4_cmd_cleanup(dev); | ||
| 846 | |||
| 847 | err_free_dev: | ||
| 848 | if (dev->flags & MLX4_FLAG_MSI_X) | ||
| 849 | pci_disable_msix(pdev); | ||
| 850 | |||
| 851 | kfree(priv); | ||
| 852 | |||
| 853 | err_release_bar2: | ||
| 854 | pci_release_region(pdev, 2); | ||
| 855 | |||
| 856 | err_release_bar0: | ||
| 857 | pci_release_region(pdev, 0); | ||
| 858 | |||
| 859 | err_disable_pdev: | ||
| 860 | pci_disable_device(pdev); | ||
| 861 | pci_set_drvdata(pdev, NULL); | ||
| 862 | return err; | ||
| 863 | } | ||
| 864 | |||
| 865 | static void __devexit mlx4_remove_one(struct pci_dev *pdev) | ||
| 866 | { | ||
| 867 | struct mlx4_dev *dev = pci_get_drvdata(pdev); | ||
| 868 | struct mlx4_priv *priv = mlx4_priv(dev); | ||
| 869 | int p; | ||
| 870 | |||
| 871 | if (dev) { | ||
| 872 | mlx4_unregister_device(dev); | ||
| 873 | |||
| 874 | for (p = 1; p <= dev->caps.num_ports; ++p) | ||
| 875 | mlx4_CLOSE_PORT(dev, p); | ||
| 876 | |||
| 877 | mlx4_cleanup_mcg_table(dev); | ||
| 878 | mlx4_cleanup_qp_table(dev); | ||
| 879 | mlx4_cleanup_srq_table(dev); | ||
| 880 | mlx4_cleanup_cq_table(dev); | ||
| 881 | mlx4_cmd_use_polling(dev); | ||
| 882 | mlx4_cleanup_eq_table(dev); | ||
| 883 | |||
| 884 | mlx4_unmap_catas_buf(dev); | ||
| 885 | |||
| 886 | mlx4_cleanup_mr_table(dev); | ||
| 887 | mlx4_cleanup_pd_table(dev); | ||
| 888 | |||
| 889 | iounmap(priv->kar); | ||
| 890 | mlx4_uar_free(dev, &priv->driver_uar); | ||
| 891 | mlx4_cleanup_uar_table(dev); | ||
| 892 | mlx4_close_hca(dev); | ||
| 893 | mlx4_cmd_cleanup(dev); | ||
| 894 | |||
| 895 | if (dev->flags & MLX4_FLAG_MSI_X) | ||
| 896 | pci_disable_msix(pdev); | ||
| 897 | |||
| 898 | kfree(priv); | ||
| 899 | pci_release_region(pdev, 2); | ||
| 900 | pci_release_region(pdev, 0); | ||
| 901 | pci_disable_device(pdev); | ||
| 902 | pci_set_drvdata(pdev, NULL); | ||
| 903 | } | ||
| 904 | } | ||
| 905 | |||
| 906 | static struct pci_device_id mlx4_pci_table[] = { | ||
| 907 | { PCI_VDEVICE(MELLANOX, 0x6340) }, /* MT25408 "Hermon" SDR */ | ||
| 908 | { PCI_VDEVICE(MELLANOX, 0x634a) }, /* MT25408 "Hermon" DDR */ | ||
| 909 | { PCI_VDEVICE(MELLANOX, 0x6354) }, /* MT25408 "Hermon" QDR */ | ||
| 910 | { 0, } | ||
| 911 | }; | ||
| 912 | |||
| 913 | MODULE_DEVICE_TABLE(pci, mlx4_pci_table); | ||
| 914 | |||
| 915 | static struct pci_driver mlx4_driver = { | ||
| 916 | .name = DRV_NAME, | ||
| 917 | .id_table = mlx4_pci_table, | ||
| 918 | .probe = mlx4_init_one, | ||
| 919 | .remove = __devexit_p(mlx4_remove_one) | ||
| 920 | }; | ||
| 921 | |||
| 922 | static int __init mlx4_init(void) | ||
| 923 | { | ||
| 924 | int ret; | ||
| 925 | |||
| 926 | ret = pci_register_driver(&mlx4_driver); | ||
| 927 | return ret < 0 ? ret : 0; | ||
| 928 | } | ||
| 929 | |||
| 930 | static void __exit mlx4_cleanup(void) | ||
| 931 | { | ||
| 932 | pci_unregister_driver(&mlx4_driver); | ||
| 933 | } | ||
| 934 | |||
| 935 | module_init(mlx4_init); | ||
| 936 | module_exit(mlx4_cleanup); | ||
diff --git a/drivers/net/mlx4/mcg.c b/drivers/net/mlx4/mcg.c new file mode 100644 index 000000000000..672024a0ee71 --- /dev/null +++ b/drivers/net/mlx4/mcg.c | |||
| @@ -0,0 +1,380 @@ | |||
| 1 | /* | ||
| 2 | * Copyright (c) 2006, 2007 Cisco Systems, Inc. All rights reserved. | ||
| 3 | * | ||
| 4 | * This software is available to you under a choice of one of two | ||
| 5 | * licenses. You may choose to be licensed under the terms of the GNU | ||
| 6 | * General Public License (GPL) Version 2, available from the file | ||
| 7 | * COPYING in the main directory of this source tree, or the | ||
| 8 | * OpenIB.org BSD license below: | ||
| 9 | * | ||
| 10 | * Redistribution and use in source and binary forms, with or | ||
| 11 | * without modification, are permitted provided that the following | ||
| 12 | * conditions are met: | ||
| 13 | * | ||
| 14 | * - Redistributions of source code must retain the above | ||
| 15 | * copyright notice, this list of conditions and the following | ||
| 16 | * disclaimer. | ||
| 17 | * | ||
| 18 | * - Redistributions in binary form must reproduce the above | ||
| 19 | * copyright notice, this list of conditions and the following | ||
| 20 | * disclaimer in the documentation and/or other materials | ||
| 21 | * provided with the distribution. | ||
| 22 | * | ||
| 23 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, | ||
| 24 | * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF | ||
| 25 | * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND | ||
| 26 | * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS | ||
| 27 | * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN | ||
| 28 | * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN | ||
| 29 | * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE | ||
| 30 | * SOFTWARE. | ||
| 31 | */ | ||
| 32 | |||
| 33 | #include <linux/init.h> | ||
| 34 | #include <linux/string.h> | ||
| 35 | #include <linux/slab.h> | ||
| 36 | |||
| 37 | #include <linux/mlx4/cmd.h> | ||
| 38 | |||
| 39 | #include "mlx4.h" | ||
| 40 | |||
| 41 | struct mlx4_mgm { | ||
| 42 | __be32 next_gid_index; | ||
| 43 | __be32 members_count; | ||
| 44 | u32 reserved[2]; | ||
| 45 | u8 gid[16]; | ||
| 46 | __be32 qp[MLX4_QP_PER_MGM]; | ||
| 47 | }; | ||
| 48 | |||
| 49 | static const u8 zero_gid[16]; /* automatically initialized to 0 */ | ||
| 50 | |||
| 51 | static int mlx4_READ_MCG(struct mlx4_dev *dev, int index, | ||
| 52 | struct mlx4_cmd_mailbox *mailbox) | ||
| 53 | { | ||
| 54 | return mlx4_cmd_box(dev, 0, mailbox->dma, index, 0, MLX4_CMD_READ_MCG, | ||
| 55 | MLX4_CMD_TIME_CLASS_A); | ||
| 56 | } | ||
| 57 | |||
| 58 | static int mlx4_WRITE_MCG(struct mlx4_dev *dev, int index, | ||
| 59 | struct mlx4_cmd_mailbox *mailbox) | ||
| 60 | { | ||
| 61 | return mlx4_cmd(dev, mailbox->dma, index, 0, MLX4_CMD_WRITE_MCG, | ||
| 62 | MLX4_CMD_TIME_CLASS_A); | ||
| 63 | } | ||
| 64 | |||
| 65 | static int mlx4_MGID_HASH(struct mlx4_dev *dev, struct mlx4_cmd_mailbox *mailbox, | ||
| 66 | u16 *hash) | ||
| 67 | { | ||
| 68 | u64 imm; | ||
| 69 | int err; | ||
| 70 | |||
| 71 | err = mlx4_cmd_imm(dev, mailbox->dma, &imm, 0, 0, MLX4_CMD_MGID_HASH, | ||
| 72 | MLX4_CMD_TIME_CLASS_A); | ||
| 73 | |||
| 74 | if (!err) | ||
| 75 | *hash = imm; | ||
| 76 | |||
| 77 | return err; | ||
| 78 | } | ||
| 79 | |||
| 80 | /* | ||
| 81 | * Caller must hold MCG table semaphore. gid and mgm parameters must | ||
| 82 | * be properly aligned for command interface. | ||
| 83 | * | ||
| 84 | * Returns 0 unless a firmware command error occurs. | ||
| 85 | * | ||
| 86 | * If GID is found in MGM or MGM is empty, *index = *hash, *prev = -1 | ||
| 87 | * and *mgm holds MGM entry. | ||
| 88 | * | ||
| 89 | * if GID is found in AMGM, *index = index in AMGM, *prev = index of | ||
| 90 | * previous entry in hash chain and *mgm holds AMGM entry. | ||
| 91 | * | ||
| 92 | * If no AMGM exists for given gid, *index = -1, *prev = index of last | ||
| 93 | * entry in hash chain and *mgm holds end of hash chain. | ||
| 94 | */ | ||
| 95 | static int find_mgm(struct mlx4_dev *dev, | ||
| 96 | u8 *gid, struct mlx4_cmd_mailbox *mgm_mailbox, | ||
| 97 | u16 *hash, int *prev, int *index) | ||
| 98 | { | ||
| 99 | struct mlx4_cmd_mailbox *mailbox; | ||
| 100 | struct mlx4_mgm *mgm = mgm_mailbox->buf; | ||
| 101 | u8 *mgid; | ||
| 102 | int err; | ||
| 103 | |||
| 104 | mailbox = mlx4_alloc_cmd_mailbox(dev); | ||
| 105 | if (IS_ERR(mailbox)) | ||
| 106 | return -ENOMEM; | ||
| 107 | mgid = mailbox->buf; | ||
| 108 | |||
| 109 | memcpy(mgid, gid, 16); | ||
| 110 | |||
| 111 | err = mlx4_MGID_HASH(dev, mailbox, hash); | ||
| 112 | mlx4_free_cmd_mailbox(dev, mailbox); | ||
| 113 | if (err) | ||
| 114 | return err; | ||
| 115 | |||
| 116 | if (0) | ||
| 117 | mlx4_dbg(dev, "Hash for %04x:%04x:%04x:%04x:" | ||
| 118 | "%04x:%04x:%04x:%04x is %04x\n", | ||
| 119 | be16_to_cpu(((__be16 *) gid)[0]), | ||
| 120 | be16_to_cpu(((__be16 *) gid)[1]), | ||
| 121 | be16_to_cpu(((__be16 *) gid)[2]), | ||
| 122 | be16_to_cpu(((__be16 *) gid)[3]), | ||
| 123 | be16_to_cpu(((__be16 *) gid)[4]), | ||
| 124 | be16_to_cpu(((__be16 *) gid)[5]), | ||
| 125 | be16_to_cpu(((__be16 *) gid)[6]), | ||
| 126 | be16_to_cpu(((__be16 *) gid)[7]), | ||
| 127 | *hash); | ||
| 128 | |||
| 129 | *index = *hash; | ||
| 130 | *prev = -1; | ||
| 131 | |||
| 132 | do { | ||
| 133 | err = mlx4_READ_MCG(dev, *index, mgm_mailbox); | ||
| 134 | if (err) | ||
| 135 | return err; | ||
| 136 | |||
| 137 | if (!memcmp(mgm->gid, zero_gid, 16)) { | ||
| 138 | if (*index != *hash) { | ||
| 139 | mlx4_err(dev, "Found zero MGID in AMGM.\n"); | ||
| 140 | err = -EINVAL; | ||
| 141 | } | ||
| 142 | return err; | ||
| 143 | } | ||
| 144 | |||
| 145 | if (!memcmp(mgm->gid, gid, 16)) | ||
| 146 | return err; | ||
| 147 | |||
| 148 | *prev = *index; | ||
| 149 | *index = be32_to_cpu(mgm->next_gid_index) >> 6; | ||
| 150 | } while (*index); | ||
| 151 | |||
| 152 | *index = -1; | ||
| 153 | return err; | ||
| 154 | } | ||
| 155 | |||
| 156 | int mlx4_multicast_attach(struct mlx4_dev *dev, struct mlx4_qp *qp, u8 gid[16]) | ||
| 157 | { | ||
| 158 | struct mlx4_priv *priv = mlx4_priv(dev); | ||
| 159 | struct mlx4_cmd_mailbox *mailbox; | ||
| 160 | struct mlx4_mgm *mgm; | ||
| 161 | u32 members_count; | ||
| 162 | u16 hash; | ||
| 163 | int index, prev; | ||
| 164 | int link = 0; | ||
| 165 | int i; | ||
| 166 | int err; | ||
| 167 | |||
| 168 | mailbox = mlx4_alloc_cmd_mailbox(dev); | ||
| 169 | if (IS_ERR(mailbox)) | ||
| 170 | return PTR_ERR(mailbox); | ||
| 171 | mgm = mailbox->buf; | ||
| 172 | |||
| 173 | mutex_lock(&priv->mcg_table.mutex); | ||
| 174 | |||
| 175 | err = find_mgm(dev, gid, mailbox, &hash, &prev, &index); | ||
| 176 | if (err) | ||
| 177 | goto out; | ||
| 178 | |||
| 179 | if (index != -1) { | ||
| 180 | if (!memcmp(mgm->gid, zero_gid, 16)) | ||
| 181 | memcpy(mgm->gid, gid, 16); | ||
| 182 | } else { | ||
| 183 | link = 1; | ||
| 184 | |||
| 185 | index = mlx4_bitmap_alloc(&priv->mcg_table.bitmap); | ||
| 186 | if (index == -1) { | ||
| 187 | mlx4_err(dev, "No AMGM entries left\n"); | ||
| 188 | err = -ENOMEM; | ||
| 189 | goto out; | ||
| 190 | } | ||
| 191 | index += dev->caps.num_mgms; | ||
| 192 | |||
| 193 | err = mlx4_READ_MCG(dev, index, mailbox); | ||
| 194 | if (err) | ||
| 195 | goto out; | ||
| 196 | |||
| 197 | memset(mgm, 0, sizeof *mgm); | ||
| 198 | memcpy(mgm->gid, gid, 16); | ||
| 199 | } | ||
| 200 | |||
| 201 | members_count = be32_to_cpu(mgm->members_count); | ||
| 202 | if (members_count == MLX4_QP_PER_MGM) { | ||
| 203 | mlx4_err(dev, "MGM at index %x is full.\n", index); | ||
| 204 | err = -ENOMEM; | ||
| 205 | goto out; | ||
| 206 | } | ||
| 207 | |||
| 208 | for (i = 0; i < members_count; ++i) | ||
| 209 | if (mgm->qp[i] == cpu_to_be32(qp->qpn)) { | ||
| 210 | mlx4_dbg(dev, "QP %06x already a member of MGM\n", qp->qpn); | ||
| 211 | err = 0; | ||
| 212 | goto out; | ||
| 213 | } | ||
| 214 | |||
| 215 | mgm->qp[members_count++] = cpu_to_be32(qp->qpn); | ||
| 216 | mgm->members_count = cpu_to_be32(members_count); | ||
| 217 | |||
| 218 | err = mlx4_WRITE_MCG(dev, index, mailbox); | ||
| 219 | if (err) | ||
| 220 | goto out; | ||
| 221 | |||
| 222 | if (!link) | ||
| 223 | goto out; | ||
| 224 | |||
| 225 | err = mlx4_READ_MCG(dev, prev, mailbox); | ||
| 226 | if (err) | ||
| 227 | goto out; | ||
| 228 | |||
| 229 | mgm->next_gid_index = cpu_to_be32(index << 6); | ||
| 230 | |||
| 231 | err = mlx4_WRITE_MCG(dev, prev, mailbox); | ||
| 232 | if (err) | ||
| 233 | goto out; | ||
| 234 | |||
| 235 | out: | ||
| 236 | if (err && link && index != -1) { | ||
| 237 | if (index < dev->caps.num_mgms) | ||
| 238 | mlx4_warn(dev, "Got AMGM index %d < %d", | ||
| 239 | index, dev->caps.num_mgms); | ||
| 240 | else | ||
| 241 | mlx4_bitmap_free(&priv->mcg_table.bitmap, | ||
| 242 | index - dev->caps.num_mgms); | ||
| 243 | } | ||
| 244 | mutex_unlock(&priv->mcg_table.mutex); | ||
| 245 | |||
| 246 | mlx4_free_cmd_mailbox(dev, mailbox); | ||
| 247 | return err; | ||
| 248 | } | ||
| 249 | EXPORT_SYMBOL_GPL(mlx4_multicast_attach); | ||
| 250 | |||
| 251 | int mlx4_multicast_detach(struct mlx4_dev *dev, struct mlx4_qp *qp, u8 gid[16]) | ||
| 252 | { | ||
| 253 | struct mlx4_priv *priv = mlx4_priv(dev); | ||
| 254 | struct mlx4_cmd_mailbox *mailbox; | ||
| 255 | struct mlx4_mgm *mgm; | ||
| 256 | u32 members_count; | ||
| 257 | u16 hash; | ||
| 258 | int prev, index; | ||
| 259 | int i, loc; | ||
| 260 | int err; | ||
| 261 | |||
| 262 | mailbox = mlx4_alloc_cmd_mailbox(dev); | ||
| 263 | if (IS_ERR(mailbox)) | ||
| 264 | return PTR_ERR(mailbox); | ||
| 265 | mgm = mailbox->buf; | ||
| 266 | |||
| 267 | mutex_lock(&priv->mcg_table.mutex); | ||
| 268 | |||
| 269 | err = find_mgm(dev, gid, mailbox, &hash, &prev, &index); | ||
| 270 | if (err) | ||
| 271 | goto out; | ||
| 272 | |||
| 273 | if (index == -1) { | ||
| 274 | mlx4_err(dev, "MGID %04x:%04x:%04x:%04x:%04x:%04x:%04x:%04x " | ||
| 275 | "not found\n", | ||
| 276 | be16_to_cpu(((__be16 *) gid)[0]), | ||
| 277 | be16_to_cpu(((__be16 *) gid)[1]), | ||
| 278 | be16_to_cpu(((__be16 *) gid)[2]), | ||
| 279 | be16_to_cpu(((__be16 *) gid)[3]), | ||
| 280 | be16_to_cpu(((__be16 *) gid)[4]), | ||
| 281 | be16_to_cpu(((__be16 *) gid)[5]), | ||
| 282 | be16_to_cpu(((__be16 *) gid)[6]), | ||
| 283 | be16_to_cpu(((__be16 *) gid)[7])); | ||
| 284 | err = -EINVAL; | ||
| 285 | goto out; | ||
| 286 | } | ||
| 287 | |||
| 288 | members_count = be32_to_cpu(mgm->members_count); | ||
| 289 | for (loc = -1, i = 0; i < members_count; ++i) | ||
| 290 | if (mgm->qp[i] == cpu_to_be32(qp->qpn)) | ||
| 291 | loc = i; | ||
| 292 | |||
| 293 | if (loc == -1) { | ||
| 294 | mlx4_err(dev, "QP %06x not found in MGM\n", qp->qpn); | ||
| 295 | err = -EINVAL; | ||
| 296 | goto out; | ||
| 297 | } | ||
| 298 | |||
| 299 | |||
| 300 | mgm->members_count = cpu_to_be32(--members_count); | ||
| 301 | mgm->qp[loc] = mgm->qp[i - 1]; | ||
| 302 | mgm->qp[i - 1] = 0; | ||
| 303 | |||
| 304 | err = mlx4_WRITE_MCG(dev, index, mailbox); | ||
| 305 | if (err) | ||
| 306 | goto out; | ||
| 307 | |||
| 308 | if (i != 1) | ||
| 309 | goto out; | ||
| 310 | |||
| 311 | if (prev == -1) { | ||
| 312 | /* Remove entry from MGM */ | ||
| 313 | int amgm_index = be32_to_cpu(mgm->next_gid_index) >> 6; | ||
| 314 | if (amgm_index) { | ||
| 315 | err = mlx4_READ_MCG(dev, amgm_index, mailbox); | ||
| 316 | if (err) | ||
| 317 | goto out; | ||
| 318 | } else | ||
| 319 | memset(mgm->gid, 0, 16); | ||
| 320 | |||
| 321 | err = mlx4_WRITE_MCG(dev, index, mailbox); | ||
| 322 | if (err) | ||
| 323 | goto out; | ||
| 324 | |||
| 325 | if (amgm_index) { | ||
| 326 | if (amgm_index < dev->caps.num_mgms) | ||
| 327 | mlx4_warn(dev, "MGM entry %d had AMGM index %d < %d", | ||
| 328 | index, amgm_index, dev->caps.num_mgms); | ||
| 329 | else | ||
| 330 | mlx4_bitmap_free(&priv->mcg_table.bitmap, | ||
| 331 | amgm_index - dev->caps.num_mgms); | ||
| 332 | } | ||
| 333 | } else { | ||
| 334 | /* Remove entry from AMGM */ | ||
| 335 | int cur_next_index = be32_to_cpu(mgm->next_gid_index) >> 6; | ||
| 336 | err = mlx4_READ_MCG(dev, prev, mailbox); | ||
| 337 | if (err) | ||
| 338 | goto out; | ||
| 339 | |||
| 340 | mgm->next_gid_index = cpu_to_be32(cur_next_index << 6); | ||
| 341 | |||
| 342 | err = mlx4_WRITE_MCG(dev, prev, mailbox); | ||
| 343 | if (err) | ||
| 344 | goto out; | ||
| 345 | |||
| 346 | if (index < dev->caps.num_mgms) | ||
| 347 | mlx4_warn(dev, "entry %d had next AMGM index %d < %d", | ||
| 348 | prev, index, dev->caps.num_mgms); | ||
| 349 | else | ||
| 350 | mlx4_bitmap_free(&priv->mcg_table.bitmap, | ||
| 351 | index - dev->caps.num_mgms); | ||
| 352 | } | ||
| 353 | |||
| 354 | out: | ||
| 355 | mutex_unlock(&priv->mcg_table.mutex); | ||
| 356 | |||
| 357 | mlx4_free_cmd_mailbox(dev, mailbox); | ||
| 358 | return err; | ||
| 359 | } | ||
| 360 | EXPORT_SYMBOL_GPL(mlx4_multicast_detach); | ||
| 361 | |||
| 362 | int __devinit mlx4_init_mcg_table(struct mlx4_dev *dev) | ||
| 363 | { | ||
| 364 | struct mlx4_priv *priv = mlx4_priv(dev); | ||
| 365 | int err; | ||
| 366 | |||
| 367 | err = mlx4_bitmap_init(&priv->mcg_table.bitmap, | ||
| 368 | dev->caps.num_amgms, dev->caps.num_amgms - 1, 0); | ||
| 369 | if (err) | ||
| 370 | return err; | ||
| 371 | |||
| 372 | mutex_init(&priv->mcg_table.mutex); | ||
| 373 | |||
| 374 | return 0; | ||
| 375 | } | ||
| 376 | |||
| 377 | void mlx4_cleanup_mcg_table(struct mlx4_dev *dev) | ||
| 378 | { | ||
| 379 | mlx4_bitmap_cleanup(&mlx4_priv(dev)->mcg_table.bitmap); | ||
| 380 | } | ||
diff --git a/drivers/net/mlx4/mlx4.h b/drivers/net/mlx4/mlx4.h new file mode 100644 index 000000000000..9befbae3d196 --- /dev/null +++ b/drivers/net/mlx4/mlx4.h | |||
| @@ -0,0 +1,348 @@ | |||
| 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, 2006, 2007 Cisco Systems. All rights reserved. | ||
| 5 | * Copyright (c) 2005 Mellanox Technologies. All rights reserved. | ||
| 6 | * Copyright (c) 2004 Voltaire, Inc. All rights reserved. | ||
| 7 | * | ||
| 8 | * This software is available to you under a choice of one of two | ||
| 9 | * licenses. You may choose to be licensed under the terms of the GNU | ||
| 10 | * General Public License (GPL) Version 2, available from the file | ||
| 11 | * COPYING in the main directory of this source tree, or the | ||
| 12 | * OpenIB.org BSD license below: | ||
| 13 | * | ||
| 14 | * Redistribution and use in source and binary forms, with or | ||
| 15 | * without modification, are permitted provided that the following | ||
| 16 | * conditions are met: | ||
| 17 | * | ||
| 18 | * - Redistributions of source code must retain the above | ||
| 19 | * copyright notice, this list of conditions and the following | ||
| 20 | * disclaimer. | ||
| 21 | * | ||
| 22 | * - Redistributions in binary form must reproduce the above | ||
| 23 | * copyright notice, this list of conditions and the following | ||
| 24 | * disclaimer in the documentation and/or other materials | ||
| 25 | * provided with the distribution. | ||
| 26 | * | ||
| 27 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, | ||
| 28 | * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF | ||
| 29 | * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND | ||
| 30 | * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS | ||
| 31 | * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN | ||
| 32 | * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN | ||
| 33 | * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE | ||
| 34 | * SOFTWARE. | ||
| 35 | */ | ||
| 36 | |||
| 37 | #ifndef MLX4_H | ||
| 38 | #define MLX4_H | ||
| 39 | |||
| 40 | #include <linux/radix-tree.h> | ||
| 41 | |||
| 42 | #include <linux/mlx4/device.h> | ||
| 43 | #include <linux/mlx4/doorbell.h> | ||
| 44 | |||
| 45 | #define DRV_NAME "mlx4_core" | ||
| 46 | #define PFX DRV_NAME ": " | ||
| 47 | #define DRV_VERSION "0.01" | ||
| 48 | #define DRV_RELDATE "May 1, 2007" | ||
| 49 | |||
| 50 | enum { | ||
| 51 | MLX4_HCR_BASE = 0x80680, | ||
| 52 | MLX4_HCR_SIZE = 0x0001c, | ||
| 53 | MLX4_CLR_INT_SIZE = 0x00008 | ||
| 54 | }; | ||
| 55 | |||
| 56 | enum { | ||
| 57 | MLX4_BOARD_ID_LEN = 64 | ||
| 58 | }; | ||
| 59 | |||
| 60 | enum { | ||
| 61 | MLX4_MGM_ENTRY_SIZE = 0x40, | ||
| 62 | MLX4_QP_PER_MGM = 4 * (MLX4_MGM_ENTRY_SIZE / 16 - 2), | ||
| 63 | MLX4_MTT_ENTRY_PER_SEG = 8 | ||
| 64 | }; | ||
| 65 | |||
| 66 | enum { | ||
| 67 | MLX4_EQ_ASYNC, | ||
| 68 | MLX4_EQ_COMP, | ||
| 69 | MLX4_EQ_CATAS, | ||
| 70 | MLX4_NUM_EQ | ||
| 71 | }; | ||
| 72 | |||
| 73 | enum { | ||
| 74 | MLX4_NUM_PDS = 1 << 15 | ||
| 75 | }; | ||
| 76 | |||
| 77 | enum { | ||
| 78 | MLX4_CMPT_TYPE_QP = 0, | ||
| 79 | MLX4_CMPT_TYPE_SRQ = 1, | ||
| 80 | MLX4_CMPT_TYPE_CQ = 2, | ||
| 81 | MLX4_CMPT_TYPE_EQ = 3, | ||
| 82 | MLX4_CMPT_NUM_TYPE | ||
| 83 | }; | ||
| 84 | |||
| 85 | enum { | ||
| 86 | MLX4_CMPT_SHIFT = 24, | ||
| 87 | MLX4_NUM_CMPTS = MLX4_CMPT_NUM_TYPE << MLX4_CMPT_SHIFT | ||
| 88 | }; | ||
| 89 | |||
| 90 | #ifdef CONFIG_MLX4_DEBUG | ||
| 91 | extern int mlx4_debug_level; | ||
| 92 | |||
| 93 | #define mlx4_dbg(mdev, format, arg...) \ | ||
| 94 | do { \ | ||
| 95 | if (mlx4_debug_level) \ | ||
| 96 | dev_printk(KERN_DEBUG, &mdev->pdev->dev, format, ## arg); \ | ||
| 97 | } while (0) | ||
| 98 | |||
| 99 | #else /* CONFIG_MLX4_DEBUG */ | ||
| 100 | |||
| 101 | #define mlx4_dbg(mdev, format, arg...) do { (void) mdev; } while (0) | ||
| 102 | |||
| 103 | #endif /* CONFIG_MLX4_DEBUG */ | ||
| 104 | |||
| 105 | #define mlx4_err(mdev, format, arg...) \ | ||
| 106 | dev_err(&mdev->pdev->dev, format, ## arg) | ||
| 107 | #define mlx4_info(mdev, format, arg...) \ | ||
| 108 | dev_info(&mdev->pdev->dev, format, ## arg) | ||
| 109 | #define mlx4_warn(mdev, format, arg...) \ | ||
| 110 | dev_warn(&mdev->pdev->dev, format, ## arg) | ||
| 111 | |||
| 112 | struct mlx4_bitmap { | ||
| 113 | u32 last; | ||
| 114 | u32 top; | ||
| 115 | u32 max; | ||
| 116 | u32 mask; | ||
| 117 | spinlock_t lock; | ||
| 118 | unsigned long *table; | ||
| 119 | }; | ||
| 120 | |||
| 121 | struct mlx4_buddy { | ||
| 122 | unsigned long **bits; | ||
| 123 | int max_order; | ||
| 124 | spinlock_t lock; | ||
| 125 | }; | ||
| 126 | |||
| 127 | struct mlx4_icm; | ||
| 128 | |||
| 129 | struct mlx4_icm_table { | ||
| 130 | u64 virt; | ||
| 131 | int num_icm; | ||
| 132 | int num_obj; | ||
| 133 | int obj_size; | ||
| 134 | int lowmem; | ||
| 135 | struct mutex mutex; | ||
| 136 | struct mlx4_icm **icm; | ||
| 137 | }; | ||
| 138 | |||
| 139 | struct mlx4_eq { | ||
| 140 | struct mlx4_dev *dev; | ||
| 141 | void __iomem *doorbell; | ||
| 142 | int eqn; | ||
| 143 | u32 cons_index; | ||
| 144 | u16 irq; | ||
| 145 | u16 have_irq; | ||
| 146 | int nent; | ||
| 147 | struct mlx4_buf_list *page_list; | ||
| 148 | struct mlx4_mtt mtt; | ||
| 149 | }; | ||
| 150 | |||
| 151 | struct mlx4_profile { | ||
| 152 | int num_qp; | ||
| 153 | int rdmarc_per_qp; | ||
| 154 | int num_srq; | ||
| 155 | int num_cq; | ||
| 156 | int num_mcg; | ||
| 157 | int num_mpt; | ||
| 158 | int num_mtt; | ||
| 159 | }; | ||
| 160 | |||
| 161 | struct mlx4_fw { | ||
| 162 | u64 clr_int_base; | ||
| 163 | u64 catas_offset; | ||
| 164 | struct mlx4_icm *fw_icm; | ||
| 165 | struct mlx4_icm *aux_icm; | ||
| 166 | u32 catas_size; | ||
| 167 | u16 fw_pages; | ||
| 168 | u8 clr_int_bar; | ||
| 169 | u8 catas_bar; | ||
| 170 | }; | ||
| 171 | |||
| 172 | struct mlx4_cmd { | ||
| 173 | struct pci_pool *pool; | ||
| 174 | void __iomem *hcr; | ||
| 175 | struct mutex hcr_mutex; | ||
| 176 | struct semaphore poll_sem; | ||
| 177 | struct semaphore event_sem; | ||
| 178 | int max_cmds; | ||
| 179 | spinlock_t context_lock; | ||
| 180 | int free_head; | ||
| 181 | struct mlx4_cmd_context *context; | ||
| 182 | u16 token_mask; | ||
| 183 | u8 use_events; | ||
| 184 | u8 toggle; | ||
| 185 | }; | ||
| 186 | |||
| 187 | struct mlx4_uar_table { | ||
| 188 | struct mlx4_bitmap bitmap; | ||
| 189 | }; | ||
| 190 | |||
| 191 | struct mlx4_mr_table { | ||
| 192 | struct mlx4_bitmap mpt_bitmap; | ||
| 193 | struct mlx4_buddy mtt_buddy; | ||
| 194 | u64 mtt_base; | ||
| 195 | u64 mpt_base; | ||
| 196 | struct mlx4_icm_table mtt_table; | ||
| 197 | struct mlx4_icm_table dmpt_table; | ||
| 198 | }; | ||
| 199 | |||
| 200 | struct mlx4_cq_table { | ||
| 201 | struct mlx4_bitmap bitmap; | ||
| 202 | spinlock_t lock; | ||
| 203 | struct radix_tree_root tree; | ||
| 204 | struct mlx4_icm_table table; | ||
| 205 | struct mlx4_icm_table cmpt_table; | ||
| 206 | }; | ||
| 207 | |||
| 208 | struct mlx4_eq_table { | ||
| 209 | struct mlx4_bitmap bitmap; | ||
| 210 | void __iomem *clr_int; | ||
| 211 | void __iomem *uar_map[(MLX4_NUM_EQ + 6) / 4]; | ||
| 212 | u32 clr_mask; | ||
| 213 | struct mlx4_eq eq[MLX4_NUM_EQ]; | ||
| 214 | u64 icm_virt; | ||
| 215 | struct page *icm_page; | ||
| 216 | dma_addr_t icm_dma; | ||
| 217 | struct mlx4_icm_table cmpt_table; | ||
| 218 | int have_irq; | ||
| 219 | u8 inta_pin; | ||
| 220 | }; | ||
| 221 | |||
| 222 | struct mlx4_srq_table { | ||
| 223 | struct mlx4_bitmap bitmap; | ||
| 224 | spinlock_t lock; | ||
| 225 | struct radix_tree_root tree; | ||
| 226 | struct mlx4_icm_table table; | ||
| 227 | struct mlx4_icm_table cmpt_table; | ||
| 228 | }; | ||
| 229 | |||
| 230 | struct mlx4_qp_table { | ||
| 231 | struct mlx4_bitmap bitmap; | ||
| 232 | u32 rdmarc_base; | ||
| 233 | int rdmarc_shift; | ||
| 234 | spinlock_t lock; | ||
| 235 | struct mlx4_icm_table qp_table; | ||
| 236 | struct mlx4_icm_table auxc_table; | ||
| 237 | struct mlx4_icm_table altc_table; | ||
| 238 | struct mlx4_icm_table rdmarc_table; | ||
| 239 | struct mlx4_icm_table cmpt_table; | ||
| 240 | }; | ||
| 241 | |||
| 242 | struct mlx4_mcg_table { | ||
| 243 | struct mutex mutex; | ||
| 244 | struct mlx4_bitmap bitmap; | ||
| 245 | struct mlx4_icm_table table; | ||
| 246 | }; | ||
| 247 | |||
| 248 | struct mlx4_catas_err { | ||
| 249 | u32 __iomem *map; | ||
| 250 | int size; | ||
| 251 | }; | ||
| 252 | |||
| 253 | struct mlx4_priv { | ||
| 254 | struct mlx4_dev dev; | ||
| 255 | |||
| 256 | struct list_head dev_list; | ||
| 257 | struct list_head ctx_list; | ||
| 258 | spinlock_t ctx_lock; | ||
| 259 | |||
| 260 | struct mlx4_fw fw; | ||
| 261 | struct mlx4_cmd cmd; | ||
| 262 | |||
| 263 | struct mlx4_bitmap pd_bitmap; | ||
| 264 | struct mlx4_uar_table uar_table; | ||
| 265 | struct mlx4_mr_table mr_table; | ||
| 266 | struct mlx4_cq_table cq_table; | ||
| 267 | struct mlx4_eq_table eq_table; | ||
| 268 | struct mlx4_srq_table srq_table; | ||
| 269 | struct mlx4_qp_table qp_table; | ||
| 270 | struct mlx4_mcg_table mcg_table; | ||
| 271 | |||
| 272 | struct mlx4_catas_err catas_err; | ||
| 273 | |||
| 274 | void __iomem *clr_base; | ||
| 275 | |||
| 276 | struct mlx4_uar driver_uar; | ||
| 277 | void __iomem *kar; | ||
| 278 | MLX4_DECLARE_DOORBELL_LOCK(doorbell_lock) | ||
| 279 | |||
| 280 | u32 rev_id; | ||
| 281 | char board_id[MLX4_BOARD_ID_LEN]; | ||
| 282 | }; | ||
| 283 | |||
| 284 | static inline struct mlx4_priv *mlx4_priv(struct mlx4_dev *dev) | ||
| 285 | { | ||
| 286 | return container_of(dev, struct mlx4_priv, dev); | ||
| 287 | } | ||
| 288 | |||
| 289 | u32 mlx4_bitmap_alloc(struct mlx4_bitmap *bitmap); | ||
| 290 | void mlx4_bitmap_free(struct mlx4_bitmap *bitmap, u32 obj); | ||
| 291 | int mlx4_bitmap_init(struct mlx4_bitmap *bitmap, u32 num, u32 mask, u32 reserved); | ||
| 292 | void mlx4_bitmap_cleanup(struct mlx4_bitmap *bitmap); | ||
| 293 | |||
| 294 | int mlx4_reset(struct mlx4_dev *dev); | ||
| 295 | |||
| 296 | int mlx4_init_pd_table(struct mlx4_dev *dev); | ||
| 297 | int mlx4_init_uar_table(struct mlx4_dev *dev); | ||
| 298 | int mlx4_init_mr_table(struct mlx4_dev *dev); | ||
| 299 | int mlx4_init_eq_table(struct mlx4_dev *dev); | ||
| 300 | int mlx4_init_cq_table(struct mlx4_dev *dev); | ||
| 301 | int mlx4_init_qp_table(struct mlx4_dev *dev); | ||
| 302 | int mlx4_init_srq_table(struct mlx4_dev *dev); | ||
| 303 | int mlx4_init_mcg_table(struct mlx4_dev *dev); | ||
| 304 | |||
| 305 | void mlx4_cleanup_pd_table(struct mlx4_dev *dev); | ||
| 306 | void mlx4_cleanup_uar_table(struct mlx4_dev *dev); | ||
| 307 | void mlx4_cleanup_mr_table(struct mlx4_dev *dev); | ||
| 308 | void mlx4_cleanup_eq_table(struct mlx4_dev *dev); | ||
| 309 | void mlx4_cleanup_cq_table(struct mlx4_dev *dev); | ||
| 310 | void mlx4_cleanup_qp_table(struct mlx4_dev *dev); | ||
| 311 | void mlx4_cleanup_srq_table(struct mlx4_dev *dev); | ||
| 312 | void mlx4_cleanup_mcg_table(struct mlx4_dev *dev); | ||
| 313 | |||
| 314 | void mlx4_map_catas_buf(struct mlx4_dev *dev); | ||
| 315 | void mlx4_unmap_catas_buf(struct mlx4_dev *dev); | ||
| 316 | |||
| 317 | int mlx4_register_device(struct mlx4_dev *dev); | ||
| 318 | void mlx4_unregister_device(struct mlx4_dev *dev); | ||
| 319 | void mlx4_dispatch_event(struct mlx4_dev *dev, enum mlx4_event type, | ||
| 320 | int subtype, int port); | ||
| 321 | |||
| 322 | struct mlx4_dev_cap; | ||
| 323 | struct mlx4_init_hca_param; | ||
| 324 | |||
| 325 | u64 mlx4_make_profile(struct mlx4_dev *dev, | ||
| 326 | struct mlx4_profile *request, | ||
| 327 | struct mlx4_dev_cap *dev_cap, | ||
| 328 | struct mlx4_init_hca_param *init_hca); | ||
| 329 | |||
| 330 | int mlx4_map_eq_icm(struct mlx4_dev *dev, u64 icm_virt); | ||
| 331 | void mlx4_unmap_eq_icm(struct mlx4_dev *dev); | ||
| 332 | |||
| 333 | int mlx4_cmd_init(struct mlx4_dev *dev); | ||
| 334 | void mlx4_cmd_cleanup(struct mlx4_dev *dev); | ||
| 335 | void mlx4_cmd_event(struct mlx4_dev *dev, u16 token, u8 status, u64 out_param); | ||
| 336 | int mlx4_cmd_use_events(struct mlx4_dev *dev); | ||
| 337 | void mlx4_cmd_use_polling(struct mlx4_dev *dev); | ||
| 338 | |||
| 339 | void mlx4_cq_completion(struct mlx4_dev *dev, u32 cqn); | ||
| 340 | void mlx4_cq_event(struct mlx4_dev *dev, u32 cqn, int event_type); | ||
| 341 | |||
| 342 | void mlx4_qp_event(struct mlx4_dev *dev, u32 qpn, int event_type); | ||
| 343 | |||
| 344 | void mlx4_srq_event(struct mlx4_dev *dev, u32 srqn, int event_type); | ||
| 345 | |||
| 346 | void mlx4_handle_catas_err(struct mlx4_dev *dev); | ||
| 347 | |||
| 348 | #endif /* MLX4_H */ | ||
diff --git a/drivers/net/mlx4/mr.c b/drivers/net/mlx4/mr.c new file mode 100644 index 000000000000..b33864dab179 --- /dev/null +++ b/drivers/net/mlx4/mr.c | |||
| @@ -0,0 +1,479 @@ | |||
| 1 | /* | ||
| 2 | * Copyright (c) 2004 Topspin Communications. All rights reserved. | ||
| 3 | * Copyright (c) 2005 Mellanox Technologies. All rights reserved. | ||
| 4 | * Copyright (c) 2006, 2007 Cisco Systems, Inc. All rights reserved. | ||
| 5 | * | ||
| 6 | * This software is available to you under a choice of one of two | ||
| 7 | * licenses. You may choose to be licensed under the terms of the GNU | ||
| 8 | * General Public License (GPL) Version 2, available from the file | ||
| 9 | * COPYING in the main directory of this source tree, or the | ||
| 10 | * OpenIB.org BSD license below: | ||
| 11 | * | ||
| 12 | * Redistribution and use in source and binary forms, with or | ||
| 13 | * without modification, are permitted provided that the following | ||
| 14 | * conditions are met: | ||
| 15 | * | ||
| 16 | * - Redistributions of source code must retain the above | ||
| 17 | * copyright notice, this list of conditions and the following | ||
| 18 | * disclaimer. | ||
| 19 | * | ||
| 20 | * - Redistributions in binary form must reproduce the above | ||
| 21 | * copyright notice, this list of conditions and the following | ||
| 22 | * disclaimer in the documentation and/or other materials | ||
| 23 | * provided with the distribution. | ||
| 24 | * | ||
| 25 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, | ||
| 26 | * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF | ||
| 27 | * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND | ||
| 28 | * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS | ||
| 29 | * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN | ||
| 30 | * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN | ||
| 31 | * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE | ||
| 32 | * SOFTWARE. | ||
| 33 | */ | ||
| 34 | |||
| 35 | #include <linux/init.h> | ||
| 36 | #include <linux/errno.h> | ||
| 37 | |||
| 38 | #include <linux/mlx4/cmd.h> | ||
| 39 | |||
| 40 | #include "mlx4.h" | ||
| 41 | #include "icm.h" | ||
| 42 | |||
| 43 | /* | ||
| 44 | * Must be packed because mtt_seg is 64 bits but only aligned to 32 bits. | ||
| 45 | */ | ||
| 46 | struct mlx4_mpt_entry { | ||
| 47 | __be32 flags; | ||
| 48 | __be32 qpn; | ||
| 49 | __be32 key; | ||
| 50 | __be32 pd; | ||
| 51 | __be64 start; | ||
| 52 | __be64 length; | ||
| 53 | __be32 lkey; | ||
| 54 | __be32 win_cnt; | ||
| 55 | u8 reserved1[3]; | ||
| 56 | u8 mtt_rep; | ||
| 57 | __be64 mtt_seg; | ||
| 58 | __be32 mtt_sz; | ||
| 59 | __be32 entity_size; | ||
| 60 | __be32 first_byte_offset; | ||
| 61 | } __attribute__((packed)); | ||
| 62 | |||
| 63 | #define MLX4_MPT_FLAG_SW_OWNS (0xfUL << 28) | ||
| 64 | #define MLX4_MPT_FLAG_MIO (1 << 17) | ||
| 65 | #define MLX4_MPT_FLAG_BIND_ENABLE (1 << 15) | ||
| 66 | #define MLX4_MPT_FLAG_PHYSICAL (1 << 9) | ||
| 67 | #define MLX4_MPT_FLAG_REGION (1 << 8) | ||
| 68 | |||
| 69 | #define MLX4_MTT_FLAG_PRESENT 1 | ||
| 70 | |||
| 71 | static u32 mlx4_buddy_alloc(struct mlx4_buddy *buddy, int order) | ||
| 72 | { | ||
| 73 | int o; | ||
| 74 | int m; | ||
| 75 | u32 seg; | ||
| 76 | |||
| 77 | spin_lock(&buddy->lock); | ||
| 78 | |||
| 79 | for (o = order; o <= buddy->max_order; ++o) { | ||
| 80 | m = 1 << (buddy->max_order - o); | ||
| 81 | seg = find_first_bit(buddy->bits[o], m); | ||
| 82 | if (seg < m) | ||
| 83 | goto found; | ||
| 84 | } | ||
| 85 | |||
| 86 | spin_unlock(&buddy->lock); | ||
| 87 | return -1; | ||
| 88 | |||
| 89 | found: | ||
| 90 | clear_bit(seg, buddy->bits[o]); | ||
| 91 | |||
| 92 | while (o > order) { | ||
| 93 | --o; | ||
| 94 | seg <<= 1; | ||
| 95 | set_bit(seg ^ 1, buddy->bits[o]); | ||
| 96 | } | ||
| 97 | |||
| 98 | spin_unlock(&buddy->lock); | ||
| 99 | |||
| 100 | seg <<= order; | ||
| 101 | |||
| 102 | return seg; | ||
| 103 | } | ||
| 104 | |||
| 105 | static void mlx4_buddy_free(struct mlx4_buddy *buddy, u32 seg, int order) | ||
| 106 | { | ||
| 107 | seg >>= order; | ||
| 108 | |||
| 109 | spin_lock(&buddy->lock); | ||
| 110 | |||
| 111 | while (test_bit(seg ^ 1, buddy->bits[order])) { | ||
| 112 | clear_bit(seg ^ 1, buddy->bits[order]); | ||
| 113 | seg >>= 1; | ||
| 114 | ++order; | ||
| 115 | } | ||
| 116 | |||
| 117 | set_bit(seg, buddy->bits[order]); | ||
| 118 | |||
| 119 | spin_unlock(&buddy->lock); | ||
| 120 | } | ||
| 121 | |||
| 122 | static int __devinit mlx4_buddy_init(struct mlx4_buddy *buddy, int max_order) | ||
| 123 | { | ||
| 124 | int i, s; | ||
| 125 | |||
| 126 | buddy->max_order = max_order; | ||
| 127 | spin_lock_init(&buddy->lock); | ||
| 128 | |||
| 129 | buddy->bits = kzalloc((buddy->max_order + 1) * sizeof (long *), | ||
| 130 | GFP_KERNEL); | ||
| 131 | if (!buddy->bits) | ||
| 132 | goto err_out; | ||
| 133 | |||
| 134 | for (i = 0; i <= buddy->max_order; ++i) { | ||
| 135 | s = BITS_TO_LONGS(1 << (buddy->max_order - i)); | ||
| 136 | buddy->bits[i] = kmalloc(s * sizeof (long), GFP_KERNEL); | ||
| 137 | if (!buddy->bits[i]) | ||
| 138 | goto err_out_free; | ||
| 139 | bitmap_zero(buddy->bits[i], 1 << (buddy->max_order - i)); | ||
| 140 | } | ||
| 141 | |||
| 142 | set_bit(0, buddy->bits[buddy->max_order]); | ||
| 143 | |||
| 144 | return 0; | ||
| 145 | |||
| 146 | err_out_free: | ||
| 147 | for (i = 0; i <= buddy->max_order; ++i) | ||
| 148 | kfree(buddy->bits[i]); | ||
| 149 | |||
| 150 | kfree(buddy->bits); | ||
| 151 | |||
| 152 | err_out: | ||
| 153 | return -ENOMEM; | ||
| 154 | } | ||
| 155 | |||
| 156 | static void mlx4_buddy_cleanup(struct mlx4_buddy *buddy) | ||
| 157 | { | ||
| 158 | int i; | ||
| 159 | |||
| 160 | for (i = 0; i <= buddy->max_order; ++i) | ||
| 161 | kfree(buddy->bits[i]); | ||
| 162 | |||
| 163 | kfree(buddy->bits); | ||
| 164 | } | ||
| 165 | |||
| 166 | static u32 mlx4_alloc_mtt_range(struct mlx4_dev *dev, int order) | ||
| 167 | { | ||
| 168 | struct mlx4_mr_table *mr_table = &mlx4_priv(dev)->mr_table; | ||
| 169 | u32 seg; | ||
| 170 | |||
| 171 | seg = mlx4_buddy_alloc(&mr_table->mtt_buddy, order); | ||
| 172 | if (seg == -1) | ||
| 173 | return -1; | ||
| 174 | |||
| 175 | if (mlx4_table_get_range(dev, &mr_table->mtt_table, seg, | ||
| 176 | seg + (1 << order) - 1)) { | ||
| 177 | mlx4_buddy_free(&mr_table->mtt_buddy, seg, order); | ||
| 178 | return -1; | ||
| 179 | } | ||
| 180 | |||
| 181 | return seg; | ||
| 182 | } | ||
| 183 | |||
| 184 | int mlx4_mtt_init(struct mlx4_dev *dev, int npages, int page_shift, | ||
| 185 | struct mlx4_mtt *mtt) | ||
| 186 | { | ||
| 187 | int i; | ||
| 188 | |||
| 189 | if (!npages) { | ||
| 190 | mtt->order = -1; | ||
| 191 | mtt->page_shift = MLX4_ICM_PAGE_SHIFT; | ||
| 192 | return 0; | ||
| 193 | } else | ||
| 194 | mtt->page_shift = page_shift; | ||
| 195 | |||
| 196 | for (mtt->order = 0, i = MLX4_MTT_ENTRY_PER_SEG; i < npages; i <<= 1) | ||
| 197 | ++mtt->order; | ||
| 198 | |||
| 199 | mtt->first_seg = mlx4_alloc_mtt_range(dev, mtt->order); | ||
| 200 | if (mtt->first_seg == -1) | ||
| 201 | return -ENOMEM; | ||
| 202 | |||
| 203 | return 0; | ||
| 204 | } | ||
| 205 | EXPORT_SYMBOL_GPL(mlx4_mtt_init); | ||
| 206 | |||
| 207 | void mlx4_mtt_cleanup(struct mlx4_dev *dev, struct mlx4_mtt *mtt) | ||
| 208 | { | ||
| 209 | struct mlx4_mr_table *mr_table = &mlx4_priv(dev)->mr_table; | ||
| 210 | |||
| 211 | if (mtt->order < 0) | ||
| 212 | return; | ||
| 213 | |||
| 214 | mlx4_buddy_free(&mr_table->mtt_buddy, mtt->first_seg, mtt->order); | ||
| 215 | mlx4_table_put_range(dev, &mr_table->mtt_table, mtt->first_seg, | ||
| 216 | mtt->first_seg + (1 << mtt->order) - 1); | ||
| 217 | } | ||
| 218 | EXPORT_SYMBOL_GPL(mlx4_mtt_cleanup); | ||
| 219 | |||
| 220 | u64 mlx4_mtt_addr(struct mlx4_dev *dev, struct mlx4_mtt *mtt) | ||
| 221 | { | ||
| 222 | return (u64) mtt->first_seg * dev->caps.mtt_entry_sz; | ||
| 223 | } | ||
| 224 | EXPORT_SYMBOL_GPL(mlx4_mtt_addr); | ||
| 225 | |||
| 226 | static u32 hw_index_to_key(u32 ind) | ||
| 227 | { | ||
| 228 | return (ind >> 24) | (ind << 8); | ||
| 229 | } | ||
| 230 | |||
| 231 | static u32 key_to_hw_index(u32 key) | ||
| 232 | { | ||
| 233 | return (key << 24) | (key >> 8); | ||
| 234 | } | ||
| 235 | |||
| 236 | static int mlx4_SW2HW_MPT(struct mlx4_dev *dev, struct mlx4_cmd_mailbox *mailbox, | ||
| 237 | int mpt_index) | ||
| 238 | { | ||
| 239 | return mlx4_cmd(dev, mailbox->dma, mpt_index, 0, MLX4_CMD_SW2HW_MPT, | ||
| 240 | MLX4_CMD_TIME_CLASS_B); | ||
| 241 | } | ||
| 242 | |||
| 243 | static int mlx4_HW2SW_MPT(struct mlx4_dev *dev, struct mlx4_cmd_mailbox *mailbox, | ||
| 244 | int mpt_index) | ||
| 245 | { | ||
| 246 | return mlx4_cmd_box(dev, 0, mailbox ? mailbox->dma : 0, mpt_index, | ||
| 247 | !mailbox, MLX4_CMD_HW2SW_MPT, MLX4_CMD_TIME_CLASS_B); | ||
| 248 | } | ||
| 249 | |||
| 250 | int mlx4_mr_alloc(struct mlx4_dev *dev, u32 pd, u64 iova, u64 size, u32 access, | ||
| 251 | int npages, int page_shift, struct mlx4_mr *mr) | ||
| 252 | { | ||
| 253 | struct mlx4_priv *priv = mlx4_priv(dev); | ||
| 254 | u32 index; | ||
| 255 | int err; | ||
| 256 | |||
| 257 | index = mlx4_bitmap_alloc(&priv->mr_table.mpt_bitmap); | ||
| 258 | if (index == -1) { | ||
| 259 | err = -ENOMEM; | ||
| 260 | goto err; | ||
| 261 | } | ||
| 262 | |||
| 263 | mr->iova = iova; | ||
| 264 | mr->size = size; | ||
| 265 | mr->pd = pd; | ||
| 266 | mr->access = access; | ||
| 267 | mr->enabled = 0; | ||
| 268 | mr->key = hw_index_to_key(index); | ||
| 269 | |||
| 270 | err = mlx4_mtt_init(dev, npages, page_shift, &mr->mtt); | ||
| 271 | if (err) | ||
| 272 | goto err_index; | ||
| 273 | |||
| 274 | return 0; | ||
| 275 | |||
| 276 | err_index: | ||
| 277 | mlx4_bitmap_free(&priv->mr_table.mpt_bitmap, index); | ||
| 278 | |||
| 279 | err: | ||
| 280 | kfree(mr); | ||
| 281 | return err; | ||
| 282 | } | ||
| 283 | EXPORT_SYMBOL_GPL(mlx4_mr_alloc); | ||
| 284 | |||
| 285 | void mlx4_mr_free(struct mlx4_dev *dev, struct mlx4_mr *mr) | ||
| 286 | { | ||
| 287 | struct mlx4_priv *priv = mlx4_priv(dev); | ||
| 288 | int err; | ||
| 289 | |||
| 290 | if (mr->enabled) { | ||
| 291 | err = mlx4_HW2SW_MPT(dev, NULL, | ||
| 292 | key_to_hw_index(mr->key) & | ||
| 293 | (dev->caps.num_mpts - 1)); | ||
| 294 | if (err) | ||
| 295 | mlx4_warn(dev, "HW2SW_MPT failed (%d)\n", err); | ||
| 296 | } | ||
| 297 | |||
| 298 | mlx4_mtt_cleanup(dev, &mr->mtt); | ||
| 299 | mlx4_bitmap_free(&priv->mr_table.mpt_bitmap, key_to_hw_index(mr->key)); | ||
| 300 | } | ||
| 301 | EXPORT_SYMBOL_GPL(mlx4_mr_free); | ||
| 302 | |||
| 303 | int mlx4_mr_enable(struct mlx4_dev *dev, struct mlx4_mr *mr) | ||
| 304 | { | ||
| 305 | struct mlx4_mr_table *mr_table = &mlx4_priv(dev)->mr_table; | ||
| 306 | struct mlx4_cmd_mailbox *mailbox; | ||
| 307 | struct mlx4_mpt_entry *mpt_entry; | ||
| 308 | int err; | ||
| 309 | |||
| 310 | err = mlx4_table_get(dev, &mr_table->dmpt_table, key_to_hw_index(mr->key)); | ||
| 311 | if (err) | ||
| 312 | return err; | ||
| 313 | |||
| 314 | mailbox = mlx4_alloc_cmd_mailbox(dev); | ||
| 315 | if (IS_ERR(mailbox)) { | ||
| 316 | err = PTR_ERR(mailbox); | ||
| 317 | goto err_table; | ||
| 318 | } | ||
| 319 | mpt_entry = mailbox->buf; | ||
| 320 | |||
| 321 | memset(mpt_entry, 0, sizeof *mpt_entry); | ||
| 322 | |||
| 323 | mpt_entry->flags = cpu_to_be32(MLX4_MPT_FLAG_SW_OWNS | | ||
| 324 | MLX4_MPT_FLAG_MIO | | ||
| 325 | MLX4_MPT_FLAG_REGION | | ||
| 326 | mr->access); | ||
| 327 | if (mr->mtt.order < 0) | ||
| 328 | mpt_entry->flags |= cpu_to_be32(MLX4_MPT_FLAG_PHYSICAL); | ||
| 329 | |||
| 330 | mpt_entry->key = cpu_to_be32(key_to_hw_index(mr->key)); | ||
| 331 | mpt_entry->pd = cpu_to_be32(mr->pd); | ||
| 332 | mpt_entry->start = cpu_to_be64(mr->iova); | ||
| 333 | mpt_entry->length = cpu_to_be64(mr->size); | ||
| 334 | mpt_entry->entity_size = cpu_to_be32(mr->mtt.page_shift); | ||
| 335 | mpt_entry->mtt_seg = cpu_to_be64(mlx4_mtt_addr(dev, &mr->mtt)); | ||
| 336 | |||
| 337 | err = mlx4_SW2HW_MPT(dev, mailbox, | ||
| 338 | key_to_hw_index(mr->key) & (dev->caps.num_mpts - 1)); | ||
| 339 | if (err) { | ||
| 340 | mlx4_warn(dev, "SW2HW_MPT failed (%d)\n", err); | ||
| 341 | goto err_cmd; | ||
| 342 | } | ||
| 343 | |||
| 344 | mr->enabled = 1; | ||
| 345 | |||
| 346 | mlx4_free_cmd_mailbox(dev, mailbox); | ||
| 347 | |||
| 348 | return 0; | ||
| 349 | |||
| 350 | err_cmd: | ||
| 351 | mlx4_free_cmd_mailbox(dev, mailbox); | ||
| 352 | |||
| 353 | err_table: | ||
| 354 | mlx4_table_put(dev, &mr_table->dmpt_table, key_to_hw_index(mr->key)); | ||
| 355 | return err; | ||
| 356 | } | ||
| 357 | EXPORT_SYMBOL_GPL(mlx4_mr_enable); | ||
| 358 | |||
| 359 | static int mlx4_WRITE_MTT(struct mlx4_dev *dev, struct mlx4_cmd_mailbox *mailbox, | ||
| 360 | int num_mtt) | ||
| 361 | { | ||
| 362 | return mlx4_cmd(dev, mailbox->dma, num_mtt, 0, MLX4_CMD_WRITE_MTT, | ||
| 363 | MLX4_CMD_TIME_CLASS_B); | ||
| 364 | } | ||
| 365 | |||
| 366 | int mlx4_write_mtt(struct mlx4_dev *dev, struct mlx4_mtt *mtt, | ||
| 367 | int start_index, int npages, u64 *page_list) | ||
| 368 | { | ||
| 369 | struct mlx4_cmd_mailbox *mailbox; | ||
| 370 | __be64 *mtt_entry; | ||
| 371 | int i; | ||
| 372 | int err = 0; | ||
| 373 | |||
| 374 | if (mtt->order < 0) | ||
| 375 | return -EINVAL; | ||
| 376 | |||
| 377 | mailbox = mlx4_alloc_cmd_mailbox(dev); | ||
| 378 | if (IS_ERR(mailbox)) | ||
| 379 | return PTR_ERR(mailbox); | ||
| 380 | |||
| 381 | mtt_entry = mailbox->buf; | ||
| 382 | |||
| 383 | while (npages > 0) { | ||
| 384 | mtt_entry[0] = cpu_to_be64(mlx4_mtt_addr(dev, mtt) + start_index * 8); | ||
| 385 | mtt_entry[1] = 0; | ||
| 386 | |||
| 387 | for (i = 0; i < npages && i < MLX4_MAILBOX_SIZE / 8 - 2; ++i) | ||
| 388 | mtt_entry[i + 2] = cpu_to_be64(page_list[i] | | ||
| 389 | MLX4_MTT_FLAG_PRESENT); | ||
| 390 | |||
| 391 | /* | ||
| 392 | * If we have an odd number of entries to write, add | ||
| 393 | * one more dummy entry for firmware efficiency. | ||
| 394 | */ | ||
| 395 | if (i & 1) | ||
| 396 | mtt_entry[i + 2] = 0; | ||
| 397 | |||
| 398 | err = mlx4_WRITE_MTT(dev, mailbox, (i + 1) & ~1); | ||
| 399 | if (err) | ||
| 400 | goto out; | ||
| 401 | |||
| 402 | npages -= i; | ||
| 403 | start_index += i; | ||
| 404 | page_list += i; | ||
| 405 | } | ||
| 406 | |||
| 407 | out: | ||
| 408 | mlx4_free_cmd_mailbox(dev, mailbox); | ||
| 409 | |||
| 410 | return err; | ||
| 411 | } | ||
| 412 | EXPORT_SYMBOL_GPL(mlx4_write_mtt); | ||
| 413 | |||
| 414 | int mlx4_buf_write_mtt(struct mlx4_dev *dev, struct mlx4_mtt *mtt, | ||
| 415 | struct mlx4_buf *buf) | ||
| 416 | { | ||
| 417 | u64 *page_list; | ||
| 418 | int err; | ||
| 419 | int i; | ||
| 420 | |||
| 421 | page_list = kmalloc(buf->npages * sizeof *page_list, GFP_KERNEL); | ||
| 422 | if (!page_list) | ||
| 423 | return -ENOMEM; | ||
| 424 | |||
| 425 | for (i = 0; i < buf->npages; ++i) | ||
| 426 | if (buf->nbufs == 1) | ||
| 427 | page_list[i] = buf->u.direct.map + (i << buf->page_shift); | ||
| 428 | else | ||
| 429 | page_list[i] = buf->u.page_list[i].map; | ||
| 430 | |||
| 431 | err = mlx4_write_mtt(dev, mtt, 0, buf->npages, page_list); | ||
| 432 | |||
| 433 | kfree(page_list); | ||
| 434 | return err; | ||
| 435 | } | ||
| 436 | EXPORT_SYMBOL_GPL(mlx4_buf_write_mtt); | ||
| 437 | |||
| 438 | int __devinit mlx4_init_mr_table(struct mlx4_dev *dev) | ||
| 439 | { | ||
| 440 | struct mlx4_mr_table *mr_table = &mlx4_priv(dev)->mr_table; | ||
| 441 | int err; | ||
| 442 | |||
| 443 | err = mlx4_bitmap_init(&mr_table->mpt_bitmap, dev->caps.num_mpts, | ||
| 444 | ~0, dev->caps.reserved_mrws); | ||
| 445 | if (err) | ||
| 446 | return err; | ||
| 447 | |||
| 448 | err = mlx4_buddy_init(&mr_table->mtt_buddy, | ||
| 449 | ilog2(dev->caps.num_mtt_segs)); | ||
| 450 | if (err) | ||
| 451 | goto err_buddy; | ||
| 452 | |||
| 453 | if (dev->caps.reserved_mtts) { | ||
| 454 | if (mlx4_alloc_mtt_range(dev, ilog2(dev->caps.reserved_mtts)) == -1) { | ||
| 455 | mlx4_warn(dev, "MTT table of order %d is too small.\n", | ||
| 456 | mr_table->mtt_buddy.max_order); | ||
| 457 | err = -ENOMEM; | ||
| 458 | goto err_reserve_mtts; | ||
| 459 | } | ||
| 460 | } | ||
| 461 | |||
| 462 | return 0; | ||
| 463 | |||
| 464 | err_reserve_mtts: | ||
| 465 | mlx4_buddy_cleanup(&mr_table->mtt_buddy); | ||
| 466 | |||
| 467 | err_buddy: | ||
| 468 | mlx4_bitmap_cleanup(&mr_table->mpt_bitmap); | ||
| 469 | |||
| 470 | return err; | ||
| 471 | } | ||
| 472 | |||
| 473 | void mlx4_cleanup_mr_table(struct mlx4_dev *dev) | ||
| 474 | { | ||
| 475 | struct mlx4_mr_table *mr_table = &mlx4_priv(dev)->mr_table; | ||
| 476 | |||
| 477 | mlx4_buddy_cleanup(&mr_table->mtt_buddy); | ||
| 478 | mlx4_bitmap_cleanup(&mr_table->mpt_bitmap); | ||
| 479 | } | ||
diff --git a/drivers/net/mlx4/pd.c b/drivers/net/mlx4/pd.c new file mode 100644 index 000000000000..23dea1ee7750 --- /dev/null +++ b/drivers/net/mlx4/pd.c | |||
| @@ -0,0 +1,102 @@ | |||
| 1 | /* | ||
| 2 | * Copyright (c) 2006, 2007 Cisco Systems, Inc. All rights reserved. | ||
| 3 | * Copyright (c) 2005 Mellanox Technologies. 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 | |||
| 34 | #include <linux/init.h> | ||
| 35 | #include <linux/errno.h> | ||
| 36 | |||
| 37 | #include <asm/page.h> | ||
| 38 | |||
| 39 | #include "mlx4.h" | ||
| 40 | #include "icm.h" | ||
| 41 | |||
| 42 | int mlx4_pd_alloc(struct mlx4_dev *dev, u32 *pdn) | ||
| 43 | { | ||
| 44 | struct mlx4_priv *priv = mlx4_priv(dev); | ||
| 45 | |||
| 46 | *pdn = mlx4_bitmap_alloc(&priv->pd_bitmap); | ||
| 47 | if (*pdn == -1) | ||
| 48 | return -ENOMEM; | ||
| 49 | |||
| 50 | return 0; | ||
| 51 | } | ||
| 52 | EXPORT_SYMBOL_GPL(mlx4_pd_alloc); | ||
| 53 | |||
| 54 | void mlx4_pd_free(struct mlx4_dev *dev, u32 pdn) | ||
| 55 | { | ||
| 56 | mlx4_bitmap_free(&mlx4_priv(dev)->pd_bitmap, pdn); | ||
| 57 | } | ||
| 58 | EXPORT_SYMBOL_GPL(mlx4_pd_free); | ||
| 59 | |||
| 60 | int __devinit mlx4_init_pd_table(struct mlx4_dev *dev) | ||
| 61 | { | ||
| 62 | struct mlx4_priv *priv = mlx4_priv(dev); | ||
| 63 | |||
| 64 | return mlx4_bitmap_init(&priv->pd_bitmap, dev->caps.num_pds, | ||
| 65 | (1 << 24) - 1, dev->caps.reserved_pds); | ||
| 66 | } | ||
| 67 | |||
| 68 | void mlx4_cleanup_pd_table(struct mlx4_dev *dev) | ||
| 69 | { | ||
| 70 | mlx4_bitmap_cleanup(&mlx4_priv(dev)->pd_bitmap); | ||
| 71 | } | ||
| 72 | |||
| 73 | |||
| 74 | int mlx4_uar_alloc(struct mlx4_dev *dev, struct mlx4_uar *uar) | ||
| 75 | { | ||
| 76 | uar->index = mlx4_bitmap_alloc(&mlx4_priv(dev)->uar_table.bitmap); | ||
| 77 | if (uar->index == -1) | ||
| 78 | return -ENOMEM; | ||
| 79 | |||
| 80 | uar->pfn = (pci_resource_start(dev->pdev, 2) >> PAGE_SHIFT) + uar->index; | ||
| 81 | |||
| 82 | return 0; | ||
| 83 | } | ||
| 84 | EXPORT_SYMBOL_GPL(mlx4_uar_alloc); | ||
| 85 | |||
| 86 | void mlx4_uar_free(struct mlx4_dev *dev, struct mlx4_uar *uar) | ||
| 87 | { | ||
| 88 | mlx4_bitmap_free(&mlx4_priv(dev)->uar_table.bitmap, uar->index); | ||
| 89 | } | ||
| 90 | EXPORT_SYMBOL_GPL(mlx4_uar_free); | ||
| 91 | |||
| 92 | int mlx4_init_uar_table(struct mlx4_dev *dev) | ||
| 93 | { | ||
| 94 | return mlx4_bitmap_init(&mlx4_priv(dev)->uar_table.bitmap, | ||
| 95 | dev->caps.num_uars, dev->caps.num_uars - 1, | ||
| 96 | max(128, dev->caps.reserved_uars)); | ||
| 97 | } | ||
| 98 | |||
| 99 | void mlx4_cleanup_uar_table(struct mlx4_dev *dev) | ||
| 100 | { | ||
| 101 | mlx4_bitmap_cleanup(&mlx4_priv(dev)->uar_table.bitmap); | ||
| 102 | } | ||
diff --git a/drivers/net/mlx4/profile.c b/drivers/net/mlx4/profile.c new file mode 100644 index 000000000000..9ca42b213d54 --- /dev/null +++ b/drivers/net/mlx4/profile.c | |||
| @@ -0,0 +1,238 @@ | |||
| 1 | /* | ||
| 2 | * Copyright (c) 2004, 2005 Topspin Communications. All rights reserved. | ||
| 3 | * Copyright (c) 2005 Mellanox Technologies. All rights reserved. | ||
| 4 | * Copyright (c) 2006, 2007 Cisco Systems, Inc. All rights reserved. | ||
| 5 | * | ||
| 6 | * This software is available to you under a choice of one of two | ||
| 7 | * licenses. You may choose to be licensed under the terms of the GNU | ||
| 8 | * General Public License (GPL) Version 2, available from the file | ||
| 9 | * COPYING in the main directory of this source tree, or the | ||
| 10 | * OpenIB.org BSD license below: | ||
| 11 | * | ||
| 12 | * Redistribution and use in source and binary forms, with or | ||
| 13 | * without modification, are permitted provided that the following | ||
| 14 | * conditions are met: | ||
| 15 | * | ||
| 16 | * - Redistributions of source code must retain the above | ||
| 17 | * copyright notice, this list of conditions and the following | ||
| 18 | * disclaimer. | ||
| 19 | * | ||
| 20 | * - Redistributions in binary form must reproduce the above | ||
| 21 | * copyright notice, this list of conditions and the following | ||
| 22 | * disclaimer in the documentation and/or other materials | ||
| 23 | * provided with the distribution. | ||
| 24 | * | ||
| 25 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, | ||
| 26 | * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF | ||
| 27 | * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND | ||
| 28 | * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS | ||
| 29 | * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN | ||
| 30 | * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN | ||
| 31 | * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE | ||
| 32 | * SOFTWARE. | ||
| 33 | */ | ||
| 34 | |||
| 35 | #include <linux/init.h> | ||
| 36 | |||
| 37 | #include "mlx4.h" | ||
| 38 | #include "fw.h" | ||
| 39 | |||
| 40 | enum { | ||
| 41 | MLX4_RES_QP, | ||
| 42 | MLX4_RES_RDMARC, | ||
| 43 | MLX4_RES_ALTC, | ||
| 44 | MLX4_RES_AUXC, | ||
| 45 | MLX4_RES_SRQ, | ||
| 46 | MLX4_RES_CQ, | ||
| 47 | MLX4_RES_EQ, | ||
| 48 | MLX4_RES_DMPT, | ||
| 49 | MLX4_RES_CMPT, | ||
| 50 | MLX4_RES_MTT, | ||
| 51 | MLX4_RES_MCG, | ||
| 52 | MLX4_RES_NUM | ||
| 53 | }; | ||
| 54 | |||
| 55 | static const char *res_name[] = { | ||
| 56 | [MLX4_RES_QP] = "QP", | ||
| 57 | [MLX4_RES_RDMARC] = "RDMARC", | ||
| 58 | [MLX4_RES_ALTC] = "ALTC", | ||
| 59 | [MLX4_RES_AUXC] = "AUXC", | ||
| 60 | [MLX4_RES_SRQ] = "SRQ", | ||
| 61 | [MLX4_RES_CQ] = "CQ", | ||
| 62 | [MLX4_RES_EQ] = "EQ", | ||
| 63 | [MLX4_RES_DMPT] = "DMPT", | ||
| 64 | [MLX4_RES_CMPT] = "CMPT", | ||
| 65 | [MLX4_RES_MTT] = "MTT", | ||
| 66 | [MLX4_RES_MCG] = "MCG", | ||
| 67 | }; | ||
| 68 | |||
| 69 | u64 mlx4_make_profile(struct mlx4_dev *dev, | ||
| 70 | struct mlx4_profile *request, | ||
| 71 | struct mlx4_dev_cap *dev_cap, | ||
| 72 | struct mlx4_init_hca_param *init_hca) | ||
| 73 | { | ||
| 74 | struct mlx4_priv *priv = mlx4_priv(dev); | ||
| 75 | struct mlx4_resource { | ||
| 76 | u64 size; | ||
| 77 | u64 start; | ||
| 78 | int type; | ||
| 79 | int num; | ||
| 80 | int log_num; | ||
| 81 | }; | ||
| 82 | |||
| 83 | u64 total_size = 0; | ||
| 84 | struct mlx4_resource *profile; | ||
| 85 | struct mlx4_resource tmp; | ||
| 86 | int i, j; | ||
| 87 | |||
| 88 | profile = kzalloc(MLX4_RES_NUM * sizeof *profile, GFP_KERNEL); | ||
| 89 | if (!profile) | ||
| 90 | return -ENOMEM; | ||
| 91 | |||
| 92 | profile[MLX4_RES_QP].size = dev_cap->qpc_entry_sz; | ||
| 93 | profile[MLX4_RES_RDMARC].size = dev_cap->rdmarc_entry_sz; | ||
| 94 | profile[MLX4_RES_ALTC].size = dev_cap->altc_entry_sz; | ||
| 95 | profile[MLX4_RES_AUXC].size = dev_cap->aux_entry_sz; | ||
| 96 | profile[MLX4_RES_SRQ].size = dev_cap->srq_entry_sz; | ||
| 97 | profile[MLX4_RES_CQ].size = dev_cap->cqc_entry_sz; | ||
| 98 | profile[MLX4_RES_EQ].size = dev_cap->eqc_entry_sz; | ||
| 99 | profile[MLX4_RES_DMPT].size = dev_cap->dmpt_entry_sz; | ||
| 100 | profile[MLX4_RES_CMPT].size = dev_cap->cmpt_entry_sz; | ||
| 101 | profile[MLX4_RES_MTT].size = MLX4_MTT_ENTRY_PER_SEG * dev_cap->mtt_entry_sz; | ||
| 102 | profile[MLX4_RES_MCG].size = MLX4_MGM_ENTRY_SIZE; | ||
| 103 | |||
| 104 | profile[MLX4_RES_QP].num = request->num_qp; | ||
| 105 | profile[MLX4_RES_RDMARC].num = request->num_qp * request->rdmarc_per_qp; | ||
| 106 | profile[MLX4_RES_ALTC].num = request->num_qp; | ||
| 107 | profile[MLX4_RES_AUXC].num = request->num_qp; | ||
| 108 | profile[MLX4_RES_SRQ].num = request->num_srq; | ||
| 109 | profile[MLX4_RES_CQ].num = request->num_cq; | ||
| 110 | profile[MLX4_RES_EQ].num = MLX4_NUM_EQ + dev_cap->reserved_eqs; | ||
| 111 | profile[MLX4_RES_DMPT].num = request->num_mpt; | ||
| 112 | profile[MLX4_RES_CMPT].num = MLX4_NUM_CMPTS; | ||
| 113 | profile[MLX4_RES_MTT].num = request->num_mtt; | ||
| 114 | profile[MLX4_RES_MCG].num = request->num_mcg; | ||
| 115 | |||
| 116 | for (i = 0; i < MLX4_RES_NUM; ++i) { | ||
| 117 | profile[i].type = i; | ||
| 118 | profile[i].num = roundup_pow_of_two(profile[i].num); | ||
| 119 | profile[i].log_num = ilog2(profile[i].num); | ||
| 120 | profile[i].size *= profile[i].num; | ||
| 121 | profile[i].size = max(profile[i].size, (u64) PAGE_SIZE); | ||
| 122 | } | ||
| 123 | |||
| 124 | /* | ||
| 125 | * Sort the resources in decreasing order of size. Since they | ||
| 126 | * all have sizes that are powers of 2, we'll be able to keep | ||
| 127 | * resources aligned to their size and pack them without gaps | ||
| 128 | * using the sorted order. | ||
| 129 | */ | ||
| 130 | for (i = MLX4_RES_NUM; i > 0; --i) | ||
| 131 | for (j = 1; j < i; ++j) { | ||
| 132 | if (profile[j].size > profile[j - 1].size) { | ||
| 133 | tmp = profile[j]; | ||
| 134 | profile[j] = profile[j - 1]; | ||
| 135 | profile[j - 1] = tmp; | ||
| 136 | } | ||
| 137 | } | ||
| 138 | |||
| 139 | for (i = 0; i < MLX4_RES_NUM; ++i) { | ||
| 140 | if (profile[i].size) { | ||
| 141 | profile[i].start = total_size; | ||
| 142 | total_size += profile[i].size; | ||
| 143 | } | ||
| 144 | |||
| 145 | if (total_size > dev_cap->max_icm_sz) { | ||
| 146 | mlx4_err(dev, "Profile requires 0x%llx bytes; " | ||
| 147 | "won't fit in 0x%llx bytes of context memory.\n", | ||
| 148 | (unsigned long long) total_size, | ||
| 149 | (unsigned long long) dev_cap->max_icm_sz); | ||
| 150 | kfree(profile); | ||
| 151 | return -ENOMEM; | ||
| 152 | } | ||
| 153 | |||
| 154 | if (profile[i].size) | ||
| 155 | mlx4_dbg(dev, " profile[%2d] (%6s): 2^%02d entries @ 0x%10llx, " | ||
| 156 | "size 0x%10llx\n", | ||
| 157 | i, res_name[profile[i].type], profile[i].log_num, | ||
| 158 | (unsigned long long) profile[i].start, | ||
| 159 | (unsigned long long) profile[i].size); | ||
| 160 | } | ||
| 161 | |||
| 162 | mlx4_dbg(dev, "HCA context memory: reserving %d KB\n", | ||
| 163 | (int) (total_size >> 10)); | ||
| 164 | |||
| 165 | for (i = 0; i < MLX4_RES_NUM; ++i) { | ||
| 166 | switch (profile[i].type) { | ||
| 167 | case MLX4_RES_QP: | ||
| 168 | dev->caps.num_qps = profile[i].num; | ||
| 169 | init_hca->qpc_base = profile[i].start; | ||
| 170 | init_hca->log_num_qps = profile[i].log_num; | ||
| 171 | break; | ||
| 172 | case MLX4_RES_RDMARC: | ||
| 173 | for (priv->qp_table.rdmarc_shift = 0; | ||
| 174 | request->num_qp << priv->qp_table.rdmarc_shift < profile[i].num; | ||
| 175 | ++priv->qp_table.rdmarc_shift) | ||
| 176 | ; /* nothing */ | ||
| 177 | dev->caps.max_qp_dest_rdma = 1 << priv->qp_table.rdmarc_shift; | ||
| 178 | priv->qp_table.rdmarc_base = (u32) profile[i].start; | ||
| 179 | init_hca->rdmarc_base = profile[i].start; | ||
| 180 | init_hca->log_rd_per_qp = priv->qp_table.rdmarc_shift; | ||
| 181 | break; | ||
| 182 | case MLX4_RES_ALTC: | ||
| 183 | init_hca->altc_base = profile[i].start; | ||
| 184 | break; | ||
| 185 | case MLX4_RES_AUXC: | ||
| 186 | init_hca->auxc_base = profile[i].start; | ||
| 187 | break; | ||
| 188 | case MLX4_RES_SRQ: | ||
| 189 | dev->caps.num_srqs = profile[i].num; | ||
| 190 | init_hca->srqc_base = profile[i].start; | ||
| 191 | init_hca->log_num_srqs = profile[i].log_num; | ||
| 192 | break; | ||
| 193 | case MLX4_RES_CQ: | ||
| 194 | dev->caps.num_cqs = profile[i].num; | ||
| 195 | init_hca->cqc_base = profile[i].start; | ||
| 196 | init_hca->log_num_cqs = profile[i].log_num; | ||
| 197 | break; | ||
| 198 | case MLX4_RES_EQ: | ||
| 199 | dev->caps.num_eqs = profile[i].num; | ||
| 200 | init_hca->eqc_base = profile[i].start; | ||
| 201 | init_hca->log_num_eqs = profile[i].log_num; | ||
| 202 | break; | ||
| 203 | case MLX4_RES_DMPT: | ||
| 204 | dev->caps.num_mpts = profile[i].num; | ||
| 205 | priv->mr_table.mpt_base = profile[i].start; | ||
| 206 | init_hca->dmpt_base = profile[i].start; | ||
| 207 | init_hca->log_mpt_sz = profile[i].log_num; | ||
| 208 | break; | ||
| 209 | case MLX4_RES_CMPT: | ||
| 210 | init_hca->cmpt_base = profile[i].start; | ||
| 211 | break; | ||
| 212 | case MLX4_RES_MTT: | ||
| 213 | dev->caps.num_mtt_segs = profile[i].num; | ||
| 214 | priv->mr_table.mtt_base = profile[i].start; | ||
| 215 | init_hca->mtt_base = profile[i].start; | ||
| 216 | break; | ||
| 217 | case MLX4_RES_MCG: | ||
| 218 | dev->caps.num_mgms = profile[i].num >> 1; | ||
| 219 | dev->caps.num_amgms = profile[i].num >> 1; | ||
| 220 | init_hca->mc_base = profile[i].start; | ||
| 221 | init_hca->log_mc_entry_sz = ilog2(MLX4_MGM_ENTRY_SIZE); | ||
| 222 | init_hca->log_mc_table_sz = profile[i].log_num; | ||
| 223 | init_hca->log_mc_hash_sz = profile[i].log_num - 1; | ||
| 224 | break; | ||
| 225 | default: | ||
| 226 | break; | ||
| 227 | } | ||
| 228 | } | ||
| 229 | |||
| 230 | /* | ||
| 231 | * PDs don't take any HCA memory, but we assign them as part | ||
| 232 | * of the HCA profile anyway. | ||
| 233 | */ | ||
| 234 | dev->caps.num_pds = MLX4_NUM_PDS; | ||
| 235 | |||
| 236 | kfree(profile); | ||
| 237 | return total_size; | ||
| 238 | } | ||
diff --git a/drivers/net/mlx4/qp.c b/drivers/net/mlx4/qp.c new file mode 100644 index 000000000000..7f8b7d55b6e1 --- /dev/null +++ b/drivers/net/mlx4/qp.c | |||
| @@ -0,0 +1,280 @@ | |||
| 1 | /* | ||
| 2 | * Copyright (c) 2004 Topspin Communications. All rights reserved. | ||
| 3 | * Copyright (c) 2005, 2006, 2007 Cisco Systems, Inc. All rights reserved. | ||
| 4 | * Copyright (c) 2005 Mellanox Technologies. All rights reserved. | ||
| 5 | * Copyright (c) 2004 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/init.h> | ||
| 37 | |||
| 38 | #include <linux/mlx4/cmd.h> | ||
| 39 | #include <linux/mlx4/qp.h> | ||
| 40 | |||
| 41 | #include "mlx4.h" | ||
| 42 | #include "icm.h" | ||
| 43 | |||
| 44 | void mlx4_qp_event(struct mlx4_dev *dev, u32 qpn, int event_type) | ||
| 45 | { | ||
| 46 | struct mlx4_qp_table *qp_table = &mlx4_priv(dev)->qp_table; | ||
| 47 | struct mlx4_qp *qp; | ||
| 48 | |||
| 49 | spin_lock(&qp_table->lock); | ||
| 50 | |||
| 51 | qp = __mlx4_qp_lookup(dev, qpn); | ||
| 52 | if (qp) | ||
| 53 | atomic_inc(&qp->refcount); | ||
| 54 | |||
| 55 | spin_unlock(&qp_table->lock); | ||
| 56 | |||
| 57 | if (!qp) { | ||
| 58 | mlx4_warn(dev, "Async event for bogus QP %08x\n", qpn); | ||
| 59 | return; | ||
| 60 | } | ||
| 61 | |||
| 62 | qp->event(qp, event_type); | ||
| 63 | |||
| 64 | if (atomic_dec_and_test(&qp->refcount)) | ||
| 65 | complete(&qp->free); | ||
| 66 | } | ||
| 67 | |||
| 68 | int mlx4_qp_modify(struct mlx4_dev *dev, struct mlx4_mtt *mtt, | ||
| 69 | enum mlx4_qp_state cur_state, enum mlx4_qp_state new_state, | ||
| 70 | struct mlx4_qp_context *context, enum mlx4_qp_optpar optpar, | ||
| 71 | int sqd_event, struct mlx4_qp *qp) | ||
| 72 | { | ||
| 73 | static const u16 op[MLX4_QP_NUM_STATE][MLX4_QP_NUM_STATE] = { | ||
| 74 | [MLX4_QP_STATE_RST] = { | ||
| 75 | [MLX4_QP_STATE_RST] = MLX4_CMD_2RST_QP, | ||
| 76 | [MLX4_QP_STATE_ERR] = MLX4_CMD_2ERR_QP, | ||
| 77 | [MLX4_QP_STATE_INIT] = MLX4_CMD_RST2INIT_QP, | ||
| 78 | }, | ||
| 79 | [MLX4_QP_STATE_INIT] = { | ||
| 80 | [MLX4_QP_STATE_RST] = MLX4_CMD_2RST_QP, | ||
| 81 | [MLX4_QP_STATE_ERR] = MLX4_CMD_2ERR_QP, | ||
| 82 | [MLX4_QP_STATE_INIT] = MLX4_CMD_INIT2INIT_QP, | ||
| 83 | [MLX4_QP_STATE_RTR] = MLX4_CMD_INIT2RTR_QP, | ||
| 84 | }, | ||
| 85 | [MLX4_QP_STATE_RTR] = { | ||
| 86 | [MLX4_QP_STATE_RST] = MLX4_CMD_2RST_QP, | ||
| 87 | [MLX4_QP_STATE_ERR] = MLX4_CMD_2ERR_QP, | ||
| 88 | [MLX4_QP_STATE_RTS] = MLX4_CMD_RTR2RTS_QP, | ||
| 89 | }, | ||
| 90 | [MLX4_QP_STATE_RTS] = { | ||
| 91 | [MLX4_QP_STATE_RST] = MLX4_CMD_2RST_QP, | ||
| 92 | [MLX4_QP_STATE_ERR] = MLX4_CMD_2ERR_QP, | ||
| 93 | [MLX4_QP_STATE_RTS] = MLX4_CMD_RTS2RTS_QP, | ||
| 94 | [MLX4_QP_STATE_SQD] = MLX4_CMD_RTS2SQD_QP, | ||
| 95 | }, | ||
| 96 | [MLX4_QP_STATE_SQD] = { | ||
| 97 | [MLX4_QP_STATE_RST] = MLX4_CMD_2RST_QP, | ||
| 98 | [MLX4_QP_STATE_ERR] = MLX4_CMD_2ERR_QP, | ||
| 99 | [MLX4_QP_STATE_RTS] = MLX4_CMD_SQD2RTS_QP, | ||
| 100 | [MLX4_QP_STATE_SQD] = MLX4_CMD_SQD2SQD_QP, | ||
| 101 | }, | ||
| 102 | [MLX4_QP_STATE_SQER] = { | ||
| 103 | [MLX4_QP_STATE_RST] = MLX4_CMD_2RST_QP, | ||
| 104 | [MLX4_QP_STATE_ERR] = MLX4_CMD_2ERR_QP, | ||
| 105 | [MLX4_QP_STATE_RTS] = MLX4_CMD_SQERR2RTS_QP, | ||
| 106 | }, | ||
| 107 | [MLX4_QP_STATE_ERR] = { | ||
| 108 | [MLX4_QP_STATE_RST] = MLX4_CMD_2RST_QP, | ||
| 109 | [MLX4_QP_STATE_ERR] = MLX4_CMD_2ERR_QP, | ||
| 110 | } | ||
| 111 | }; | ||
| 112 | |||
| 113 | struct mlx4_cmd_mailbox *mailbox; | ||
| 114 | int ret = 0; | ||
| 115 | |||
| 116 | if (cur_state < 0 || cur_state >= MLX4_QP_NUM_STATE || | ||
| 117 | new_state < 0 || cur_state >= MLX4_QP_NUM_STATE || | ||
| 118 | !op[cur_state][new_state]) | ||
| 119 | return -EINVAL; | ||
| 120 | |||
| 121 | if (op[cur_state][new_state] == MLX4_CMD_2RST_QP) | ||
| 122 | return mlx4_cmd(dev, 0, qp->qpn, 2, | ||
| 123 | MLX4_CMD_2RST_QP, MLX4_CMD_TIME_CLASS_A); | ||
| 124 | |||
| 125 | mailbox = mlx4_alloc_cmd_mailbox(dev); | ||
| 126 | if (IS_ERR(mailbox)) | ||
| 127 | return PTR_ERR(mailbox); | ||
| 128 | |||
| 129 | if (cur_state == MLX4_QP_STATE_RST && new_state == MLX4_QP_STATE_INIT) { | ||
| 130 | u64 mtt_addr = mlx4_mtt_addr(dev, mtt); | ||
| 131 | context->mtt_base_addr_h = mtt_addr >> 32; | ||
| 132 | context->mtt_base_addr_l = cpu_to_be32(mtt_addr & 0xffffffff); | ||
| 133 | context->log_page_size = mtt->page_shift - MLX4_ICM_PAGE_SHIFT; | ||
| 134 | } | ||
| 135 | |||
| 136 | *(__be32 *) mailbox->buf = cpu_to_be32(optpar); | ||
| 137 | memcpy(mailbox->buf + 8, context, sizeof *context); | ||
| 138 | |||
| 139 | ((struct mlx4_qp_context *) (mailbox->buf + 8))->local_qpn = | ||
| 140 | cpu_to_be32(qp->qpn); | ||
| 141 | |||
| 142 | ret = mlx4_cmd(dev, mailbox->dma, qp->qpn | (!!sqd_event << 31), | ||
| 143 | new_state == MLX4_QP_STATE_RST ? 2 : 0, | ||
| 144 | op[cur_state][new_state], MLX4_CMD_TIME_CLASS_C); | ||
| 145 | |||
| 146 | mlx4_free_cmd_mailbox(dev, mailbox); | ||
| 147 | return ret; | ||
| 148 | } | ||
| 149 | EXPORT_SYMBOL_GPL(mlx4_qp_modify); | ||
| 150 | |||
| 151 | int mlx4_qp_alloc(struct mlx4_dev *dev, int sqpn, struct mlx4_qp *qp) | ||
| 152 | { | ||
| 153 | struct mlx4_priv *priv = mlx4_priv(dev); | ||
| 154 | struct mlx4_qp_table *qp_table = &priv->qp_table; | ||
| 155 | int err; | ||
| 156 | |||
| 157 | if (sqpn) | ||
| 158 | qp->qpn = sqpn; | ||
| 159 | else { | ||
| 160 | qp->qpn = mlx4_bitmap_alloc(&qp_table->bitmap); | ||
| 161 | if (qp->qpn == -1) | ||
| 162 | return -ENOMEM; | ||
| 163 | } | ||
| 164 | |||
| 165 | err = mlx4_table_get(dev, &qp_table->qp_table, qp->qpn); | ||
| 166 | if (err) | ||
| 167 | goto err_out; | ||
| 168 | |||
| 169 | err = mlx4_table_get(dev, &qp_table->auxc_table, qp->qpn); | ||
| 170 | if (err) | ||
| 171 | goto err_put_qp; | ||
| 172 | |||
| 173 | err = mlx4_table_get(dev, &qp_table->altc_table, qp->qpn); | ||
| 174 | if (err) | ||
| 175 | goto err_put_auxc; | ||
| 176 | |||
| 177 | err = mlx4_table_get(dev, &qp_table->rdmarc_table, qp->qpn); | ||
| 178 | if (err) | ||
| 179 | goto err_put_altc; | ||
| 180 | |||
| 181 | err = mlx4_table_get(dev, &qp_table->cmpt_table, qp->qpn); | ||
| 182 | if (err) | ||
| 183 | goto err_put_rdmarc; | ||
| 184 | |||
| 185 | spin_lock_irq(&qp_table->lock); | ||
| 186 | err = radix_tree_insert(&dev->qp_table_tree, qp->qpn & (dev->caps.num_qps - 1), qp); | ||
| 187 | spin_unlock_irq(&qp_table->lock); | ||
| 188 | if (err) | ||
| 189 | goto err_put_cmpt; | ||
| 190 | |||
| 191 | atomic_set(&qp->refcount, 1); | ||
| 192 | init_completion(&qp->free); | ||
| 193 | |||
| 194 | return 0; | ||
| 195 | |||
| 196 | err_put_cmpt: | ||
| 197 | mlx4_table_put(dev, &qp_table->cmpt_table, qp->qpn); | ||
| 198 | |||
| 199 | err_put_rdmarc: | ||
| 200 | mlx4_table_put(dev, &qp_table->rdmarc_table, qp->qpn); | ||
| 201 | |||
| 202 | err_put_altc: | ||
| 203 | mlx4_table_put(dev, &qp_table->altc_table, qp->qpn); | ||
| 204 | |||
| 205 | err_put_auxc: | ||
| 206 | mlx4_table_put(dev, &qp_table->auxc_table, qp->qpn); | ||
| 207 | |||
| 208 | err_put_qp: | ||
| 209 | mlx4_table_put(dev, &qp_table->qp_table, qp->qpn); | ||
| 210 | |||
| 211 | err_out: | ||
| 212 | if (!sqpn) | ||
| 213 | mlx4_bitmap_free(&qp_table->bitmap, qp->qpn); | ||
| 214 | |||
| 215 | return err; | ||
| 216 | } | ||
| 217 | EXPORT_SYMBOL_GPL(mlx4_qp_alloc); | ||
| 218 | |||
| 219 | void mlx4_qp_remove(struct mlx4_dev *dev, struct mlx4_qp *qp) | ||
| 220 | { | ||
| 221 | struct mlx4_qp_table *qp_table = &mlx4_priv(dev)->qp_table; | ||
| 222 | unsigned long flags; | ||
| 223 | |||
| 224 | spin_lock_irqsave(&qp_table->lock, flags); | ||
| 225 | radix_tree_delete(&dev->qp_table_tree, qp->qpn & (dev->caps.num_qps - 1)); | ||
| 226 | spin_unlock_irqrestore(&qp_table->lock, flags); | ||
| 227 | } | ||
| 228 | EXPORT_SYMBOL_GPL(mlx4_qp_remove); | ||
| 229 | |||
| 230 | void mlx4_qp_free(struct mlx4_dev *dev, struct mlx4_qp *qp) | ||
| 231 | { | ||
| 232 | struct mlx4_qp_table *qp_table = &mlx4_priv(dev)->qp_table; | ||
| 233 | |||
| 234 | if (atomic_dec_and_test(&qp->refcount)) | ||
| 235 | complete(&qp->free); | ||
| 236 | wait_for_completion(&qp->free); | ||
| 237 | |||
| 238 | mlx4_table_put(dev, &qp_table->cmpt_table, qp->qpn); | ||
| 239 | mlx4_table_put(dev, &qp_table->rdmarc_table, qp->qpn); | ||
| 240 | mlx4_table_put(dev, &qp_table->altc_table, qp->qpn); | ||
| 241 | mlx4_table_put(dev, &qp_table->auxc_table, qp->qpn); | ||
| 242 | mlx4_table_put(dev, &qp_table->qp_table, qp->qpn); | ||
| 243 | |||
| 244 | mlx4_bitmap_free(&qp_table->bitmap, qp->qpn); | ||
| 245 | } | ||
| 246 | EXPORT_SYMBOL_GPL(mlx4_qp_free); | ||
| 247 | |||
| 248 | static int mlx4_CONF_SPECIAL_QP(struct mlx4_dev *dev, u32 base_qpn) | ||
| 249 | { | ||
| 250 | return mlx4_cmd(dev, 0, base_qpn, 0, MLX4_CMD_CONF_SPECIAL_QP, | ||
| 251 | MLX4_CMD_TIME_CLASS_B); | ||
| 252 | } | ||
| 253 | |||
| 254 | int __devinit mlx4_init_qp_table(struct mlx4_dev *dev) | ||
| 255 | { | ||
| 256 | struct mlx4_qp_table *qp_table = &mlx4_priv(dev)->qp_table; | ||
| 257 | int err; | ||
| 258 | |||
| 259 | spin_lock_init(&qp_table->lock); | ||
| 260 | INIT_RADIX_TREE(&dev->qp_table_tree, GFP_ATOMIC); | ||
| 261 | |||
| 262 | /* | ||
| 263 | * We reserve 2 extra QPs per port for the special QPs. The | ||
| 264 | * block of special QPs must be aligned to a multiple of 8, so | ||
| 265 | * round up. | ||
| 266 | */ | ||
| 267 | dev->caps.sqp_start = ALIGN(dev->caps.reserved_qps, 8); | ||
| 268 | err = mlx4_bitmap_init(&qp_table->bitmap, dev->caps.num_qps, | ||
| 269 | (1 << 24) - 1, dev->caps.sqp_start + 8); | ||
| 270 | if (err) | ||
| 271 | return err; | ||
| 272 | |||
| 273 | return mlx4_CONF_SPECIAL_QP(dev, dev->caps.sqp_start); | ||
| 274 | } | ||
| 275 | |||
| 276 | void mlx4_cleanup_qp_table(struct mlx4_dev *dev) | ||
| 277 | { | ||
| 278 | mlx4_CONF_SPECIAL_QP(dev, 0); | ||
| 279 | mlx4_bitmap_cleanup(&mlx4_priv(dev)->qp_table.bitmap); | ||
| 280 | } | ||
diff --git a/drivers/net/mlx4/reset.c b/drivers/net/mlx4/reset.c new file mode 100644 index 000000000000..51eef8492e93 --- /dev/null +++ b/drivers/net/mlx4/reset.c | |||
| @@ -0,0 +1,181 @@ | |||
| 1 | /* | ||
| 2 | * Copyright (c) 2006, 2007 Cisco Systems, Inc. All rights reserved. | ||
| 3 | * | ||
| 4 | * This software is available to you under a choice of one of two | ||
| 5 | * licenses. You may choose to be licensed under the terms of the GNU | ||
| 6 | * General Public License (GPL) Version 2, available from the file | ||
| 7 | * COPYING in the main directory of this source tree, or the | ||
| 8 | * OpenIB.org BSD license below: | ||
| 9 | * | ||
| 10 | * Redistribution and use in source and binary forms, with or | ||
| 11 | * without modification, are permitted provided that the following | ||
| 12 | * conditions are met: | ||
| 13 | * | ||
| 14 | * - Redistributions of source code must retain the above | ||
| 15 | * copyright notice, this list of conditions and the following | ||
| 16 | * disclaimer. | ||
| 17 | * | ||
| 18 | * - Redistributions in binary form must reproduce the above | ||
| 19 | * copyright notice, this list of conditions and the following | ||
| 20 | * disclaimer in the documentation and/or other materials | ||
| 21 | * provided with the distribution. | ||
| 22 | * | ||
| 23 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, | ||
| 24 | * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF | ||
| 25 | * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND | ||
| 26 | * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS | ||
| 27 | * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN | ||
| 28 | * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN | ||
| 29 | * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE | ||
| 30 | * SOFTWARE. | ||
| 31 | */ | ||
| 32 | |||
| 33 | #include <linux/init.h> | ||
| 34 | #include <linux/errno.h> | ||
| 35 | #include <linux/pci.h> | ||
| 36 | #include <linux/delay.h> | ||
| 37 | #include <linux/slab.h> | ||
| 38 | |||
| 39 | #include "mlx4.h" | ||
| 40 | |||
| 41 | int mlx4_reset(struct mlx4_dev *dev) | ||
| 42 | { | ||
| 43 | void __iomem *reset; | ||
| 44 | u32 *hca_header = NULL; | ||
| 45 | int pcie_cap; | ||
| 46 | u16 devctl; | ||
| 47 | u16 linkctl; | ||
| 48 | u16 vendor; | ||
| 49 | unsigned long end; | ||
| 50 | u32 sem; | ||
| 51 | int i; | ||
| 52 | int err = 0; | ||
| 53 | |||
| 54 | #define MLX4_RESET_BASE 0xf0000 | ||
| 55 | #define MLX4_RESET_SIZE 0x400 | ||
| 56 | #define MLX4_SEM_OFFSET 0x3fc | ||
| 57 | #define MLX4_RESET_OFFSET 0x10 | ||
| 58 | #define MLX4_RESET_VALUE swab32(1) | ||
| 59 | |||
| 60 | #define MLX4_SEM_TIMEOUT_JIFFIES (10 * HZ) | ||
| 61 | #define MLX4_RESET_TIMEOUT_JIFFIES (2 * HZ) | ||
| 62 | |||
| 63 | /* | ||
| 64 | * Reset the chip. This is somewhat ugly because we have to | ||
| 65 | * save off the PCI header before reset and then restore it | ||
| 66 | * after the chip reboots. We skip config space offsets 22 | ||
| 67 | * and 23 since those have a special meaning. | ||
| 68 | */ | ||
| 69 | |||
| 70 | /* Do we need to save off the full 4K PCI Express header?? */ | ||
| 71 | hca_header = kmalloc(256, GFP_KERNEL); | ||
| 72 | if (!hca_header) { | ||
| 73 | err = -ENOMEM; | ||
| 74 | mlx4_err(dev, "Couldn't allocate memory to save HCA " | ||
| 75 | "PCI header, aborting.\n"); | ||
| 76 | goto out; | ||
| 77 | } | ||
| 78 | |||
| 79 | pcie_cap = pci_find_capability(dev->pdev, PCI_CAP_ID_EXP); | ||
| 80 | |||
| 81 | for (i = 0; i < 64; ++i) { | ||
| 82 | if (i == 22 || i == 23) | ||
| 83 | continue; | ||
| 84 | if (pci_read_config_dword(dev->pdev, i * 4, hca_header + i)) { | ||
| 85 | err = -ENODEV; | ||
| 86 | mlx4_err(dev, "Couldn't save HCA " | ||
| 87 | "PCI header, aborting.\n"); | ||
| 88 | goto out; | ||
| 89 | } | ||
| 90 | } | ||
| 91 | |||
| 92 | reset = ioremap(pci_resource_start(dev->pdev, 0) + MLX4_RESET_BASE, | ||
| 93 | MLX4_RESET_SIZE); | ||
| 94 | if (!reset) { | ||
| 95 | err = -ENOMEM; | ||
| 96 | mlx4_err(dev, "Couldn't map HCA reset register, aborting.\n"); | ||
| 97 | goto out; | ||
| 98 | } | ||
| 99 | |||
| 100 | /* grab HW semaphore to lock out flash updates */ | ||
| 101 | end = jiffies + MLX4_SEM_TIMEOUT_JIFFIES; | ||
| 102 | do { | ||
| 103 | sem = readl(reset + MLX4_SEM_OFFSET); | ||
| 104 | if (!sem) | ||
| 105 | break; | ||
| 106 | |||
| 107 | msleep(1); | ||
| 108 | } while (time_before(jiffies, end)); | ||
| 109 | |||
| 110 | if (sem) { | ||
| 111 | mlx4_err(dev, "Failed to obtain HW semaphore, aborting\n"); | ||
| 112 | err = -EAGAIN; | ||
| 113 | iounmap(reset); | ||
| 114 | goto out; | ||
| 115 | } | ||
| 116 | |||
| 117 | /* actually hit reset */ | ||
| 118 | writel(MLX4_RESET_VALUE, reset + MLX4_RESET_OFFSET); | ||
| 119 | iounmap(reset); | ||
| 120 | |||
| 121 | end = jiffies + MLX4_RESET_TIMEOUT_JIFFIES; | ||
| 122 | do { | ||
| 123 | if (!pci_read_config_word(dev->pdev, PCI_VENDOR_ID, &vendor) && | ||
| 124 | vendor != 0xffff) | ||
| 125 | break; | ||
| 126 | |||
| 127 | msleep(1); | ||
| 128 | } while (time_before(jiffies, end)); | ||
| 129 | |||
| 130 | if (vendor == 0xffff) { | ||
| 131 | err = -ENODEV; | ||
| 132 | mlx4_err(dev, "PCI device did not come back after reset, " | ||
| 133 | "aborting.\n"); | ||
| 134 | goto out; | ||
| 135 | } | ||
| 136 | |||
| 137 | /* Now restore the PCI headers */ | ||
| 138 | if (pcie_cap) { | ||
| 139 | devctl = hca_header[(pcie_cap + PCI_EXP_DEVCTL) / 4]; | ||
| 140 | if (pci_write_config_word(dev->pdev, pcie_cap + PCI_EXP_DEVCTL, | ||
| 141 | devctl)) { | ||
| 142 | err = -ENODEV; | ||
| 143 | mlx4_err(dev, "Couldn't restore HCA PCI Express " | ||
| 144 | "Device Control register, aborting.\n"); | ||
| 145 | goto out; | ||
| 146 | } | ||
| 147 | linkctl = hca_header[(pcie_cap + PCI_EXP_LNKCTL) / 4]; | ||
| 148 | if (pci_write_config_word(dev->pdev, pcie_cap + PCI_EXP_LNKCTL, | ||
| 149 | linkctl)) { | ||
| 150 | err = -ENODEV; | ||
| 151 | mlx4_err(dev, "Couldn't restore HCA PCI Express " | ||
| 152 | "Link control register, aborting.\n"); | ||
| 153 | goto out; | ||
| 154 | } | ||
| 155 | } | ||
| 156 | |||
| 157 | for (i = 0; i < 16; ++i) { | ||
| 158 | if (i * 4 == PCI_COMMAND) | ||
| 159 | continue; | ||
| 160 | |||
| 161 | if (pci_write_config_dword(dev->pdev, i * 4, hca_header[i])) { | ||
| 162 | err = -ENODEV; | ||
| 163 | mlx4_err(dev, "Couldn't restore HCA reg %x, " | ||
| 164 | "aborting.\n", i); | ||
| 165 | goto out; | ||
| 166 | } | ||
| 167 | } | ||
| 168 | |||
| 169 | if (pci_write_config_dword(dev->pdev, PCI_COMMAND, | ||
| 170 | hca_header[PCI_COMMAND / 4])) { | ||
| 171 | err = -ENODEV; | ||
| 172 | mlx4_err(dev, "Couldn't restore HCA COMMAND, " | ||
| 173 | "aborting.\n"); | ||
| 174 | goto out; | ||
| 175 | } | ||
| 176 | |||
| 177 | out: | ||
| 178 | kfree(hca_header); | ||
| 179 | |||
| 180 | return err; | ||
| 181 | } | ||
diff --git a/drivers/net/mlx4/srq.c b/drivers/net/mlx4/srq.c new file mode 100644 index 000000000000..2134f83aed87 --- /dev/null +++ b/drivers/net/mlx4/srq.c | |||
| @@ -0,0 +1,227 @@ | |||
| 1 | /* | ||
| 2 | * Copyright (c) 2006, 2007 Cisco Systems, Inc. All rights reserved. | ||
| 3 | * | ||
| 4 | * This software is available to you under a choice of one of two | ||
| 5 | * licenses. You may choose to be licensed under the terms of the GNU | ||
| 6 | * General Public License (GPL) Version 2, available from the file | ||
| 7 | * COPYING in the main directory of this source tree, or the | ||
| 8 | * OpenIB.org BSD license below: | ||
| 9 | * | ||
| 10 | * Redistribution and use in source and binary forms, with or | ||
| 11 | * without modification, are permitted provided that the following | ||
| 12 | * conditions are met: | ||
| 13 | * | ||
| 14 | * - Redistributions of source code must retain the above | ||
| 15 | * copyright notice, this list of conditions and the following | ||
| 16 | * disclaimer. | ||
| 17 | * | ||
| 18 | * - Redistributions in binary form must reproduce the above | ||
| 19 | * copyright notice, this list of conditions and the following | ||
| 20 | * disclaimer in the documentation and/or other materials | ||
| 21 | * provided with the distribution. | ||
| 22 | * | ||
| 23 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, | ||
| 24 | * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF | ||
| 25 | * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND | ||
| 26 | * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS | ||
| 27 | * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN | ||
| 28 | * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN | ||
| 29 | * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE | ||
| 30 | * SOFTWARE. | ||
| 31 | */ | ||
| 32 | |||
| 33 | #include <linux/init.h> | ||
| 34 | |||
| 35 | #include <linux/mlx4/cmd.h> | ||
| 36 | |||
| 37 | #include "mlx4.h" | ||
| 38 | #include "icm.h" | ||
| 39 | |||
| 40 | struct mlx4_srq_context { | ||
| 41 | __be32 state_logsize_srqn; | ||
| 42 | u8 logstride; | ||
| 43 | u8 reserved1[3]; | ||
| 44 | u8 pg_offset; | ||
| 45 | u8 reserved2[3]; | ||
| 46 | u32 reserved3; | ||
| 47 | u8 log_page_size; | ||
| 48 | u8 reserved4[2]; | ||
| 49 | u8 mtt_base_addr_h; | ||
| 50 | __be32 mtt_base_addr_l; | ||
| 51 | __be32 pd; | ||
| 52 | __be16 limit_watermark; | ||
| 53 | __be16 wqe_cnt; | ||
| 54 | u16 reserved5; | ||
| 55 | __be16 wqe_counter; | ||
| 56 | u32 reserved6; | ||
| 57 | __be64 db_rec_addr; | ||
| 58 | }; | ||
| 59 | |||
| 60 | void mlx4_srq_event(struct mlx4_dev *dev, u32 srqn, int event_type) | ||
| 61 | { | ||
| 62 | struct mlx4_srq_table *srq_table = &mlx4_priv(dev)->srq_table; | ||
| 63 | struct mlx4_srq *srq; | ||
| 64 | |||
| 65 | spin_lock(&srq_table->lock); | ||
| 66 | |||
| 67 | srq = radix_tree_lookup(&srq_table->tree, srqn & (dev->caps.num_srqs - 1)); | ||
| 68 | if (srq) | ||
| 69 | atomic_inc(&srq->refcount); | ||
| 70 | |||
| 71 | spin_unlock(&srq_table->lock); | ||
| 72 | |||
| 73 | if (!srq) { | ||
| 74 | mlx4_warn(dev, "Async event for bogus SRQ %08x\n", srqn); | ||
| 75 | return; | ||
| 76 | } | ||
| 77 | |||
| 78 | srq->event(srq, event_type); | ||
| 79 | |||
| 80 | if (atomic_dec_and_test(&srq->refcount)) | ||
| 81 | complete(&srq->free); | ||
| 82 | } | ||
| 83 | |||
| 84 | static int mlx4_SW2HW_SRQ(struct mlx4_dev *dev, struct mlx4_cmd_mailbox *mailbox, | ||
| 85 | int srq_num) | ||
| 86 | { | ||
| 87 | return mlx4_cmd(dev, mailbox->dma, srq_num, 0, MLX4_CMD_SW2HW_SRQ, | ||
| 88 | MLX4_CMD_TIME_CLASS_A); | ||
| 89 | } | ||
| 90 | |||
| 91 | static int mlx4_HW2SW_SRQ(struct mlx4_dev *dev, struct mlx4_cmd_mailbox *mailbox, | ||
| 92 | int srq_num) | ||
| 93 | { | ||
| 94 | return mlx4_cmd_box(dev, 0, mailbox ? mailbox->dma : 0, srq_num, | ||
| 95 | mailbox ? 0 : 1, MLX4_CMD_HW2SW_SRQ, | ||
| 96 | MLX4_CMD_TIME_CLASS_A); | ||
| 97 | } | ||
| 98 | |||
| 99 | static int mlx4_ARM_SRQ(struct mlx4_dev *dev, int srq_num, int limit_watermark) | ||
| 100 | { | ||
| 101 | return mlx4_cmd(dev, limit_watermark, srq_num, 0, MLX4_CMD_ARM_SRQ, | ||
| 102 | MLX4_CMD_TIME_CLASS_B); | ||
| 103 | } | ||
| 104 | |||
| 105 | int mlx4_srq_alloc(struct mlx4_dev *dev, u32 pdn, struct mlx4_mtt *mtt, | ||
| 106 | u64 db_rec, struct mlx4_srq *srq) | ||
| 107 | { | ||
| 108 | struct mlx4_srq_table *srq_table = &mlx4_priv(dev)->srq_table; | ||
| 109 | struct mlx4_cmd_mailbox *mailbox; | ||
| 110 | struct mlx4_srq_context *srq_context; | ||
| 111 | u64 mtt_addr; | ||
| 112 | int err; | ||
| 113 | |||
| 114 | srq->srqn = mlx4_bitmap_alloc(&srq_table->bitmap); | ||
| 115 | if (srq->srqn == -1) | ||
| 116 | return -ENOMEM; | ||
| 117 | |||
| 118 | err = mlx4_table_get(dev, &srq_table->table, srq->srqn); | ||
| 119 | if (err) | ||
| 120 | goto err_out; | ||
| 121 | |||
| 122 | err = mlx4_table_get(dev, &srq_table->cmpt_table, srq->srqn); | ||
| 123 | if (err) | ||
| 124 | goto err_put; | ||
| 125 | |||
| 126 | spin_lock_irq(&srq_table->lock); | ||
| 127 | err = radix_tree_insert(&srq_table->tree, srq->srqn, srq); | ||
| 128 | spin_unlock_irq(&srq_table->lock); | ||
| 129 | if (err) | ||
| 130 | goto err_cmpt_put; | ||
| 131 | |||
| 132 | mailbox = mlx4_alloc_cmd_mailbox(dev); | ||
| 133 | if (IS_ERR(mailbox)) { | ||
| 134 | err = PTR_ERR(mailbox); | ||
| 135 | goto err_radix; | ||
| 136 | } | ||
| 137 | |||
| 138 | srq_context = mailbox->buf; | ||
| 139 | memset(srq_context, 0, sizeof *srq_context); | ||
| 140 | |||
| 141 | srq_context->state_logsize_srqn = cpu_to_be32((ilog2(srq->max) << 24) | | ||
| 142 | srq->srqn); | ||
| 143 | srq_context->logstride = srq->wqe_shift - 4; | ||
| 144 | srq_context->log_page_size = mtt->page_shift - MLX4_ICM_PAGE_SHIFT; | ||
| 145 | |||
| 146 | mtt_addr = mlx4_mtt_addr(dev, mtt); | ||
| 147 | srq_context->mtt_base_addr_h = mtt_addr >> 32; | ||
| 148 | srq_context->mtt_base_addr_l = cpu_to_be32(mtt_addr & 0xffffffff); | ||
| 149 | srq_context->pd = cpu_to_be32(pdn); | ||
| 150 | srq_context->db_rec_addr = cpu_to_be64(db_rec); | ||
| 151 | |||
| 152 | err = mlx4_SW2HW_SRQ(dev, mailbox, srq->srqn); | ||
| 153 | mlx4_free_cmd_mailbox(dev, mailbox); | ||
| 154 | if (err) | ||
| 155 | goto err_radix; | ||
| 156 | |||
| 157 | atomic_set(&srq->refcount, 1); | ||
| 158 | init_completion(&srq->free); | ||
| 159 | |||
| 160 | return 0; | ||
| 161 | |||
| 162 | err_radix: | ||
| 163 | spin_lock_irq(&srq_table->lock); | ||
| 164 | radix_tree_delete(&srq_table->tree, srq->srqn); | ||
| 165 | spin_unlock_irq(&srq_table->lock); | ||
| 166 | |||
| 167 | err_cmpt_put: | ||
| 168 | mlx4_table_put(dev, &srq_table->cmpt_table, srq->srqn); | ||
| 169 | |||
| 170 | err_put: | ||
| 171 | mlx4_table_put(dev, &srq_table->table, srq->srqn); | ||
| 172 | |||
| 173 | err_out: | ||
| 174 | mlx4_bitmap_free(&srq_table->bitmap, srq->srqn); | ||
| 175 | |||
| 176 | return err; | ||
| 177 | } | ||
| 178 | EXPORT_SYMBOL_GPL(mlx4_srq_alloc); | ||
| 179 | |||
| 180 | void mlx4_srq_free(struct mlx4_dev *dev, struct mlx4_srq *srq) | ||
| 181 | { | ||
| 182 | struct mlx4_srq_table *srq_table = &mlx4_priv(dev)->srq_table; | ||
| 183 | int err; | ||
| 184 | |||
| 185 | err = mlx4_HW2SW_SRQ(dev, NULL, srq->srqn); | ||
| 186 | if (err) | ||
| 187 | mlx4_warn(dev, "HW2SW_SRQ failed (%d) for SRQN %06x\n", err, srq->srqn); | ||
| 188 | |||
| 189 | spin_lock_irq(&srq_table->lock); | ||
| 190 | radix_tree_delete(&srq_table->tree, srq->srqn); | ||
| 191 | spin_unlock_irq(&srq_table->lock); | ||
| 192 | |||
| 193 | if (atomic_dec_and_test(&srq->refcount)) | ||
| 194 | complete(&srq->free); | ||
| 195 | wait_for_completion(&srq->free); | ||
| 196 | |||
| 197 | mlx4_table_put(dev, &srq_table->table, srq->srqn); | ||
| 198 | mlx4_bitmap_free(&srq_table->bitmap, srq->srqn); | ||
| 199 | } | ||
| 200 | EXPORT_SYMBOL_GPL(mlx4_srq_free); | ||
| 201 | |||
| 202 | int mlx4_srq_arm(struct mlx4_dev *dev, struct mlx4_srq *srq, int limit_watermark) | ||
| 203 | { | ||
| 204 | return mlx4_ARM_SRQ(dev, srq->srqn, limit_watermark); | ||
| 205 | } | ||
| 206 | EXPORT_SYMBOL_GPL(mlx4_srq_arm); | ||
| 207 | |||
| 208 | int __devinit mlx4_init_srq_table(struct mlx4_dev *dev) | ||
| 209 | { | ||
| 210 | struct mlx4_srq_table *srq_table = &mlx4_priv(dev)->srq_table; | ||
| 211 | int err; | ||
| 212 | |||
| 213 | spin_lock_init(&srq_table->lock); | ||
| 214 | INIT_RADIX_TREE(&srq_table->tree, GFP_ATOMIC); | ||
| 215 | |||
| 216 | err = mlx4_bitmap_init(&srq_table->bitmap, dev->caps.num_srqs, | ||
| 217 | dev->caps.num_srqs - 1, dev->caps.reserved_srqs); | ||
| 218 | if (err) | ||
| 219 | return err; | ||
| 220 | |||
| 221 | return 0; | ||
| 222 | } | ||
| 223 | |||
| 224 | void mlx4_cleanup_srq_table(struct mlx4_dev *dev) | ||
| 225 | { | ||
| 226 | mlx4_bitmap_cleanup(&mlx4_priv(dev)->srq_table.bitmap); | ||
| 227 | } | ||
