net/mlx4_en: Fix mixed PFC and Global pause user control requests
[pandora-kernel.git] / drivers / net / ethernet / mellanox / mlx4 / pd.c
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/errno.h>
35 #include <linux/export.h>
36 #include <linux/io-mapping.h>
37
38 #include <asm/page.h>
39
40 #include "mlx4.h"
41 #include "icm.h"
42
43 enum {
44         MLX4_NUM_RESERVED_UARS = 8
45 };
46
47 int mlx4_pd_alloc(struct mlx4_dev *dev, u32 *pdn)
48 {
49         struct mlx4_priv *priv = mlx4_priv(dev);
50
51         *pdn = mlx4_bitmap_alloc(&priv->pd_bitmap);
52         if (*pdn == -1)
53                 return -ENOMEM;
54
55         return 0;
56 }
57 EXPORT_SYMBOL_GPL(mlx4_pd_alloc);
58
59 void mlx4_pd_free(struct mlx4_dev *dev, u32 pdn)
60 {
61         mlx4_bitmap_free(&mlx4_priv(dev)->pd_bitmap, pdn);
62 }
63 EXPORT_SYMBOL_GPL(mlx4_pd_free);
64
65 int mlx4_xrcd_alloc(struct mlx4_dev *dev, u32 *xrcdn)
66 {
67         struct mlx4_priv *priv = mlx4_priv(dev);
68
69         *xrcdn = mlx4_bitmap_alloc(&priv->xrcd_bitmap);
70         if (*xrcdn == -1)
71                 return -ENOMEM;
72
73         return 0;
74 }
75 EXPORT_SYMBOL_GPL(mlx4_xrcd_alloc);
76
77 void mlx4_xrcd_free(struct mlx4_dev *dev, u32 xrcdn)
78 {
79         mlx4_bitmap_free(&mlx4_priv(dev)->xrcd_bitmap, xrcdn);
80 }
81 EXPORT_SYMBOL_GPL(mlx4_xrcd_free);
82
83 int mlx4_init_pd_table(struct mlx4_dev *dev)
84 {
85         struct mlx4_priv *priv = mlx4_priv(dev);
86
87         return mlx4_bitmap_init(&priv->pd_bitmap, dev->caps.num_pds,
88                                 (1 << 24) - 1, dev->caps.reserved_pds, 0);
89 }
90
91 void mlx4_cleanup_pd_table(struct mlx4_dev *dev)
92 {
93         mlx4_bitmap_cleanup(&mlx4_priv(dev)->pd_bitmap);
94 }
95
96 int mlx4_init_xrcd_table(struct mlx4_dev *dev)
97 {
98         struct mlx4_priv *priv = mlx4_priv(dev);
99
100         return mlx4_bitmap_init(&priv->xrcd_bitmap, (1 << 16),
101                                 (1 << 16) - 1, dev->caps.reserved_xrcds + 1, 0);
102 }
103
104 void mlx4_cleanup_xrcd_table(struct mlx4_dev *dev)
105 {
106         mlx4_bitmap_cleanup(&mlx4_priv(dev)->xrcd_bitmap);
107 }
108
109 int mlx4_uar_alloc(struct mlx4_dev *dev, struct mlx4_uar *uar)
110 {
111         uar->index = mlx4_bitmap_alloc(&mlx4_priv(dev)->uar_table.bitmap);
112         if (uar->index == -1)
113                 return -ENOMEM;
114
115         uar->pfn = (pci_resource_start(dev->pdev, 2) >> PAGE_SHIFT) + uar->index;
116         uar->map = NULL;
117
118         return 0;
119 }
120 EXPORT_SYMBOL_GPL(mlx4_uar_alloc);
121
122 void mlx4_uar_free(struct mlx4_dev *dev, struct mlx4_uar *uar)
123 {
124         mlx4_bitmap_free(&mlx4_priv(dev)->uar_table.bitmap, uar->index);
125 }
126 EXPORT_SYMBOL_GPL(mlx4_uar_free);
127
128 int mlx4_bf_alloc(struct mlx4_dev *dev, struct mlx4_bf *bf)
129 {
130         struct mlx4_priv *priv = mlx4_priv(dev);
131         struct mlx4_uar *uar;
132         int err = 0;
133         int idx;
134
135         if (!priv->bf_mapping)
136                 return -ENOMEM;
137
138         mutex_lock(&priv->bf_mutex);
139         if (!list_empty(&priv->bf_list))
140                 uar = list_entry(priv->bf_list.next, struct mlx4_uar, bf_list);
141         else {
142                 if (mlx4_bitmap_avail(&priv->uar_table.bitmap) < MLX4_NUM_RESERVED_UARS) {
143                         err = -ENOMEM;
144                         goto out;
145                 }
146                 uar = kmalloc(sizeof *uar, GFP_KERNEL);
147                 if (!uar) {
148                         err = -ENOMEM;
149                         goto out;
150                 }
151                 err = mlx4_uar_alloc(dev, uar);
152                 if (err)
153                         goto free_kmalloc;
154
155                 uar->map = ioremap(uar->pfn << PAGE_SHIFT, PAGE_SIZE);
156                 if (!uar->map) {
157                         err = -ENOMEM;
158                         goto free_uar;
159                 }
160
161                 uar->bf_map = io_mapping_map_wc(priv->bf_mapping, uar->index << PAGE_SHIFT);
162                 if (!uar->bf_map) {
163                         err = -ENOMEM;
164                         goto unamp_uar;
165                 }
166                 uar->free_bf_bmap = 0;
167                 list_add(&uar->bf_list, &priv->bf_list);
168         }
169
170         bf->uar = uar;
171         idx = ffz(uar->free_bf_bmap);
172         uar->free_bf_bmap |= 1 << idx;
173         bf->uar = uar;
174         bf->offset = 0;
175         bf->buf_size = dev->caps.bf_reg_size / 2;
176         bf->reg = uar->bf_map + idx * dev->caps.bf_reg_size;
177         if (uar->free_bf_bmap == (1 << dev->caps.bf_regs_per_page) - 1)
178                 list_del_init(&uar->bf_list);
179
180         goto out;
181
182 unamp_uar:
183         bf->uar = NULL;
184         iounmap(uar->map);
185
186 free_uar:
187         mlx4_uar_free(dev, uar);
188
189 free_kmalloc:
190         kfree(uar);
191
192 out:
193         mutex_unlock(&priv->bf_mutex);
194         return err;
195 }
196 EXPORT_SYMBOL_GPL(mlx4_bf_alloc);
197
198 void mlx4_bf_free(struct mlx4_dev *dev, struct mlx4_bf *bf)
199 {
200         struct mlx4_priv *priv = mlx4_priv(dev);
201         int idx;
202
203         if (!bf->uar || !bf->uar->bf_map)
204                 return;
205
206         mutex_lock(&priv->bf_mutex);
207         idx = (bf->reg - bf->uar->bf_map) / dev->caps.bf_reg_size;
208         bf->uar->free_bf_bmap &= ~(1 << idx);
209         if (!bf->uar->free_bf_bmap) {
210                 if (!list_empty(&bf->uar->bf_list))
211                         list_del(&bf->uar->bf_list);
212
213                 io_mapping_unmap(bf->uar->bf_map);
214                 iounmap(bf->uar->map);
215                 mlx4_uar_free(dev, bf->uar);
216                 kfree(bf->uar);
217         } else if (list_empty(&bf->uar->bf_list))
218                 list_add(&bf->uar->bf_list, &priv->bf_list);
219
220         mutex_unlock(&priv->bf_mutex);
221 }
222 EXPORT_SYMBOL_GPL(mlx4_bf_free);
223
224 int mlx4_init_uar_table(struct mlx4_dev *dev)
225 {
226         if (dev->caps.num_uars <= 128) {
227                 mlx4_err(dev, "Only %d UAR pages (need more than 128)\n",
228                          dev->caps.num_uars);
229                 mlx4_err(dev, "Increase firmware log2_uar_bar_megabytes?\n");
230                 return -ENODEV;
231         }
232
233         return mlx4_bitmap_init(&mlx4_priv(dev)->uar_table.bitmap,
234                                 dev->caps.num_uars, dev->caps.num_uars - 1,
235                                 max(128, dev->caps.reserved_uars), 0);
236 }
237
238 void mlx4_cleanup_uar_table(struct mlx4_dev *dev)
239 {
240         mlx4_bitmap_cleanup(&mlx4_priv(dev)->uar_table.bitmap);
241 }