linux-imx

/*

 * Debug support for HID Nintendo Wii / Wii U peripherals

 * Copyright (c) 2011-2013 David Herrmann <dh.herrmann@gmail.com>

 */

​

/*

 * 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.

 */

​

#include <linux/debugfs.h>

#include <linux/module.h>

#include <linux/seq_file.h>

#include <linux/spinlock.h>

#include <linux/uaccess.h>

#include "hid-wiimote.h"

​

struct wiimote_debug {

    struct wiimote_data *wdata;

    struct dentry *eeprom;

    struct dentry *drm;

};

​

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 = 0;

​

    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);

​