Merge branch 'master' into upstream
[linux-2.6] / drivers / infiniband / hw / ipath / ipath_layer.c
1 /*
2  * Copyright (c) 2006 QLogic, Inc. All rights reserved.
3  * Copyright (c) 2003, 2004, 2005, 2006 PathScale, 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 /*
35  * These are the routines used by layered drivers, currently just the
36  * layered ethernet driver and verbs layer.
37  */
38
39 #include <linux/io.h>
40 #include <linux/pci.h>
41 #include <asm/byteorder.h>
42
43 #include "ipath_kernel.h"
44 #include "ipath_layer.h"
45 #include "ipath_verbs.h"
46 #include "ipath_common.h"
47
48 /* Acquire before ipath_devs_lock. */
49 static DEFINE_MUTEX(ipath_layer_mutex);
50
51 u16 ipath_layer_rcv_opcode;
52
53 static int (*layer_intr)(void *, u32);
54 static int (*layer_rcv)(void *, void *, struct sk_buff *);
55 static int (*layer_rcv_lid)(void *, void *);
56
57 static void *(*layer_add_one)(int, struct ipath_devdata *);
58 static void (*layer_remove_one)(void *);
59
60 int __ipath_layer_intr(struct ipath_devdata *dd, u32 arg)
61 {
62         int ret = -ENODEV;
63
64         if (dd->ipath_layer.l_arg && layer_intr)
65                 ret = layer_intr(dd->ipath_layer.l_arg, arg);
66
67         return ret;
68 }
69
70 int ipath_layer_intr(struct ipath_devdata *dd, u32 arg)
71 {
72         int ret;
73
74         mutex_lock(&ipath_layer_mutex);
75
76         ret = __ipath_layer_intr(dd, arg);
77
78         mutex_unlock(&ipath_layer_mutex);
79
80         return ret;
81 }
82
83 int __ipath_layer_rcv(struct ipath_devdata *dd, void *hdr,
84                       struct sk_buff *skb)
85 {
86         int ret = -ENODEV;
87
88         if (dd->ipath_layer.l_arg && layer_rcv)
89                 ret = layer_rcv(dd->ipath_layer.l_arg, hdr, skb);
90
91         return ret;
92 }
93
94 int __ipath_layer_rcv_lid(struct ipath_devdata *dd, void *hdr)
95 {
96         int ret = -ENODEV;
97
98         if (dd->ipath_layer.l_arg && layer_rcv_lid)
99                 ret = layer_rcv_lid(dd->ipath_layer.l_arg, hdr);
100
101         return ret;
102 }
103
104 void ipath_layer_lid_changed(struct ipath_devdata *dd)
105 {
106         mutex_lock(&ipath_layer_mutex);
107
108         if (dd->ipath_layer.l_arg && layer_intr)
109                 layer_intr(dd->ipath_layer.l_arg, IPATH_LAYER_INT_LID);
110
111         mutex_unlock(&ipath_layer_mutex);
112 }
113
114 void ipath_layer_add(struct ipath_devdata *dd)
115 {
116         mutex_lock(&ipath_layer_mutex);
117
118         if (layer_add_one)
119                 dd->ipath_layer.l_arg =
120                         layer_add_one(dd->ipath_unit, dd);
121
122         mutex_unlock(&ipath_layer_mutex);
123 }
124
125 void ipath_layer_remove(struct ipath_devdata *dd)
126 {
127         mutex_lock(&ipath_layer_mutex);
128
129         if (dd->ipath_layer.l_arg && layer_remove_one) {
130                 layer_remove_one(dd->ipath_layer.l_arg);
131                 dd->ipath_layer.l_arg = NULL;
132         }
133
134         mutex_unlock(&ipath_layer_mutex);
135 }
136
137 int ipath_layer_register(void *(*l_add)(int, struct ipath_devdata *),
138                          void (*l_remove)(void *),
139                          int (*l_intr)(void *, u32),
140                          int (*l_rcv)(void *, void *, struct sk_buff *),
141                          u16 l_rcv_opcode,
142                          int (*l_rcv_lid)(void *, void *))
143 {
144         struct ipath_devdata *dd, *tmp;
145         unsigned long flags;
146
147         mutex_lock(&ipath_layer_mutex);
148
149         layer_add_one = l_add;
150         layer_remove_one = l_remove;
151         layer_intr = l_intr;
152         layer_rcv = l_rcv;
153         layer_rcv_lid = l_rcv_lid;
154         ipath_layer_rcv_opcode = l_rcv_opcode;
155
156         spin_lock_irqsave(&ipath_devs_lock, flags);
157
158         list_for_each_entry_safe(dd, tmp, &ipath_dev_list, ipath_list) {
159                 if (!(dd->ipath_flags & IPATH_INITTED))
160                         continue;
161
162                 if (dd->ipath_layer.l_arg)
163                         continue;
164
165                 spin_unlock_irqrestore(&ipath_devs_lock, flags);
166                 dd->ipath_layer.l_arg = l_add(dd->ipath_unit, dd);
167                 spin_lock_irqsave(&ipath_devs_lock, flags);
168         }
169
170         spin_unlock_irqrestore(&ipath_devs_lock, flags);
171         mutex_unlock(&ipath_layer_mutex);
172
173         return 0;
174 }
175
176 EXPORT_SYMBOL_GPL(ipath_layer_register);
177
178 void ipath_layer_unregister(void)
179 {
180         struct ipath_devdata *dd, *tmp;
181         unsigned long flags;
182
183         mutex_lock(&ipath_layer_mutex);
184         spin_lock_irqsave(&ipath_devs_lock, flags);
185
186         list_for_each_entry_safe(dd, tmp, &ipath_dev_list, ipath_list) {
187                 if (dd->ipath_layer.l_arg && layer_remove_one) {
188                         spin_unlock_irqrestore(&ipath_devs_lock, flags);
189                         layer_remove_one(dd->ipath_layer.l_arg);
190                         spin_lock_irqsave(&ipath_devs_lock, flags);
191                         dd->ipath_layer.l_arg = NULL;
192                 }
193         }
194
195         spin_unlock_irqrestore(&ipath_devs_lock, flags);
196
197         layer_add_one = NULL;
198         layer_remove_one = NULL;
199         layer_intr = NULL;
200         layer_rcv = NULL;
201         layer_rcv_lid = NULL;
202
203         mutex_unlock(&ipath_layer_mutex);
204 }
205
206 EXPORT_SYMBOL_GPL(ipath_layer_unregister);
207
208 int ipath_layer_open(struct ipath_devdata *dd, u32 * pktmax)
209 {
210         int ret;
211         u32 intval = 0;
212
213         mutex_lock(&ipath_layer_mutex);
214
215         if (!dd->ipath_layer.l_arg) {
216                 ret = -EINVAL;
217                 goto bail;
218         }
219
220         ret = ipath_setrcvhdrsize(dd, IPATH_HEADER_QUEUE_WORDS);
221
222         if (ret < 0)
223                 goto bail;
224
225         *pktmax = dd->ipath_ibmaxlen;
226
227         if (*dd->ipath_statusp & IPATH_STATUS_IB_READY)
228                 intval |= IPATH_LAYER_INT_IF_UP;
229         if (dd->ipath_lid)
230                 intval |= IPATH_LAYER_INT_LID;
231         if (dd->ipath_mlid)
232                 intval |= IPATH_LAYER_INT_BCAST;
233         /*
234          * do this on open, in case low level is already up and
235          * just layered driver was reloaded, etc.
236          */
237         if (intval)
238                 layer_intr(dd->ipath_layer.l_arg, intval);
239
240         ret = 0;
241 bail:
242         mutex_unlock(&ipath_layer_mutex);
243
244         return ret;
245 }
246
247 EXPORT_SYMBOL_GPL(ipath_layer_open);
248
249 u16 ipath_layer_get_lid(struct ipath_devdata *dd)
250 {
251         return dd->ipath_lid;
252 }
253
254 EXPORT_SYMBOL_GPL(ipath_layer_get_lid);
255
256 /**
257  * ipath_layer_get_mac - get the MAC address
258  * @dd: the infinipath device
259  * @mac: the MAC is put here
260  *
261  * This is the EUID-64 OUI octets (top 3), then
262  * skip the next 2 (which should both be zero or 0xff).
263  * The returned MAC is in network order
264  * mac points to at least 6 bytes of buffer
265  * We assume that by the time the LID is set, that the GUID is as valid
266  * as it's ever going to be, rather than adding yet another status bit.
267  */
268
269 int ipath_layer_get_mac(struct ipath_devdata *dd, u8 * mac)
270 {
271         u8 *guid;
272
273         guid = (u8 *) &dd->ipath_guid;
274
275         mac[0] = guid[0];
276         mac[1] = guid[1];
277         mac[2] = guid[2];
278         mac[3] = guid[5];
279         mac[4] = guid[6];
280         mac[5] = guid[7];
281         if ((guid[3] || guid[4]) && !(guid[3] == 0xff && guid[4] == 0xff))
282                 ipath_dbg("Warning, guid bytes 3 and 4 not 0 or 0xffff: "
283                           "%x %x\n", guid[3], guid[4]);
284         return 0;
285 }
286
287 EXPORT_SYMBOL_GPL(ipath_layer_get_mac);
288
289 u16 ipath_layer_get_bcast(struct ipath_devdata *dd)
290 {
291         return dd->ipath_mlid;
292 }
293
294 EXPORT_SYMBOL_GPL(ipath_layer_get_bcast);
295
296 int ipath_layer_send_hdr(struct ipath_devdata *dd, struct ether_header *hdr)
297 {
298         int ret = 0;
299         u32 __iomem *piobuf;
300         u32 plen, *uhdr;
301         size_t count;
302         __be16 vlsllnh;
303
304         if (!(dd->ipath_flags & IPATH_RCVHDRSZ_SET)) {
305                 ipath_dbg("send while not open\n");
306                 ret = -EINVAL;
307         } else
308                 if ((dd->ipath_flags & (IPATH_LINKUNK | IPATH_LINKDOWN)) ||
309                     dd->ipath_lid == 0) {
310                         /*
311                          * lid check is for when sma hasn't yet configured
312                          */
313                         ret = -ENETDOWN;
314                         ipath_cdbg(VERBOSE, "send while not ready, "
315                                    "mylid=%u, flags=0x%x\n",
316                                    dd->ipath_lid, dd->ipath_flags);
317                 }
318
319         vlsllnh = *((__be16 *) hdr);
320         if (vlsllnh != htons(IPATH_LRH_BTH)) {
321                 ipath_dbg("Warning: lrh[0] wrong (%x, not %x); "
322                           "not sending\n", be16_to_cpu(vlsllnh),
323                           IPATH_LRH_BTH);
324                 ret = -EINVAL;
325         }
326         if (ret)
327                 goto done;
328
329         /* Get a PIO buffer to use. */
330         piobuf = ipath_getpiobuf(dd, NULL);
331         if (piobuf == NULL) {
332                 ret = -EBUSY;
333                 goto done;
334         }
335
336         plen = (sizeof(*hdr) >> 2); /* actual length */
337         ipath_cdbg(EPKT, "0x%x+1w pio %p\n", plen, piobuf);
338
339         writeq(plen+1, piobuf); /* len (+1 for pad) to pbc, no flags */
340         ipath_flush_wc();
341         piobuf += 2;
342         uhdr = (u32 *)hdr;
343         count = plen-1; /* amount we can copy before trigger word */
344         __iowrite32_copy(piobuf, uhdr, count);
345         ipath_flush_wc();
346         __raw_writel(uhdr[count], piobuf + count);
347         ipath_flush_wc(); /* ensure it's sent, now */
348
349         ipath_stats.sps_ether_spkts++;  /* ether packet sent */
350
351 done:
352         return ret;
353 }
354
355 EXPORT_SYMBOL_GPL(ipath_layer_send_hdr);
356
357 int ipath_layer_set_piointbufavail_int(struct ipath_devdata *dd)
358 {
359         set_bit(IPATH_S_PIOINTBUFAVAIL, &dd->ipath_sendctrl);
360
361         ipath_write_kreg(dd, dd->ipath_kregs->kr_sendctrl,
362                          dd->ipath_sendctrl);
363         return 0;
364 }
365
366 EXPORT_SYMBOL_GPL(ipath_layer_set_piointbufavail_int);