| Ivo van Doorn | 95ea362 | 2007-09-25 17:57:13 -0700 | [diff] [blame] | 1 | /* | 
| Gertjan van Wingerde | 9c9a0d1 | 2009-11-08 16:39:55 +0100 | [diff] [blame] | 2 | 	Copyright (C) 2004 - 2009 Ivo van Doorn <IvDoorn@gmail.com> | 
| Ivo van Doorn | 95ea362 | 2007-09-25 17:57:13 -0700 | [diff] [blame] | 3 | 	<http://rt2x00.serialmonkey.com> | 
 | 4 |  | 
 | 5 | 	This program is free software; you can redistribute it and/or modify | 
 | 6 | 	it under the terms of the GNU General Public License as published by | 
 | 7 | 	the Free Software Foundation; either version 2 of the License, or | 
 | 8 | 	(at your option) any later version. | 
 | 9 |  | 
 | 10 | 	This program is distributed in the hope that it will be useful, | 
 | 11 | 	but WITHOUT ANY WARRANTY; without even the implied warranty of | 
 | 12 | 	MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | 
 | 13 | 	GNU General Public License for more details. | 
 | 14 |  | 
 | 15 | 	You should have received a copy of the GNU General Public License | 
 | 16 | 	along with this program; if not, write to the | 
 | 17 | 	Free Software Foundation, Inc., | 
 | 18 | 	59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. | 
 | 19 |  */ | 
 | 20 |  | 
 | 21 | /* | 
 | 22 | 	Module: rt2x00lib | 
 | 23 | 	Abstract: rt2x00 debugfs specific routines. | 
 | 24 |  */ | 
 | 25 |  | 
| Ivo van Doorn | 95ea362 | 2007-09-25 17:57:13 -0700 | [diff] [blame] | 26 | #include <linux/debugfs.h> | 
 | 27 | #include <linux/kernel.h> | 
 | 28 | #include <linux/module.h> | 
| Ivo van Doorn | 4d8dd66 | 2007-11-27 21:49:29 +0100 | [diff] [blame] | 29 | #include <linux/poll.h> | 
| Alexey Dobriyan | d43c36d | 2009-10-07 17:09:06 +0400 | [diff] [blame] | 30 | #include <linux/sched.h> | 
| Tejun Heo | 5a0e3ad | 2010-03-24 17:04:11 +0900 | [diff] [blame] | 31 | #include <linux/slab.h> | 
| Ivo van Doorn | 95ea362 | 2007-09-25 17:57:13 -0700 | [diff] [blame] | 32 | #include <linux/uaccess.h> | 
 | 33 |  | 
 | 34 | #include "rt2x00.h" | 
 | 35 | #include "rt2x00lib.h" | 
| Ivo van Doorn | 4d8dd66 | 2007-11-27 21:49:29 +0100 | [diff] [blame] | 36 | #include "rt2x00dump.h" | 
| Ivo van Doorn | 95ea362 | 2007-09-25 17:57:13 -0700 | [diff] [blame] | 37 |  | 
| Ivo van Doorn | 68598d2 | 2008-02-10 22:50:28 +0100 | [diff] [blame] | 38 | #define MAX_LINE_LENGTH 64 | 
| Ivo van Doorn | 95ea362 | 2007-09-25 17:57:13 -0700 | [diff] [blame] | 39 |  | 
| Ivo van Doorn | 2bb057d | 2008-08-04 16:37:44 +0200 | [diff] [blame] | 40 | struct rt2x00debug_crypto { | 
 | 41 | 	unsigned long success; | 
 | 42 | 	unsigned long icv_error; | 
 | 43 | 	unsigned long mic_error; | 
 | 44 | 	unsigned long key_error; | 
 | 45 | }; | 
 | 46 |  | 
| Ivo van Doorn | 95ea362 | 2007-09-25 17:57:13 -0700 | [diff] [blame] | 47 | struct rt2x00debug_intf { | 
 | 48 | 	/* | 
 | 49 | 	 * Pointer to driver structure where | 
 | 50 | 	 * this debugfs entry belongs to. | 
 | 51 | 	 */ | 
 | 52 | 	struct rt2x00_dev *rt2x00dev; | 
 | 53 |  | 
 | 54 | 	/* | 
 | 55 | 	 * Reference to the rt2x00debug structure | 
 | 56 | 	 * which can be used to communicate with | 
 | 57 | 	 * the registers. | 
 | 58 | 	 */ | 
 | 59 | 	const struct rt2x00debug *debug; | 
 | 60 |  | 
 | 61 | 	/* | 
 | 62 | 	 * Debugfs entries for: | 
 | 63 | 	 * - driver folder | 
| Ivo van Doorn | 91921a4 | 2007-11-27 21:48:16 +0100 | [diff] [blame] | 64 | 	 *   - driver file | 
 | 65 | 	 *   - chipset file | 
 | 66 | 	 *   - device flags file | 
 | 67 | 	 *   - register folder | 
 | 68 | 	 *     - csr offset/value files | 
 | 69 | 	 *     - eeprom offset/value files | 
 | 70 | 	 *     - bbp offset/value files | 
 | 71 | 	 *     - rf offset/value files | 
| Ivo van Doorn | 68598d2 | 2008-02-10 22:50:28 +0100 | [diff] [blame] | 72 | 	 *   - queue folder | 
| Ivo van Doorn | 4d8dd66 | 2007-11-27 21:49:29 +0100 | [diff] [blame] | 73 | 	 *     - frame dump file | 
| Ivo van Doorn | 68598d2 | 2008-02-10 22:50:28 +0100 | [diff] [blame] | 74 | 	 *     - queue stats file | 
| Ivo van Doorn | 2bb057d | 2008-08-04 16:37:44 +0200 | [diff] [blame] | 75 | 	 *     - crypto stats file | 
| Ivo van Doorn | 95ea362 | 2007-09-25 17:57:13 -0700 | [diff] [blame] | 76 | 	 */ | 
 | 77 | 	struct dentry *driver_folder; | 
 | 78 | 	struct dentry *driver_entry; | 
 | 79 | 	struct dentry *chipset_entry; | 
| Ivo van Doorn | 643b252 | 2007-09-25 20:13:51 +0200 | [diff] [blame] | 80 | 	struct dentry *dev_flags; | 
| Ivo van Doorn | 91921a4 | 2007-11-27 21:48:16 +0100 | [diff] [blame] | 81 | 	struct dentry *register_folder; | 
| Ivo van Doorn | 95ea362 | 2007-09-25 17:57:13 -0700 | [diff] [blame] | 82 | 	struct dentry *csr_off_entry; | 
 | 83 | 	struct dentry *csr_val_entry; | 
 | 84 | 	struct dentry *eeprom_off_entry; | 
 | 85 | 	struct dentry *eeprom_val_entry; | 
 | 86 | 	struct dentry *bbp_off_entry; | 
 | 87 | 	struct dentry *bbp_val_entry; | 
 | 88 | 	struct dentry *rf_off_entry; | 
 | 89 | 	struct dentry *rf_val_entry; | 
| Ivo van Doorn | 68598d2 | 2008-02-10 22:50:28 +0100 | [diff] [blame] | 90 | 	struct dentry *queue_folder; | 
 | 91 | 	struct dentry *queue_frame_dump_entry; | 
 | 92 | 	struct dentry *queue_stats_entry; | 
| Ivo van Doorn | 2bb057d | 2008-08-04 16:37:44 +0200 | [diff] [blame] | 93 | 	struct dentry *crypto_stats_entry; | 
| Ivo van Doorn | 4d8dd66 | 2007-11-27 21:49:29 +0100 | [diff] [blame] | 94 |  | 
 | 95 | 	/* | 
 | 96 | 	 * The frame dump file only allows a single reader, | 
 | 97 | 	 * so we need to store the current state here. | 
 | 98 | 	 */ | 
 | 99 | 	unsigned long frame_dump_flags; | 
 | 100 | #define FRAME_DUMP_FILE_OPEN	1 | 
 | 101 |  | 
 | 102 | 	/* | 
 | 103 | 	 * We queue each frame before dumping it to the user, | 
 | 104 | 	 * per read command we will pass a single skb structure | 
 | 105 | 	 * so we should be prepared to queue multiple sk buffers | 
 | 106 | 	 * before sending it to userspace. | 
 | 107 | 	 */ | 
 | 108 | 	struct sk_buff_head frame_dump_skbqueue; | 
 | 109 | 	wait_queue_head_t frame_dump_waitqueue; | 
| Ivo van Doorn | 95ea362 | 2007-09-25 17:57:13 -0700 | [diff] [blame] | 110 |  | 
 | 111 | 	/* | 
| Ivo van Doorn | 2bb057d | 2008-08-04 16:37:44 +0200 | [diff] [blame] | 112 | 	 * HW crypto statistics. | 
| Daniel Mack | 3ad2f3f | 2010-02-03 08:01:28 +0800 | [diff] [blame] | 113 | 	 * All statistics are stored separately per cipher type. | 
| Ivo van Doorn | 2bb057d | 2008-08-04 16:37:44 +0200 | [diff] [blame] | 114 | 	 */ | 
 | 115 | 	struct rt2x00debug_crypto crypto_stats[CIPHER_MAX]; | 
 | 116 |  | 
 | 117 | 	/* | 
| Ivo van Doorn | 95ea362 | 2007-09-25 17:57:13 -0700 | [diff] [blame] | 118 | 	 * Driver and chipset files will use a data buffer | 
 | 119 | 	 * that has been created in advance. This will simplify | 
 | 120 | 	 * the code since we can use the debugfs functions. | 
 | 121 | 	 */ | 
 | 122 | 	struct debugfs_blob_wrapper driver_blob; | 
 | 123 | 	struct debugfs_blob_wrapper chipset_blob; | 
 | 124 |  | 
 | 125 | 	/* | 
 | 126 | 	 * Requested offset for each register type. | 
 | 127 | 	 */ | 
 | 128 | 	unsigned int offset_csr; | 
 | 129 | 	unsigned int offset_eeprom; | 
 | 130 | 	unsigned int offset_bbp; | 
 | 131 | 	unsigned int offset_rf; | 
 | 132 | }; | 
 | 133 |  | 
| Ivo van Doorn | 2bb057d | 2008-08-04 16:37:44 +0200 | [diff] [blame] | 134 | void rt2x00debug_update_crypto(struct rt2x00_dev *rt2x00dev, | 
| Ivo van Doorn | 84e3196 | 2008-12-20 10:53:29 +0100 | [diff] [blame] | 135 | 			       struct rxdone_entry_desc *rxdesc) | 
| Ivo van Doorn | 2bb057d | 2008-08-04 16:37:44 +0200 | [diff] [blame] | 136 | { | 
 | 137 | 	struct rt2x00debug_intf *intf = rt2x00dev->debugfs_intf; | 
| Ivo van Doorn | 84e3196 | 2008-12-20 10:53:29 +0100 | [diff] [blame] | 138 | 	enum cipher cipher = rxdesc->cipher; | 
 | 139 | 	enum rx_crypto status = rxdesc->cipher_status; | 
| Ivo van Doorn | 2bb057d | 2008-08-04 16:37:44 +0200 | [diff] [blame] | 140 |  | 
 | 141 | 	if (cipher == CIPHER_TKIP_NO_MIC) | 
 | 142 | 		cipher = CIPHER_TKIP; | 
| Roel Kluin | a6c6733 | 2009-05-20 02:12:56 +0200 | [diff] [blame] | 143 | 	if (cipher == CIPHER_NONE || cipher >= CIPHER_MAX) | 
| Ivo van Doorn | 2bb057d | 2008-08-04 16:37:44 +0200 | [diff] [blame] | 144 | 		return; | 
 | 145 |  | 
 | 146 | 	/* Remove CIPHER_NONE index */ | 
 | 147 | 	cipher--; | 
 | 148 |  | 
 | 149 | 	intf->crypto_stats[cipher].success += (status == RX_CRYPTO_SUCCESS); | 
 | 150 | 	intf->crypto_stats[cipher].icv_error += (status == RX_CRYPTO_FAIL_ICV); | 
 | 151 | 	intf->crypto_stats[cipher].mic_error += (status == RX_CRYPTO_FAIL_MIC); | 
 | 152 | 	intf->crypto_stats[cipher].key_error += (status == RX_CRYPTO_FAIL_KEY); | 
 | 153 | } | 
 | 154 |  | 
| Ivo van Doorn | 4d8dd66 | 2007-11-27 21:49:29 +0100 | [diff] [blame] | 155 | void rt2x00debug_dump_frame(struct rt2x00_dev *rt2x00dev, | 
| Ivo van Doorn | 5a6e599 | 2008-05-10 13:41:32 +0200 | [diff] [blame] | 156 | 			    enum rt2x00_dump_type type, struct sk_buff *skb) | 
| Ivo van Doorn | 4d8dd66 | 2007-11-27 21:49:29 +0100 | [diff] [blame] | 157 | { | 
 | 158 | 	struct rt2x00debug_intf *intf = rt2x00dev->debugfs_intf; | 
| Gertjan van Wingerde | 878f704 | 2010-05-11 23:51:37 +0200 | [diff] [blame] | 159 | 	struct skb_frame_desc *skbdesc = get_skb_frame_desc(skb); | 
| Ivo van Doorn | 4d8dd66 | 2007-11-27 21:49:29 +0100 | [diff] [blame] | 160 | 	struct sk_buff *skbcopy; | 
 | 161 | 	struct rt2x00dump_hdr *dump_hdr; | 
 | 162 | 	struct timeval timestamp; | 
| Gertjan van Wingerde | fd76f14 | 2010-05-11 23:51:43 +0200 | [diff] [blame] | 163 | 	u32 data_len; | 
| Ivo van Doorn | 4d8dd66 | 2007-11-27 21:49:29 +0100 | [diff] [blame] | 164 |  | 
 | 165 | 	do_gettimeofday(×tamp); | 
| Ivo van Doorn | 4d8dd66 | 2007-11-27 21:49:29 +0100 | [diff] [blame] | 166 |  | 
 | 167 | 	if (!test_bit(FRAME_DUMP_FILE_OPEN, &intf->frame_dump_flags)) | 
 | 168 | 		return; | 
 | 169 |  | 
 | 170 | 	if (skb_queue_len(&intf->frame_dump_skbqueue) > 20) { | 
 | 171 | 		DEBUG(rt2x00dev, "txrx dump queue length exceeded.\n"); | 
 | 172 | 		return; | 
 | 173 | 	} | 
 | 174 |  | 
| Gertjan van Wingerde | fd76f14 | 2010-05-11 23:51:43 +0200 | [diff] [blame] | 175 | 	data_len = skb->len; | 
 | 176 | 	if (skbdesc->flags & SKBDESC_DESC_IN_SKB) | 
 | 177 | 		data_len -= skbdesc->desc_len; | 
 | 178 |  | 
 | 179 | 	skbcopy = alloc_skb(sizeof(*dump_hdr) + skbdesc->desc_len + data_len, | 
| Ivo van Doorn | 4d8dd66 | 2007-11-27 21:49:29 +0100 | [diff] [blame] | 180 | 			    GFP_ATOMIC); | 
 | 181 | 	if (!skbcopy) { | 
 | 182 | 		DEBUG(rt2x00dev, "Failed to copy skb for dump.\n"); | 
 | 183 | 		return; | 
 | 184 | 	} | 
 | 185 |  | 
 | 186 | 	dump_hdr = (struct rt2x00dump_hdr *)skb_put(skbcopy, sizeof(*dump_hdr)); | 
 | 187 | 	dump_hdr->version = cpu_to_le32(DUMP_HEADER_VERSION); | 
 | 188 | 	dump_hdr->header_length = cpu_to_le32(sizeof(*dump_hdr)); | 
| Gertjan van Wingerde | 878f704 | 2010-05-11 23:51:37 +0200 | [diff] [blame] | 189 | 	dump_hdr->desc_length = cpu_to_le32(skbdesc->desc_len); | 
| Gertjan van Wingerde | fd76f14 | 2010-05-11 23:51:43 +0200 | [diff] [blame] | 190 | 	dump_hdr->data_length = cpu_to_le32(data_len); | 
| Ivo van Doorn | 4d8dd66 | 2007-11-27 21:49:29 +0100 | [diff] [blame] | 191 | 	dump_hdr->chip_rt = cpu_to_le16(rt2x00dev->chip.rt); | 
 | 192 | 	dump_hdr->chip_rf = cpu_to_le16(rt2x00dev->chip.rf); | 
| Gertjan van Wingerde | 49e721e | 2010-02-13 20:55:49 +0100 | [diff] [blame] | 193 | 	dump_hdr->chip_rev = cpu_to_le16(rt2x00dev->chip.rev); | 
| Ivo van Doorn | 5a6e599 | 2008-05-10 13:41:32 +0200 | [diff] [blame] | 194 | 	dump_hdr->type = cpu_to_le16(type); | 
| Gertjan van Wingerde | 878f704 | 2010-05-11 23:51:37 +0200 | [diff] [blame] | 195 | 	dump_hdr->queue_index = skbdesc->entry->queue->qid; | 
 | 196 | 	dump_hdr->entry_index = skbdesc->entry->entry_idx; | 
| Ivo van Doorn | 4d8dd66 | 2007-11-27 21:49:29 +0100 | [diff] [blame] | 197 | 	dump_hdr->timestamp_sec = cpu_to_le32(timestamp.tv_sec); | 
 | 198 | 	dump_hdr->timestamp_usec = cpu_to_le32(timestamp.tv_usec); | 
 | 199 |  | 
| Gertjan van Wingerde | fd76f14 | 2010-05-11 23:51:43 +0200 | [diff] [blame] | 200 | 	if (!(skbdesc->flags & SKBDESC_DESC_IN_SKB)) | 
 | 201 | 		memcpy(skb_put(skbcopy, skbdesc->desc_len), skbdesc->desc, | 
 | 202 | 		       skbdesc->desc_len); | 
| Gertjan van Wingerde | d56d453 | 2008-06-06 22:54:08 +0200 | [diff] [blame] | 203 | 	memcpy(skb_put(skbcopy, skb->len), skb->data, skb->len); | 
| Ivo van Doorn | 4d8dd66 | 2007-11-27 21:49:29 +0100 | [diff] [blame] | 204 |  | 
 | 205 | 	skb_queue_tail(&intf->frame_dump_skbqueue, skbcopy); | 
 | 206 | 	wake_up_interruptible(&intf->frame_dump_waitqueue); | 
 | 207 |  | 
 | 208 | 	/* | 
 | 209 | 	 * Verify that the file has not been closed while we were working. | 
 | 210 | 	 */ | 
 | 211 | 	if (!test_bit(FRAME_DUMP_FILE_OPEN, &intf->frame_dump_flags)) | 
 | 212 | 		skb_queue_purge(&intf->frame_dump_skbqueue); | 
 | 213 | } | 
 | 214 |  | 
| Ivo van Doorn | 95ea362 | 2007-09-25 17:57:13 -0700 | [diff] [blame] | 215 | static int rt2x00debug_file_open(struct inode *inode, struct file *file) | 
 | 216 | { | 
 | 217 | 	struct rt2x00debug_intf *intf = inode->i_private; | 
 | 218 |  | 
 | 219 | 	file->private_data = inode->i_private; | 
 | 220 |  | 
 | 221 | 	if (!try_module_get(intf->debug->owner)) | 
 | 222 | 		return -EBUSY; | 
 | 223 |  | 
 | 224 | 	return 0; | 
 | 225 | } | 
 | 226 |  | 
 | 227 | static int rt2x00debug_file_release(struct inode *inode, struct file *file) | 
 | 228 | { | 
 | 229 | 	struct rt2x00debug_intf *intf = file->private_data; | 
 | 230 |  | 
 | 231 | 	module_put(intf->debug->owner); | 
 | 232 |  | 
 | 233 | 	return 0; | 
 | 234 | } | 
 | 235 |  | 
| Ivo van Doorn | 181d690 | 2008-02-05 16:42:23 -0500 | [diff] [blame] | 236 | static int rt2x00debug_open_queue_dump(struct inode *inode, struct file *file) | 
| Ivo van Doorn | 4d8dd66 | 2007-11-27 21:49:29 +0100 | [diff] [blame] | 237 | { | 
 | 238 | 	struct rt2x00debug_intf *intf = inode->i_private; | 
 | 239 | 	int retval; | 
 | 240 |  | 
 | 241 | 	retval = rt2x00debug_file_open(inode, file); | 
 | 242 | 	if (retval) | 
 | 243 | 		return retval; | 
 | 244 |  | 
 | 245 | 	if (test_and_set_bit(FRAME_DUMP_FILE_OPEN, &intf->frame_dump_flags)) { | 
 | 246 | 		rt2x00debug_file_release(inode, file); | 
 | 247 | 		return -EBUSY; | 
 | 248 | 	} | 
 | 249 |  | 
 | 250 | 	return 0; | 
 | 251 | } | 
 | 252 |  | 
| Ivo van Doorn | 181d690 | 2008-02-05 16:42:23 -0500 | [diff] [blame] | 253 | static int rt2x00debug_release_queue_dump(struct inode *inode, struct file *file) | 
| Ivo van Doorn | 4d8dd66 | 2007-11-27 21:49:29 +0100 | [diff] [blame] | 254 | { | 
 | 255 | 	struct rt2x00debug_intf *intf = inode->i_private; | 
 | 256 |  | 
 | 257 | 	skb_queue_purge(&intf->frame_dump_skbqueue); | 
 | 258 |  | 
 | 259 | 	clear_bit(FRAME_DUMP_FILE_OPEN, &intf->frame_dump_flags); | 
 | 260 |  | 
 | 261 | 	return rt2x00debug_file_release(inode, file); | 
 | 262 | } | 
 | 263 |  | 
| Ivo van Doorn | 181d690 | 2008-02-05 16:42:23 -0500 | [diff] [blame] | 264 | static ssize_t rt2x00debug_read_queue_dump(struct file *file, | 
 | 265 | 					   char __user *buf, | 
 | 266 | 					   size_t length, | 
 | 267 | 					   loff_t *offset) | 
| Ivo van Doorn | 4d8dd66 | 2007-11-27 21:49:29 +0100 | [diff] [blame] | 268 | { | 
 | 269 | 	struct rt2x00debug_intf *intf = file->private_data; | 
 | 270 | 	struct sk_buff *skb; | 
 | 271 | 	size_t status; | 
 | 272 | 	int retval; | 
 | 273 |  | 
 | 274 | 	if (file->f_flags & O_NONBLOCK) | 
 | 275 | 		return -EAGAIN; | 
 | 276 |  | 
 | 277 | 	retval = | 
 | 278 | 	    wait_event_interruptible(intf->frame_dump_waitqueue, | 
 | 279 | 				     (skb = | 
 | 280 | 				     skb_dequeue(&intf->frame_dump_skbqueue))); | 
 | 281 | 	if (retval) | 
 | 282 | 		return retval; | 
 | 283 |  | 
 | 284 | 	status = min((size_t)skb->len, length); | 
 | 285 | 	if (copy_to_user(buf, skb->data, status)) { | 
 | 286 | 		status = -EFAULT; | 
 | 287 | 		goto exit; | 
 | 288 | 	} | 
 | 289 |  | 
 | 290 | 	*offset += status; | 
 | 291 |  | 
 | 292 | exit: | 
 | 293 | 	kfree_skb(skb); | 
 | 294 |  | 
 | 295 | 	return status; | 
 | 296 | } | 
 | 297 |  | 
| Ivo van Doorn | 181d690 | 2008-02-05 16:42:23 -0500 | [diff] [blame] | 298 | static unsigned int rt2x00debug_poll_queue_dump(struct file *file, | 
| John Daiker | 5588751 | 2008-10-17 12:16:17 -0700 | [diff] [blame] | 299 | 						poll_table *wait) | 
| Ivo van Doorn | 4d8dd66 | 2007-11-27 21:49:29 +0100 | [diff] [blame] | 300 | { | 
 | 301 | 	struct rt2x00debug_intf *intf = file->private_data; | 
 | 302 |  | 
 | 303 | 	poll_wait(file, &intf->frame_dump_waitqueue, wait); | 
 | 304 |  | 
 | 305 | 	if (!skb_queue_empty(&intf->frame_dump_skbqueue)) | 
 | 306 | 		return POLLOUT | POLLWRNORM; | 
 | 307 |  | 
 | 308 | 	return 0; | 
 | 309 | } | 
 | 310 |  | 
| Ivo van Doorn | 181d690 | 2008-02-05 16:42:23 -0500 | [diff] [blame] | 311 | static const struct file_operations rt2x00debug_fop_queue_dump = { | 
| Ivo van Doorn | 4d8dd66 | 2007-11-27 21:49:29 +0100 | [diff] [blame] | 312 | 	.owner		= THIS_MODULE, | 
| Ivo van Doorn | 181d690 | 2008-02-05 16:42:23 -0500 | [diff] [blame] | 313 | 	.read		= rt2x00debug_read_queue_dump, | 
 | 314 | 	.poll		= rt2x00debug_poll_queue_dump, | 
 | 315 | 	.open		= rt2x00debug_open_queue_dump, | 
 | 316 | 	.release	= rt2x00debug_release_queue_dump, | 
| Ivo van Doorn | 4d8dd66 | 2007-11-27 21:49:29 +0100 | [diff] [blame] | 317 | }; | 
 | 318 |  | 
| Ivo van Doorn | 68598d2 | 2008-02-10 22:50:28 +0100 | [diff] [blame] | 319 | static ssize_t rt2x00debug_read_queue_stats(struct file *file, | 
 | 320 | 					    char __user *buf, | 
 | 321 | 					    size_t length, | 
 | 322 | 					    loff_t *offset) | 
 | 323 | { | 
 | 324 | 	struct rt2x00debug_intf *intf = file->private_data; | 
 | 325 | 	struct data_queue *queue; | 
| Ivo van Doorn | 5f46c4d | 2008-03-09 22:44:30 +0100 | [diff] [blame] | 326 | 	unsigned long irqflags; | 
| Ivo van Doorn | 68598d2 | 2008-02-10 22:50:28 +0100 | [diff] [blame] | 327 | 	unsigned int lines = 1 + intf->rt2x00dev->data_queues; | 
 | 328 | 	size_t size; | 
 | 329 | 	char *data; | 
 | 330 | 	char *temp; | 
 | 331 |  | 
 | 332 | 	if (*offset) | 
 | 333 | 		return 0; | 
 | 334 |  | 
 | 335 | 	data = kzalloc(lines * MAX_LINE_LENGTH, GFP_KERNEL); | 
 | 336 | 	if (!data) | 
 | 337 | 		return -ENOMEM; | 
 | 338 |  | 
 | 339 | 	temp = data + | 
 | 340 | 	    sprintf(data, "qid\tcount\tlimit\tlength\tindex\tdone\tcrypto\n"); | 
 | 341 |  | 
 | 342 | 	queue_for_each(intf->rt2x00dev, queue) { | 
| Ivo van Doorn | 5f46c4d | 2008-03-09 22:44:30 +0100 | [diff] [blame] | 343 | 		spin_lock_irqsave(&queue->lock, irqflags); | 
| Ivo van Doorn | 68598d2 | 2008-02-10 22:50:28 +0100 | [diff] [blame] | 344 |  | 
 | 345 | 		temp += sprintf(temp, "%d\t%d\t%d\t%d\t%d\t%d\t%d\n", queue->qid, | 
 | 346 | 				queue->count, queue->limit, queue->length, | 
 | 347 | 				queue->index[Q_INDEX], | 
 | 348 | 				queue->index[Q_INDEX_DONE], | 
 | 349 | 				queue->index[Q_INDEX_CRYPTO]); | 
 | 350 |  | 
| Ivo van Doorn | 5f46c4d | 2008-03-09 22:44:30 +0100 | [diff] [blame] | 351 | 		spin_unlock_irqrestore(&queue->lock, irqflags); | 
| Ivo van Doorn | 68598d2 | 2008-02-10 22:50:28 +0100 | [diff] [blame] | 352 | 	} | 
 | 353 |  | 
 | 354 | 	size = strlen(data); | 
 | 355 | 	size = min(size, length); | 
 | 356 |  | 
 | 357 | 	if (copy_to_user(buf, data, size)) { | 
 | 358 | 		kfree(data); | 
 | 359 | 		return -EFAULT; | 
 | 360 | 	} | 
 | 361 |  | 
 | 362 | 	kfree(data); | 
 | 363 |  | 
 | 364 | 	*offset += size; | 
 | 365 | 	return size; | 
 | 366 | } | 
 | 367 |  | 
 | 368 | static const struct file_operations rt2x00debug_fop_queue_stats = { | 
 | 369 | 	.owner		= THIS_MODULE, | 
 | 370 | 	.read		= rt2x00debug_read_queue_stats, | 
 | 371 | 	.open		= rt2x00debug_file_open, | 
 | 372 | 	.release	= rt2x00debug_file_release, | 
 | 373 | }; | 
 | 374 |  | 
| Ivo van Doorn | 2bb057d | 2008-08-04 16:37:44 +0200 | [diff] [blame] | 375 | #ifdef CONFIG_RT2X00_LIB_CRYPTO | 
 | 376 | static ssize_t rt2x00debug_read_crypto_stats(struct file *file, | 
 | 377 | 					     char __user *buf, | 
 | 378 | 					     size_t length, | 
 | 379 | 					     loff_t *offset) | 
 | 380 | { | 
 | 381 | 	struct rt2x00debug_intf *intf = file->private_data; | 
 | 382 | 	char *name[] = { "WEP64", "WEP128", "TKIP", "AES" }; | 
 | 383 | 	char *data; | 
 | 384 | 	char *temp; | 
 | 385 | 	size_t size; | 
 | 386 | 	unsigned int i; | 
 | 387 |  | 
 | 388 | 	if (*offset) | 
 | 389 | 		return 0; | 
 | 390 |  | 
| John Daiker | 5588751 | 2008-10-17 12:16:17 -0700 | [diff] [blame] | 391 | 	data = kzalloc((1 + CIPHER_MAX) * MAX_LINE_LENGTH, GFP_KERNEL); | 
| Ivo van Doorn | 2bb057d | 2008-08-04 16:37:44 +0200 | [diff] [blame] | 392 | 	if (!data) | 
 | 393 | 		return -ENOMEM; | 
 | 394 |  | 
 | 395 | 	temp = data; | 
 | 396 | 	temp += sprintf(data, "cipher\tsuccess\ticv err\tmic err\tkey err\n"); | 
 | 397 |  | 
 | 398 | 	for (i = 0; i < CIPHER_MAX; i++) { | 
 | 399 | 		temp += sprintf(temp, "%s\t%lu\t%lu\t%lu\t%lu\n", name[i], | 
 | 400 | 				intf->crypto_stats[i].success, | 
 | 401 | 				intf->crypto_stats[i].icv_error, | 
 | 402 | 				intf->crypto_stats[i].mic_error, | 
 | 403 | 				intf->crypto_stats[i].key_error); | 
 | 404 | 	} | 
 | 405 |  | 
 | 406 | 	size = strlen(data); | 
 | 407 | 	size = min(size, length); | 
 | 408 |  | 
 | 409 | 	if (copy_to_user(buf, data, size)) { | 
 | 410 | 		kfree(data); | 
 | 411 | 		return -EFAULT; | 
 | 412 | 	} | 
 | 413 |  | 
 | 414 | 	kfree(data); | 
 | 415 |  | 
 | 416 | 	*offset += size; | 
 | 417 | 	return size; | 
 | 418 | } | 
 | 419 |  | 
 | 420 | static const struct file_operations rt2x00debug_fop_crypto_stats = { | 
 | 421 | 	.owner		= THIS_MODULE, | 
 | 422 | 	.read		= rt2x00debug_read_crypto_stats, | 
 | 423 | 	.open		= rt2x00debug_file_open, | 
 | 424 | 	.release	= rt2x00debug_file_release, | 
 | 425 | }; | 
 | 426 | #endif | 
 | 427 |  | 
| Ivo van Doorn | 95ea362 | 2007-09-25 17:57:13 -0700 | [diff] [blame] | 428 | #define RT2X00DEBUGFS_OPS_READ(__name, __format, __type)	\ | 
 | 429 | static ssize_t rt2x00debug_read_##__name(struct file *file,	\ | 
 | 430 | 					 char __user *buf,	\ | 
 | 431 | 					 size_t length,		\ | 
 | 432 | 					 loff_t *offset)	\ | 
 | 433 | {								\ | 
| Ivo van Doorn | 91921a4 | 2007-11-27 21:48:16 +0100 | [diff] [blame] | 434 | 	struct rt2x00debug_intf *intf = file->private_data;	\ | 
| Ivo van Doorn | 95ea362 | 2007-09-25 17:57:13 -0700 | [diff] [blame] | 435 | 	const struct rt2x00debug *debug = intf->debug;		\ | 
 | 436 | 	char line[16];						\ | 
 | 437 | 	size_t size;						\ | 
| Ivo van Doorn | 743b97c | 2008-10-29 19:41:03 +0100 | [diff] [blame] | 438 | 	unsigned int index = intf->offset_##__name;		\ | 
| Ivo van Doorn | 95ea362 | 2007-09-25 17:57:13 -0700 | [diff] [blame] | 439 | 	__type value;						\ | 
 | 440 | 								\ | 
 | 441 | 	if (*offset)						\ | 
 | 442 | 		return 0;					\ | 
 | 443 | 								\ | 
| Ivo van Doorn | 743b97c | 2008-10-29 19:41:03 +0100 | [diff] [blame] | 444 | 	if (index >= debug->__name.word_count)			\ | 
| Ivo van Doorn | 95ea362 | 2007-09-25 17:57:13 -0700 | [diff] [blame] | 445 | 		return -EINVAL;					\ | 
 | 446 | 								\ | 
| Ivo van Doorn | abd2fdb | 2009-02-17 14:04:29 +0100 | [diff] [blame] | 447 | 	index += (debug->__name.word_base /			\ | 
 | 448 | 		  debug->__name.word_size);			\ | 
 | 449 | 								\ | 
| Ivo van Doorn | 743b97c | 2008-10-29 19:41:03 +0100 | [diff] [blame] | 450 | 	if (debug->__name.flags & RT2X00DEBUGFS_OFFSET)		\ | 
 | 451 | 		index *= debug->__name.word_size;		\ | 
 | 452 | 								\ | 
| Ivo van Doorn | 743b97c | 2008-10-29 19:41:03 +0100 | [diff] [blame] | 453 | 	debug->__name.read(intf->rt2x00dev, index, &value);	\ | 
| Ivo van Doorn | 95ea362 | 2007-09-25 17:57:13 -0700 | [diff] [blame] | 454 | 								\ | 
 | 455 | 	size = sprintf(line, __format, value);			\ | 
 | 456 | 								\ | 
 | 457 | 	if (copy_to_user(buf, line, size))			\ | 
 | 458 | 		return -EFAULT;					\ | 
 | 459 | 								\ | 
 | 460 | 	*offset += size;					\ | 
 | 461 | 	return size;						\ | 
 | 462 | } | 
 | 463 |  | 
 | 464 | #define RT2X00DEBUGFS_OPS_WRITE(__name, __type)			\ | 
 | 465 | static ssize_t rt2x00debug_write_##__name(struct file *file,	\ | 
 | 466 | 					  const char __user *buf,\ | 
 | 467 | 					  size_t length,	\ | 
 | 468 | 					  loff_t *offset)	\ | 
 | 469 | {								\ | 
| Ivo van Doorn | 91921a4 | 2007-11-27 21:48:16 +0100 | [diff] [blame] | 470 | 	struct rt2x00debug_intf *intf = file->private_data;	\ | 
| Ivo van Doorn | 95ea362 | 2007-09-25 17:57:13 -0700 | [diff] [blame] | 471 | 	const struct rt2x00debug *debug = intf->debug;		\ | 
 | 472 | 	char line[16];						\ | 
 | 473 | 	size_t size;						\ | 
| Ivo van Doorn | 743b97c | 2008-10-29 19:41:03 +0100 | [diff] [blame] | 474 | 	unsigned int index = intf->offset_##__name;		\ | 
| Ivo van Doorn | 95ea362 | 2007-09-25 17:57:13 -0700 | [diff] [blame] | 475 | 	__type value;						\ | 
 | 476 | 								\ | 
 | 477 | 	if (*offset)						\ | 
 | 478 | 		return 0;					\ | 
 | 479 | 								\ | 
| Ivo van Doorn | 743b97c | 2008-10-29 19:41:03 +0100 | [diff] [blame] | 480 | 	if (index >= debug->__name.word_count)			\ | 
| Ivo van Doorn | 95ea362 | 2007-09-25 17:57:13 -0700 | [diff] [blame] | 481 | 		return -EINVAL;					\ | 
 | 482 | 								\ | 
 | 483 | 	if (copy_from_user(line, buf, length))			\ | 
 | 484 | 		return -EFAULT;					\ | 
 | 485 | 								\ | 
 | 486 | 	size = strlen(line);					\ | 
 | 487 | 	value = simple_strtoul(line, NULL, 0);			\ | 
 | 488 | 								\ | 
| Ivo van Doorn | abd2fdb | 2009-02-17 14:04:29 +0100 | [diff] [blame] | 489 | 	index += (debug->__name.word_base /			\ | 
 | 490 | 		  debug->__name.word_size);			\ | 
 | 491 | 								\ | 
| Ivo van Doorn | 743b97c | 2008-10-29 19:41:03 +0100 | [diff] [blame] | 492 | 	if (debug->__name.flags & RT2X00DEBUGFS_OFFSET)		\ | 
 | 493 | 		index *= debug->__name.word_size;		\ | 
 | 494 | 								\ | 
| Ivo van Doorn | 743b97c | 2008-10-29 19:41:03 +0100 | [diff] [blame] | 495 | 	debug->__name.write(intf->rt2x00dev, index, value);	\ | 
| Ivo van Doorn | 95ea362 | 2007-09-25 17:57:13 -0700 | [diff] [blame] | 496 | 								\ | 
 | 497 | 	*offset += size;					\ | 
 | 498 | 	return size;						\ | 
 | 499 | } | 
 | 500 |  | 
 | 501 | #define RT2X00DEBUGFS_OPS(__name, __format, __type)		\ | 
 | 502 | RT2X00DEBUGFS_OPS_READ(__name, __format, __type);		\ | 
 | 503 | RT2X00DEBUGFS_OPS_WRITE(__name, __type);			\ | 
 | 504 | 								\ | 
 | 505 | static const struct file_operations rt2x00debug_fop_##__name = {\ | 
 | 506 | 	.owner		= THIS_MODULE,				\ | 
 | 507 | 	.read		= rt2x00debug_read_##__name,		\ | 
 | 508 | 	.write		= rt2x00debug_write_##__name,		\ | 
 | 509 | 	.open		= rt2x00debug_file_open,		\ | 
 | 510 | 	.release	= rt2x00debug_file_release,		\ | 
 | 511 | }; | 
 | 512 |  | 
 | 513 | RT2X00DEBUGFS_OPS(csr, "0x%.8x\n", u32); | 
 | 514 | RT2X00DEBUGFS_OPS(eeprom, "0x%.4x\n", u16); | 
 | 515 | RT2X00DEBUGFS_OPS(bbp, "0x%.2x\n", u8); | 
 | 516 | RT2X00DEBUGFS_OPS(rf, "0x%.8x\n", u32); | 
 | 517 |  | 
| Ivo van Doorn | 643b252 | 2007-09-25 20:13:51 +0200 | [diff] [blame] | 518 | static ssize_t rt2x00debug_read_dev_flags(struct file *file, | 
 | 519 | 					  char __user *buf, | 
 | 520 | 					  size_t length, | 
 | 521 | 					  loff_t *offset) | 
 | 522 | { | 
 | 523 | 	struct rt2x00debug_intf *intf =	file->private_data; | 
 | 524 | 	char line[16]; | 
 | 525 | 	size_t size; | 
 | 526 |  | 
 | 527 | 	if (*offset) | 
 | 528 | 		return 0; | 
 | 529 |  | 
 | 530 | 	size = sprintf(line, "0x%.8x\n", (unsigned int)intf->rt2x00dev->flags); | 
 | 531 |  | 
 | 532 | 	if (copy_to_user(buf, line, size)) | 
 | 533 | 		return -EFAULT; | 
 | 534 |  | 
 | 535 | 	*offset += size; | 
 | 536 | 	return size; | 
 | 537 | } | 
 | 538 |  | 
 | 539 | static const struct file_operations rt2x00debug_fop_dev_flags = { | 
 | 540 | 	.owner		= THIS_MODULE, | 
 | 541 | 	.read		= rt2x00debug_read_dev_flags, | 
 | 542 | 	.open		= rt2x00debug_file_open, | 
 | 543 | 	.release	= rt2x00debug_file_release, | 
 | 544 | }; | 
 | 545 |  | 
| Ivo van Doorn | 95ea362 | 2007-09-25 17:57:13 -0700 | [diff] [blame] | 546 | static struct dentry *rt2x00debug_create_file_driver(const char *name, | 
 | 547 | 						     struct rt2x00debug_intf | 
 | 548 | 						     *intf, | 
 | 549 | 						     struct debugfs_blob_wrapper | 
 | 550 | 						     *blob) | 
 | 551 | { | 
 | 552 | 	char *data; | 
 | 553 |  | 
| Ivo van Doorn | 68598d2 | 2008-02-10 22:50:28 +0100 | [diff] [blame] | 554 | 	data = kzalloc(3 * MAX_LINE_LENGTH, GFP_KERNEL); | 
| Ivo van Doorn | 95ea362 | 2007-09-25 17:57:13 -0700 | [diff] [blame] | 555 | 	if (!data) | 
 | 556 | 		return NULL; | 
 | 557 |  | 
 | 558 | 	blob->data = data; | 
| Ivo van Doorn | 860559f | 2009-03-03 18:14:18 +0100 | [diff] [blame] | 559 | 	data += sprintf(data, "driver:\t%s\n", intf->rt2x00dev->ops->name); | 
 | 560 | 	data += sprintf(data, "version:\t%s\n", DRV_VERSION); | 
 | 561 | 	data += sprintf(data, "compiled:\t%s %s\n", __DATE__, __TIME__); | 
| Ivo van Doorn | 95ea362 | 2007-09-25 17:57:13 -0700 | [diff] [blame] | 562 | 	blob->size = strlen(blob->data); | 
 | 563 |  | 
| Ivo van Doorn | d2b6907 | 2008-07-27 15:06:05 +0200 | [diff] [blame] | 564 | 	return debugfs_create_blob(name, S_IRUSR, intf->driver_folder, blob); | 
| Ivo van Doorn | 95ea362 | 2007-09-25 17:57:13 -0700 | [diff] [blame] | 565 | } | 
 | 566 |  | 
 | 567 | static struct dentry *rt2x00debug_create_file_chipset(const char *name, | 
 | 568 | 						      struct rt2x00debug_intf | 
 | 569 | 						      *intf, | 
 | 570 | 						      struct | 
 | 571 | 						      debugfs_blob_wrapper | 
 | 572 | 						      *blob) | 
 | 573 | { | 
 | 574 | 	const struct rt2x00debug *debug = intf->debug; | 
 | 575 | 	char *data; | 
 | 576 |  | 
| Ivo van Doorn | 68598d2 | 2008-02-10 22:50:28 +0100 | [diff] [blame] | 577 | 	data = kzalloc(8 * MAX_LINE_LENGTH, GFP_KERNEL); | 
| Ivo van Doorn | 95ea362 | 2007-09-25 17:57:13 -0700 | [diff] [blame] | 578 | 	if (!data) | 
 | 579 | 		return NULL; | 
 | 580 |  | 
| Ivo van Doorn | 3e34c6d | 2008-01-06 23:38:10 +0100 | [diff] [blame] | 581 | 	blob->data = data; | 
| Ivo van Doorn | 860559f | 2009-03-03 18:14:18 +0100 | [diff] [blame] | 582 | 	data += sprintf(data, "rt chip:\t%04x\n", intf->rt2x00dev->chip.rt); | 
 | 583 | 	data += sprintf(data, "rf chip:\t%04x\n", intf->rt2x00dev->chip.rf); | 
| Gertjan van Wingerde | 49e721e | 2010-02-13 20:55:49 +0100 | [diff] [blame] | 584 | 	data += sprintf(data, "revision:\t%04x\n", intf->rt2x00dev->chip.rev); | 
| Ivo van Doorn | 22c96c2 | 2007-11-27 21:48:37 +0100 | [diff] [blame] | 585 | 	data += sprintf(data, "\n"); | 
| Ivo van Doorn | 860559f | 2009-03-03 18:14:18 +0100 | [diff] [blame] | 586 | 	data += sprintf(data, "register\tbase\twords\twordsize\n"); | 
 | 587 | 	data += sprintf(data, "csr\t%d\t%d\t%d\n", | 
 | 588 | 			debug->csr.word_base, | 
 | 589 | 			debug->csr.word_count, | 
 | 590 | 			debug->csr.word_size); | 
 | 591 | 	data += sprintf(data, "eeprom\t%d\t%d\t%d\n", | 
 | 592 | 			debug->eeprom.word_base, | 
 | 593 | 			debug->eeprom.word_count, | 
 | 594 | 			debug->eeprom.word_size); | 
 | 595 | 	data += sprintf(data, "bbp\t%d\t%d\t%d\n", | 
 | 596 | 			debug->bbp.word_base, | 
 | 597 | 			debug->bbp.word_count, | 
 | 598 | 			debug->bbp.word_size); | 
 | 599 | 	data += sprintf(data, "rf\t%d\t%d\t%d\n", | 
 | 600 | 			debug->rf.word_base, | 
 | 601 | 			debug->rf.word_count, | 
 | 602 | 			debug->rf.word_size); | 
| Ivo van Doorn | 3e34c6d | 2008-01-06 23:38:10 +0100 | [diff] [blame] | 603 | 	blob->size = strlen(blob->data); | 
| Ivo van Doorn | 95ea362 | 2007-09-25 17:57:13 -0700 | [diff] [blame] | 604 |  | 
| Ivo van Doorn | d2b6907 | 2008-07-27 15:06:05 +0200 | [diff] [blame] | 605 | 	return debugfs_create_blob(name, S_IRUSR, intf->driver_folder, blob); | 
| Ivo van Doorn | 95ea362 | 2007-09-25 17:57:13 -0700 | [diff] [blame] | 606 | } | 
 | 607 |  | 
 | 608 | void rt2x00debug_register(struct rt2x00_dev *rt2x00dev) | 
 | 609 | { | 
 | 610 | 	const struct rt2x00debug *debug = rt2x00dev->ops->debugfs; | 
 | 611 | 	struct rt2x00debug_intf *intf; | 
 | 612 |  | 
 | 613 | 	intf = kzalloc(sizeof(struct rt2x00debug_intf), GFP_KERNEL); | 
 | 614 | 	if (!intf) { | 
 | 615 | 		ERROR(rt2x00dev, "Failed to allocate debug handler.\n"); | 
 | 616 | 		return; | 
 | 617 | 	} | 
 | 618 |  | 
 | 619 | 	intf->debug = debug; | 
 | 620 | 	intf->rt2x00dev = rt2x00dev; | 
 | 621 | 	rt2x00dev->debugfs_intf = intf; | 
 | 622 |  | 
 | 623 | 	intf->driver_folder = | 
 | 624 | 	    debugfs_create_dir(intf->rt2x00dev->ops->name, | 
 | 625 | 			       rt2x00dev->hw->wiphy->debugfsdir); | 
| Zhaolei | cfa3fa4 | 2008-10-22 17:07:25 +0800 | [diff] [blame] | 626 | 	if (IS_ERR(intf->driver_folder) || !intf->driver_folder) | 
| Ivo van Doorn | 95ea362 | 2007-09-25 17:57:13 -0700 | [diff] [blame] | 627 | 		goto exit; | 
 | 628 |  | 
 | 629 | 	intf->driver_entry = | 
 | 630 | 	    rt2x00debug_create_file_driver("driver", intf, &intf->driver_blob); | 
| Zhaolei | cfa3fa4 | 2008-10-22 17:07:25 +0800 | [diff] [blame] | 631 | 	if (IS_ERR(intf->driver_entry) || !intf->driver_entry) | 
| Ivo van Doorn | 95ea362 | 2007-09-25 17:57:13 -0700 | [diff] [blame] | 632 | 		goto exit; | 
 | 633 |  | 
 | 634 | 	intf->chipset_entry = | 
 | 635 | 	    rt2x00debug_create_file_chipset("chipset", | 
 | 636 | 					    intf, &intf->chipset_blob); | 
| Zhaolei | cfa3fa4 | 2008-10-22 17:07:25 +0800 | [diff] [blame] | 637 | 	if (IS_ERR(intf->chipset_entry) || !intf->chipset_entry) | 
| Ivo van Doorn | 95ea362 | 2007-09-25 17:57:13 -0700 | [diff] [blame] | 638 | 		goto exit; | 
 | 639 |  | 
| Ivo van Doorn | d2b6907 | 2008-07-27 15:06:05 +0200 | [diff] [blame] | 640 | 	intf->dev_flags = debugfs_create_file("dev_flags", S_IRUSR, | 
| Ivo van Doorn | 643b252 | 2007-09-25 20:13:51 +0200 | [diff] [blame] | 641 | 					      intf->driver_folder, intf, | 
 | 642 | 					      &rt2x00debug_fop_dev_flags); | 
| Zhaolei | cfa3fa4 | 2008-10-22 17:07:25 +0800 | [diff] [blame] | 643 | 	if (IS_ERR(intf->dev_flags) || !intf->dev_flags) | 
| Ivo van Doorn | 643b252 | 2007-09-25 20:13:51 +0200 | [diff] [blame] | 644 | 		goto exit; | 
 | 645 |  | 
| Ivo van Doorn | 91921a4 | 2007-11-27 21:48:16 +0100 | [diff] [blame] | 646 | 	intf->register_folder = | 
 | 647 | 	    debugfs_create_dir("register", intf->driver_folder); | 
| Zhaolei | cfa3fa4 | 2008-10-22 17:07:25 +0800 | [diff] [blame] | 648 | 	if (IS_ERR(intf->register_folder) || !intf->register_folder) | 
| Ivo van Doorn | 91921a4 | 2007-11-27 21:48:16 +0100 | [diff] [blame] | 649 | 		goto exit; | 
 | 650 |  | 
 | 651 | #define RT2X00DEBUGFS_CREATE_REGISTER_ENTRY(__intf, __name)	\ | 
| Ivo van Doorn | 95ea362 | 2007-09-25 17:57:13 -0700 | [diff] [blame] | 652 | ({								\ | 
 | 653 | 	(__intf)->__name##_off_entry =				\ | 
 | 654 | 	    debugfs_create_u32(__stringify(__name) "_offset",	\ | 
| Ivo van Doorn | d2b6907 | 2008-07-27 15:06:05 +0200 | [diff] [blame] | 655 | 			       S_IRUSR | S_IWUSR,		\ | 
| Ivo van Doorn | 91921a4 | 2007-11-27 21:48:16 +0100 | [diff] [blame] | 656 | 			       (__intf)->register_folder,	\ | 
| Ivo van Doorn | 95ea362 | 2007-09-25 17:57:13 -0700 | [diff] [blame] | 657 | 			       &(__intf)->offset_##__name);	\ | 
| Zhaolei | cfa3fa4 | 2008-10-22 17:07:25 +0800 | [diff] [blame] | 658 | 	if (IS_ERR((__intf)->__name##_off_entry)		\ | 
 | 659 | 			|| !(__intf)->__name##_off_entry)	\ | 
| Ivo van Doorn | 95ea362 | 2007-09-25 17:57:13 -0700 | [diff] [blame] | 660 | 		goto exit;					\ | 
 | 661 | 								\ | 
 | 662 | 	(__intf)->__name##_val_entry =				\ | 
 | 663 | 	    debugfs_create_file(__stringify(__name) "_value",	\ | 
| Ivo van Doorn | d2b6907 | 2008-07-27 15:06:05 +0200 | [diff] [blame] | 664 | 				S_IRUSR | S_IWUSR,		\ | 
| Ivo van Doorn | 91921a4 | 2007-11-27 21:48:16 +0100 | [diff] [blame] | 665 | 				(__intf)->register_folder,	\ | 
| Ivo van Doorn | 95ea362 | 2007-09-25 17:57:13 -0700 | [diff] [blame] | 666 | 				(__intf), &rt2x00debug_fop_##__name);\ | 
| Zhaolei | cfa3fa4 | 2008-10-22 17:07:25 +0800 | [diff] [blame] | 667 | 	if (IS_ERR((__intf)->__name##_val_entry)		\ | 
 | 668 | 			|| !(__intf)->__name##_val_entry)	\ | 
| Ivo van Doorn | 95ea362 | 2007-09-25 17:57:13 -0700 | [diff] [blame] | 669 | 		goto exit;					\ | 
 | 670 | }) | 
 | 671 |  | 
| Ivo van Doorn | 91921a4 | 2007-11-27 21:48:16 +0100 | [diff] [blame] | 672 | 	RT2X00DEBUGFS_CREATE_REGISTER_ENTRY(intf, csr); | 
 | 673 | 	RT2X00DEBUGFS_CREATE_REGISTER_ENTRY(intf, eeprom); | 
 | 674 | 	RT2X00DEBUGFS_CREATE_REGISTER_ENTRY(intf, bbp); | 
 | 675 | 	RT2X00DEBUGFS_CREATE_REGISTER_ENTRY(intf, rf); | 
| Ivo van Doorn | 95ea362 | 2007-09-25 17:57:13 -0700 | [diff] [blame] | 676 |  | 
| Ivo van Doorn | 91921a4 | 2007-11-27 21:48:16 +0100 | [diff] [blame] | 677 | #undef RT2X00DEBUGFS_CREATE_REGISTER_ENTRY | 
| Ivo van Doorn | 95ea362 | 2007-09-25 17:57:13 -0700 | [diff] [blame] | 678 |  | 
| Ivo van Doorn | 68598d2 | 2008-02-10 22:50:28 +0100 | [diff] [blame] | 679 | 	intf->queue_folder = | 
 | 680 | 	    debugfs_create_dir("queue", intf->driver_folder); | 
| Zhaolei | cfa3fa4 | 2008-10-22 17:07:25 +0800 | [diff] [blame] | 681 | 	if (IS_ERR(intf->queue_folder) || !intf->queue_folder) | 
| Ivo van Doorn | 4d8dd66 | 2007-11-27 21:49:29 +0100 | [diff] [blame] | 682 | 		goto exit; | 
 | 683 |  | 
| Ivo van Doorn | 68598d2 | 2008-02-10 22:50:28 +0100 | [diff] [blame] | 684 | 	intf->queue_frame_dump_entry = | 
| Ivo van Doorn | d2b6907 | 2008-07-27 15:06:05 +0200 | [diff] [blame] | 685 | 	    debugfs_create_file("dump", S_IRUSR, intf->queue_folder, | 
| Ivo van Doorn | 181d690 | 2008-02-05 16:42:23 -0500 | [diff] [blame] | 686 | 				intf, &rt2x00debug_fop_queue_dump); | 
| Zhaolei | cfa3fa4 | 2008-10-22 17:07:25 +0800 | [diff] [blame] | 687 | 	if (IS_ERR(intf->queue_frame_dump_entry) | 
 | 688 | 		|| !intf->queue_frame_dump_entry) | 
| Ivo van Doorn | 4d8dd66 | 2007-11-27 21:49:29 +0100 | [diff] [blame] | 689 | 		goto exit; | 
 | 690 |  | 
 | 691 | 	skb_queue_head_init(&intf->frame_dump_skbqueue); | 
 | 692 | 	init_waitqueue_head(&intf->frame_dump_waitqueue); | 
 | 693 |  | 
| Ivo van Doorn | 68598d2 | 2008-02-10 22:50:28 +0100 | [diff] [blame] | 694 | 	intf->queue_stats_entry = | 
| Ivo van Doorn | d2b6907 | 2008-07-27 15:06:05 +0200 | [diff] [blame] | 695 | 	    debugfs_create_file("queue", S_IRUSR, intf->queue_folder, | 
| Ivo van Doorn | 68598d2 | 2008-02-10 22:50:28 +0100 | [diff] [blame] | 696 | 				intf, &rt2x00debug_fop_queue_stats); | 
 | 697 |  | 
| Ivo van Doorn | 2bb057d | 2008-08-04 16:37:44 +0200 | [diff] [blame] | 698 | #ifdef CONFIG_RT2X00_LIB_CRYPTO | 
 | 699 | 	if (test_bit(CONFIG_SUPPORT_HW_CRYPTO, &rt2x00dev->flags)) | 
 | 700 | 		intf->crypto_stats_entry = | 
 | 701 | 		    debugfs_create_file("crypto", S_IRUGO, intf->queue_folder, | 
 | 702 | 					intf, &rt2x00debug_fop_crypto_stats); | 
 | 703 | #endif | 
 | 704 |  | 
| Ivo van Doorn | 95ea362 | 2007-09-25 17:57:13 -0700 | [diff] [blame] | 705 | 	return; | 
 | 706 |  | 
 | 707 | exit: | 
 | 708 | 	rt2x00debug_deregister(rt2x00dev); | 
 | 709 | 	ERROR(rt2x00dev, "Failed to register debug handler.\n"); | 
| Ivo van Doorn | 95ea362 | 2007-09-25 17:57:13 -0700 | [diff] [blame] | 710 | } | 
 | 711 |  | 
 | 712 | void rt2x00debug_deregister(struct rt2x00_dev *rt2x00dev) | 
 | 713 | { | 
| Ivo van Doorn | 4d8dd66 | 2007-11-27 21:49:29 +0100 | [diff] [blame] | 714 | 	struct rt2x00debug_intf *intf = rt2x00dev->debugfs_intf; | 
| Ivo van Doorn | 95ea362 | 2007-09-25 17:57:13 -0700 | [diff] [blame] | 715 |  | 
 | 716 | 	if (unlikely(!intf)) | 
 | 717 | 		return; | 
 | 718 |  | 
| Ivo van Doorn | 4d8dd66 | 2007-11-27 21:49:29 +0100 | [diff] [blame] | 719 | 	skb_queue_purge(&intf->frame_dump_skbqueue); | 
 | 720 |  | 
| Ivo van Doorn | 2bb057d | 2008-08-04 16:37:44 +0200 | [diff] [blame] | 721 | #ifdef CONFIG_RT2X00_LIB_CRYPTO | 
 | 722 | 	debugfs_remove(intf->crypto_stats_entry); | 
 | 723 | #endif | 
| Ivo van Doorn | 68598d2 | 2008-02-10 22:50:28 +0100 | [diff] [blame] | 724 | 	debugfs_remove(intf->queue_stats_entry); | 
 | 725 | 	debugfs_remove(intf->queue_frame_dump_entry); | 
 | 726 | 	debugfs_remove(intf->queue_folder); | 
| Ivo van Doorn | 95ea362 | 2007-09-25 17:57:13 -0700 | [diff] [blame] | 727 | 	debugfs_remove(intf->rf_val_entry); | 
 | 728 | 	debugfs_remove(intf->rf_off_entry); | 
 | 729 | 	debugfs_remove(intf->bbp_val_entry); | 
 | 730 | 	debugfs_remove(intf->bbp_off_entry); | 
 | 731 | 	debugfs_remove(intf->eeprom_val_entry); | 
 | 732 | 	debugfs_remove(intf->eeprom_off_entry); | 
 | 733 | 	debugfs_remove(intf->csr_val_entry); | 
 | 734 | 	debugfs_remove(intf->csr_off_entry); | 
| Ivo van Doorn | 91921a4 | 2007-11-27 21:48:16 +0100 | [diff] [blame] | 735 | 	debugfs_remove(intf->register_folder); | 
| Ivo van Doorn | 643b252 | 2007-09-25 20:13:51 +0200 | [diff] [blame] | 736 | 	debugfs_remove(intf->dev_flags); | 
| Ivo van Doorn | 95ea362 | 2007-09-25 17:57:13 -0700 | [diff] [blame] | 737 | 	debugfs_remove(intf->chipset_entry); | 
 | 738 | 	debugfs_remove(intf->driver_entry); | 
 | 739 | 	debugfs_remove(intf->driver_folder); | 
 | 740 | 	kfree(intf->chipset_blob.data); | 
 | 741 | 	kfree(intf->driver_blob.data); | 
 | 742 | 	kfree(intf); | 
 | 743 |  | 
 | 744 | 	rt2x00dev->debugfs_intf = NULL; | 
 | 745 | } |