Blame view
drivers/hid/hid-wiimote-debug.c
4.85 KB
43e5e7c60 HID: wiimote: Add... |
1 2 3 4 5 6 7 8 9 10 11 |
/* * Debug support for HID Nintendo Wiimote devices * Copyright (c) 2011 David Herrmann */ /* * This program is free software; you can redistribute it and/or modify it * under the terms of the GNU General Public License as published by the Free * Software Foundation; either version 2 of the License, or (at your option) * any later version. */ |
1d3452c63 HID: wiimote: All... |
12 |
#include <linux/debugfs.h> |
43e5e7c60 HID: wiimote: Add... |
13 |
#include <linux/module.h> |
43d782ae8 HID: wiimote: All... |
14 |
#include <linux/seq_file.h> |
43e5e7c60 HID: wiimote: Add... |
15 |
#include <linux/spinlock.h> |
1d3452c63 HID: wiimote: All... |
16 |
#include <linux/uaccess.h> |
43e5e7c60 HID: wiimote: Add... |
17 18 19 20 |
#include "hid-wiimote.h" struct wiimote_debug { struct wiimote_data *wdata; |
1d3452c63 HID: wiimote: All... |
21 |
struct dentry *eeprom; |
43d782ae8 HID: wiimote: All... |
22 |
struct dentry *drm; |
1d3452c63 HID: wiimote: All... |
23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 |
}; static int wiidebug_eeprom_open(struct inode *i, struct file *f) { f->private_data = i->i_private; return 0; } static ssize_t wiidebug_eeprom_read(struct file *f, char __user *u, size_t s, loff_t *off) { struct wiimote_debug *dbg = f->private_data; struct wiimote_data *wdata = dbg->wdata; unsigned long flags; ssize_t ret; char buf[16]; __u16 size; if (s == 0) return -EINVAL; if (*off > 0xffffff) return 0; if (s > 16) s = 16; ret = wiimote_cmd_acquire(wdata); if (ret) return ret; spin_lock_irqsave(&wdata->state.lock, flags); wdata->state.cmd_read_size = s; wdata->state.cmd_read_buf = buf; wiimote_cmd_set(wdata, WIIPROTO_REQ_RMEM, *off & 0xffff); wiiproto_req_reeprom(wdata, *off, s); spin_unlock_irqrestore(&wdata->state.lock, flags); ret = wiimote_cmd_wait(wdata); if (!ret) size = wdata->state.cmd_read_size; spin_lock_irqsave(&wdata->state.lock, flags); wdata->state.cmd_read_buf = NULL; spin_unlock_irqrestore(&wdata->state.lock, flags); wiimote_cmd_release(wdata); if (ret) return ret; else if (size == 0) return -EIO; if (copy_to_user(u, buf, size)) return -EFAULT; *off += size; ret = size; return ret; } static const struct file_operations wiidebug_eeprom_fops = { .owner = THIS_MODULE, .open = wiidebug_eeprom_open, .read = wiidebug_eeprom_read, .llseek = generic_file_llseek, |
43e5e7c60 HID: wiimote: Add... |
88 |
}; |
43d782ae8 HID: wiimote: All... |
89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 |
static const char *wiidebug_drmmap[] = { [WIIPROTO_REQ_NULL] = "NULL", [WIIPROTO_REQ_DRM_K] = "K", [WIIPROTO_REQ_DRM_KA] = "KA", [WIIPROTO_REQ_DRM_KE] = "KE", [WIIPROTO_REQ_DRM_KAI] = "KAI", [WIIPROTO_REQ_DRM_KEE] = "KEE", [WIIPROTO_REQ_DRM_KAE] = "KAE", [WIIPROTO_REQ_DRM_KIE] = "KIE", [WIIPROTO_REQ_DRM_KAIE] = "KAIE", [WIIPROTO_REQ_DRM_E] = "E", [WIIPROTO_REQ_DRM_SKAI1] = "SKAI1", [WIIPROTO_REQ_DRM_SKAI2] = "SKAI2", [WIIPROTO_REQ_MAX] = NULL }; static int wiidebug_drm_show(struct seq_file *f, void *p) { struct wiimote_debug *dbg = f->private; const char *str = NULL; unsigned long flags; __u8 drm; spin_lock_irqsave(&dbg->wdata->state.lock, flags); drm = dbg->wdata->state.drm; spin_unlock_irqrestore(&dbg->wdata->state.lock, flags); if (drm < WIIPROTO_REQ_MAX) str = wiidebug_drmmap[drm]; if (!str) str = "unknown"; seq_printf(f, "%s ", str); return 0; } static int wiidebug_drm_open(struct inode *i, struct file *f) { return single_open(f, wiidebug_drm_show, i->i_private); } static ssize_t wiidebug_drm_write(struct file *f, const char __user *u, size_t s, loff_t *off) { struct wiimote_debug *dbg = f->private_data; unsigned long flags; char buf[16]; ssize_t len; int i; if (s == 0) return -EINVAL; len = min((size_t) 15, s); if (copy_from_user(buf, u, len)) return -EFAULT; buf[15] = 0; for (i = 0; i < WIIPROTO_REQ_MAX; ++i) { if (!wiidebug_drmmap[i]) continue; if (!strcasecmp(buf, wiidebug_drmmap[i])) break; } if (i == WIIPROTO_REQ_MAX) i = simple_strtoul(buf, NULL, 10); spin_lock_irqsave(&dbg->wdata->state.lock, flags); wiiproto_req_drm(dbg->wdata, (__u8) i); spin_unlock_irqrestore(&dbg->wdata->state.lock, flags); return len; } static const struct file_operations wiidebug_drm_fops = { .owner = THIS_MODULE, .open = wiidebug_drm_open, .read = seq_read, .llseek = seq_lseek, .write = wiidebug_drm_write, .release = single_release, }; |
43e5e7c60 HID: wiimote: Add... |
175 176 177 178 |
int wiidebug_init(struct wiimote_data *wdata) { struct wiimote_debug *dbg; unsigned long flags; |
43d782ae8 HID: wiimote: All... |
179 |
int ret = -ENOMEM; |
43e5e7c60 HID: wiimote: Add... |
180 181 182 183 184 185 |
dbg = kzalloc(sizeof(*dbg), GFP_KERNEL); if (!dbg) return -ENOMEM; dbg->wdata = wdata; |
1d3452c63 HID: wiimote: All... |
186 187 |
dbg->eeprom = debugfs_create_file("eeprom", S_IRUSR, dbg->wdata->hdev->debug_dir, dbg, &wiidebug_eeprom_fops); |
43d782ae8 HID: wiimote: All... |
188 189 190 191 192 193 194 |
if (!dbg->eeprom) goto err; dbg->drm = debugfs_create_file("drm", S_IRUSR, dbg->wdata->hdev->debug_dir, dbg, &wiidebug_drm_fops); if (!dbg->drm) goto err_drm; |
1d3452c63 HID: wiimote: All... |
195 |
|
43e5e7c60 HID: wiimote: Add... |
196 197 198 199 200 |
spin_lock_irqsave(&wdata->state.lock, flags); wdata->debug = dbg; spin_unlock_irqrestore(&wdata->state.lock, flags); return 0; |
43d782ae8 HID: wiimote: All... |
201 202 203 204 205 206 |
err_drm: debugfs_remove(dbg->eeprom); err: kfree(dbg); return ret; |
43e5e7c60 HID: wiimote: Add... |
207 208 209 210 211 212 213 214 215 216 217 218 219 |
} void wiidebug_deinit(struct wiimote_data *wdata) { struct wiimote_debug *dbg = wdata->debug; unsigned long flags; if (!dbg) return; spin_lock_irqsave(&wdata->state.lock, flags); wdata->debug = NULL; spin_unlock_irqrestore(&wdata->state.lock, flags); |
43d782ae8 HID: wiimote: All... |
220 |
debugfs_remove(dbg->drm); |
1d3452c63 HID: wiimote: All... |
221 |
debugfs_remove(dbg->eeprom); |
43e5e7c60 HID: wiimote: Add... |
222 223 |
kfree(dbg); } |