2 * Copyright (c) 2006 QLogic, Inc. All rights reserved.
3 * Copyright (c) 2003, 2004, 2005, 2006 PathScale, Inc. All rights reserved.
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:
11 * Redistribution and use in source and binary forms, with or
12 * without modification, are permitted provided that the following
15 * - Redistributions of source code must retain the above
16 * copyright notice, this list of conditions and the following
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.
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
35 * This file contains support for diagnostic functions. It is accessed by
36 * opening the ipath_diag device, normally minor number 129. Diagnostic use
37 * of the InfiniPath chip may render the chip or board unusable until the
38 * driver is unloaded, or in some cases, until the system is rebooted.
40 * Accesses to the chip through this interface are not similar to going
41 * through the /sys/bus/pci resource mmap interface.
45 #include <linux/pci.h>
46 #include <linux/vmalloc.h>
47 #include <asm/uaccess.h>
49 #include "ipath_kernel.h"
50 #include "ipath_common.h"
53 static int diag_set_link
;
55 static int ipath_diag_open(struct inode
*in
, struct file
*fp
);
56 static int ipath_diag_release(struct inode
*in
, struct file
*fp
);
57 static ssize_t
ipath_diag_read(struct file
*fp
, char __user
*data
,
58 size_t count
, loff_t
*off
);
59 static ssize_t
ipath_diag_write(struct file
*fp
, const char __user
*data
,
60 size_t count
, loff_t
*off
);
62 static struct file_operations diag_file_ops
= {
64 .write
= ipath_diag_write
,
65 .read
= ipath_diag_read
,
66 .open
= ipath_diag_open
,
67 .release
= ipath_diag_release
70 int ipath_diag_add(struct ipath_devdata
*dd
)
74 snprintf(name
, sizeof(name
), "ipath_diag%d", dd
->ipath_unit
);
76 return ipath_cdev_init(IPATH_DIAG_MINOR_BASE
+ dd
->ipath_unit
, name
,
77 &diag_file_ops
, &dd
->diag_cdev
,
81 void ipath_diag_remove(struct ipath_devdata
*dd
)
83 ipath_cdev_cleanup(&dd
->diag_cdev
, &dd
->diag_class_dev
);
87 * ipath_read_umem64 - read a 64-bit quantity from the chip into user space
88 * @dd: the infinipath device
89 * @uaddr: the location to store the data in user memory
90 * @caddr: the source chip address (full pointer, not offset)
91 * @count: number of bytes to copy (multiple of 32 bits)
93 * This function also localizes all chip memory accesses.
94 * The copy should be written such that we read full cacheline packets
95 * from the chip. This is usually used for a single qword
97 * NOTE: This assumes the chip address is 64-bit aligned.
99 static int ipath_read_umem64(struct ipath_devdata
*dd
, void __user
*uaddr
,
100 const void __iomem
*caddr
, size_t count
)
102 const u64 __iomem
*reg_addr
= caddr
;
103 const u64 __iomem
*reg_end
= reg_addr
+ (count
/ sizeof(u64
));
106 /* not very efficient, but it works for now */
107 if (reg_addr
< dd
->ipath_kregbase
|| reg_end
> dd
->ipath_kregend
) {
111 while (reg_addr
< reg_end
) {
112 u64 data
= readq(reg_addr
);
113 if (copy_to_user(uaddr
, &data
, sizeof(u64
))) {
118 uaddr
+= sizeof(u64
);
126 * ipath_write_umem64 - write a 64-bit quantity to the chip from user space
127 * @dd: the infinipath device
128 * @caddr: the destination chip address (full pointer, not offset)
129 * @uaddr: the source of the data in user memory
130 * @count: the number of bytes to copy (multiple of 32 bits)
132 * This is usually used for a single qword
133 * NOTE: This assumes the chip address is 64-bit aligned.
136 static int ipath_write_umem64(struct ipath_devdata
*dd
, void __iomem
*caddr
,
137 const void __user
*uaddr
, size_t count
)
139 u64 __iomem
*reg_addr
= caddr
;
140 const u64 __iomem
*reg_end
= reg_addr
+ (count
/ sizeof(u64
));
143 /* not very efficient, but it works for now */
144 if (reg_addr
< dd
->ipath_kregbase
|| reg_end
> dd
->ipath_kregend
) {
148 while (reg_addr
< reg_end
) {
150 if (copy_from_user(&data
, uaddr
, sizeof(data
))) {
154 writeq(data
, reg_addr
);
157 uaddr
+= sizeof(u64
);
165 * ipath_read_umem32 - read a 32-bit quantity from the chip into user space
166 * @dd: the infinipath device
167 * @uaddr: the location to store the data in user memory
168 * @caddr: the source chip address (full pointer, not offset)
169 * @count: number of bytes to copy
171 * read 32 bit values, not 64 bit; for memories that only
172 * support 32 bit reads; usually a single dword.
174 static int ipath_read_umem32(struct ipath_devdata
*dd
, void __user
*uaddr
,
175 const void __iomem
*caddr
, size_t count
)
177 const u32 __iomem
*reg_addr
= caddr
;
178 const u32 __iomem
*reg_end
= reg_addr
+ (count
/ sizeof(u32
));
181 if (reg_addr
< (u32 __iomem
*) dd
->ipath_kregbase
||
182 reg_end
> (u32 __iomem
*) dd
->ipath_kregend
) {
186 /* not very efficient, but it works for now */
187 while (reg_addr
< reg_end
) {
188 u32 data
= readl(reg_addr
);
189 if (copy_to_user(uaddr
, &data
, sizeof(data
))) {
195 uaddr
+= sizeof(u32
);
204 * ipath_write_umem32 - write a 32-bit quantity to the chip from user space
205 * @dd: the infinipath device
206 * @caddr: the destination chip address (full pointer, not offset)
207 * @uaddr: the source of the data in user memory
208 * @count: number of bytes to copy
210 * write 32 bit values, not 64 bit; for memories that only
211 * support 32 bit write; usually a single dword.
214 static int ipath_write_umem32(struct ipath_devdata
*dd
, void __iomem
*caddr
,
215 const void __user
*uaddr
, size_t count
)
217 u32 __iomem
*reg_addr
= caddr
;
218 const u32 __iomem
*reg_end
= reg_addr
+ (count
/ sizeof(u32
));
221 if (reg_addr
< (u32 __iomem
*) dd
->ipath_kregbase
||
222 reg_end
> (u32 __iomem
*) dd
->ipath_kregend
) {
226 while (reg_addr
< reg_end
) {
228 if (copy_from_user(&data
, uaddr
, sizeof(data
))) {
232 writel(data
, reg_addr
);
235 uaddr
+= sizeof(u32
);
242 static int ipath_diag_open(struct inode
*in
, struct file
*fp
)
244 int unit
= iminor(in
) - IPATH_DIAG_MINOR_BASE
;
245 struct ipath_devdata
*dd
;
248 mutex_lock(&ipath_mutex
);
250 if (ipath_diag_inuse
) {
255 dd
= ipath_lookup(unit
);
257 if (dd
== NULL
|| !(dd
->ipath_flags
& IPATH_PRESENT
) ||
258 !dd
->ipath_kregbase
) {
263 fp
->private_data
= dd
;
264 ipath_diag_inuse
= 1;
268 /* Only expose a way to reset the device if we
269 make it into diag mode. */
270 ipath_expose_reset(&dd
->pcidev
->dev
);
273 mutex_unlock(&ipath_mutex
);
278 static ssize_t
ipath_diagpkt_write(struct file
*fp
,
279 const char __user
*data
,
280 size_t count
, loff_t
*off
);
282 static struct file_operations diagpkt_file_ops
= {
283 .owner
= THIS_MODULE
,
284 .write
= ipath_diagpkt_write
,
287 static struct cdev
*diagpkt_cdev
;
288 static struct class_device
*diagpkt_class_dev
;
290 int __init
ipath_diagpkt_add(void)
292 return ipath_cdev_init(IPATH_DIAGPKT_MINOR
,
293 "ipath_diagpkt", &diagpkt_file_ops
,
294 &diagpkt_cdev
, &diagpkt_class_dev
);
297 void __exit
ipath_diagpkt_remove(void)
299 ipath_cdev_cleanup(&diagpkt_cdev
, &diagpkt_class_dev
);
303 * ipath_diagpkt_write - write an IB packet
304 * @fp: the diag data device file pointer
305 * @data: ipath_diag_pkt structure saying where to get the packet
306 * @count: size of data to write
307 * @off: unused by this code
309 static ssize_t
ipath_diagpkt_write(struct file
*fp
,
310 const char __user
*data
,
311 size_t count
, loff_t
*off
)
314 u32 plen
, clen
, pbufn
;
315 struct ipath_diag_pkt dp
;
317 struct ipath_devdata
*dd
;
321 if (count
< sizeof(dp
)) {
326 if (copy_from_user(&dp
, data
, sizeof(dp
))) {
331 /* send count must be an exact number of dwords */
339 dd
= ipath_lookup(dp
.unit
);
340 if (!dd
|| !(dd
->ipath_flags
& IPATH_PRESENT
) ||
341 !dd
->ipath_kregbase
) {
342 ipath_cdbg(VERBOSE
, "illegal unit %u for diag data send\n",
348 if (ipath_diag_inuse
&& !diag_set_link
&&
349 !(dd
->ipath_flags
& IPATH_LINKACTIVE
)) {
351 ipath_cdbg(VERBOSE
, "Trying to set to set link active for "
353 ipath_set_linkstate(dd
, IPATH_IB_LINKARM
);
354 ipath_set_linkstate(dd
, IPATH_IB_LINKACTIVE
);
357 if (!(dd
->ipath_flags
& IPATH_INITTED
)) {
358 /* no hardware, freeze, etc. */
359 ipath_cdbg(VERBOSE
, "unit %u not usable\n", dd
->ipath_unit
);
363 val
= dd
->ipath_lastibcstat
& IPATH_IBSTATE_MASK
;
364 if (val
!= IPATH_IBSTATE_INIT
&& val
!= IPATH_IBSTATE_ARM
&&
365 val
!= IPATH_IBSTATE_ACTIVE
) {
366 ipath_cdbg(VERBOSE
, "unit %u not ready (state %llx)\n",
367 dd
->ipath_unit
, (unsigned long long) val
);
372 /* need total length before first word written */
373 /* +1 word is for the qword padding */
374 plen
= sizeof(u32
) + dp
.len
;
376 if ((plen
+ 4) > dd
->ipath_ibmaxlen
) {
377 ipath_dbg("Pkt len 0x%x > ibmaxlen %x\n",
378 plen
- 4, dd
->ipath_ibmaxlen
);
380 goto bail
; /* before writing pbc */
382 tmpbuf
= vmalloc(plen
);
384 dev_info(&dd
->pcidev
->dev
, "Unable to allocate tmp buffer, "
390 if (copy_from_user(tmpbuf
,
391 (const void __user
*) (unsigned long) dp
.data
,
397 piobuf
= ipath_getpiobuf(dd
, &pbufn
);
399 ipath_cdbg(VERBOSE
, "No PIO buffers avail unit for %u\n",
405 plen
>>= 2; /* in dwords */
407 if (ipath_debug
& __IPATH_PKTDBG
)
408 ipath_cdbg(VERBOSE
, "unit %u 0x%x+1w pio%d\n",
409 dd
->ipath_unit
, plen
- 1, pbufn
);
411 /* we have to flush after the PBC for correctness on some cpus
412 * or WC buffer can be written out of order */
413 writeq(plen
, piobuf
);
415 /* copy all by the trigger word, then flush, so it's written
416 * to chip before trigger word, then write trigger word, then
417 * flush again, so packet is sent. */
418 __iowrite32_copy(piobuf
+ 2, tmpbuf
, clen
- 1);
420 __raw_writel(tmpbuf
[clen
- 1], piobuf
+ clen
+ 1);
430 static int ipath_diag_release(struct inode
*in
, struct file
*fp
)
432 mutex_lock(&ipath_mutex
);
433 ipath_diag_inuse
= 0;
434 fp
->private_data
= NULL
;
435 mutex_unlock(&ipath_mutex
);
439 static ssize_t
ipath_diag_read(struct file
*fp
, char __user
*data
,
440 size_t count
, loff_t
*off
)
442 struct ipath_devdata
*dd
= fp
->private_data
;
443 void __iomem
*kreg_base
;
446 kreg_base
= dd
->ipath_kregbase
;
450 else if ((count
% 4) || (*off
% 4))
451 /* address or length is not 32-bit aligned, hence invalid */
453 else if ((count
% 8) || (*off
% 8))
454 /* address or length not 64-bit aligned; do 32-bit reads */
455 ret
= ipath_read_umem32(dd
, data
, kreg_base
+ *off
, count
);
457 ret
= ipath_read_umem64(dd
, data
, kreg_base
+ *off
, count
);
467 static ssize_t
ipath_diag_write(struct file
*fp
, const char __user
*data
,
468 size_t count
, loff_t
*off
)
470 struct ipath_devdata
*dd
= fp
->private_data
;
471 void __iomem
*kreg_base
;
474 kreg_base
= dd
->ipath_kregbase
;
478 else if ((count
% 4) || (*off
% 4))
479 /* address or length is not 32-bit aligned, hence invalid */
481 else if ((count
% 8) || (*off
% 8))
482 /* address or length not 64-bit aligned; do 32-bit writes */
483 ret
= ipath_write_umem32(dd
, kreg_base
+ *off
, data
, count
);
485 ret
= ipath_write_umem64(dd
, kreg_base
+ *off
, data
, count
);