linux-imx

/*

 *  Force feedback support for Logitech RumblePad and Rumblepad 2

 *

 *  Copyright (c) 2008 Anssi Hannula <anssi.hannula@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.

 *

 * This program is distributed in the hope that it will be useful,

 * but WITHOUT ANY WARRANTY; without even the implied warranty of

 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the

 * GNU General Public License for more details.

 *

 * You should have received a copy of the GNU General Public License

 * along with this program; if not, write to the Free Software

 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA

 */

​

​

#include <linux/input.h>

#include <linux/slab.h>

#include <linux/hid.h>

​

#include "hid-lg.h"

​

struct lg2ff_device {

    struct hid_report *report;

};

​

static int play_effect(struct input_dev *dev, void *data,

             struct ff_effect *effect)

{

    struct hid_device *hid = input_get_drvdata(dev);

    struct lg2ff_device *lg2ff = data;

    int weak, strong;

​

    strong = effect->u.rumble.strong_magnitude;

    weak = effect->u.rumble.weak_magnitude;

​

    if (weak || strong) {

        weak = weak * 0xff / 0xffff;

        strong = strong * 0xff / 0xffff;

​

        lg2ff->report->field[0]->value[0] = 0x51;

        lg2ff->report->field[0]->value[2] = weak;

        lg2ff->report->field[0]->value[4] = strong;

    } else {

        lg2ff->report->field[0]->value[0] = 0xf3;

        lg2ff->report->field[0]->value[2] = 0x00;

        lg2ff->report->field[0]->value[4] = 0x00;

    }

​

    hid_hw_request(hid, lg2ff->report, HID_REQ_SET_REPORT);

    return 0;

}

​

int lg2ff_init(struct hid_device *hid)

{

    struct lg2ff_device *lg2ff;