HID: picoLCD: split driver code
In order to make code maintenance easier, split the vairous functions into individial files (this removes a bunch of #ifdefs). Signed-off-by: Bruno Prémont <bonbons@linux-vserver.org> Signed-off-by: Jiri Kosina <jkosina@suse.cz>
This commit is contained in:
Bruno Prémont
committed by
Jiri Kosina
Jiri Kosina
parent
e8ff13b0bf
commit
fabdbf2fd2
172
drivers/hid/hid-picolcd_leds.c
Normal file
172
drivers/hid/hid-picolcd_leds.c
Normal file
@@ -0,0 +1,172 @@
|
||||
/***************************************************************************
|
||||
* Copyright (C) 2010-2012 by Bruno Prémont <bonbons@linux-vserver.org> *
|
||||
* *
|
||||
* Based on Logitech G13 driver (v0.4) *
|
||||
* Copyright (C) 2009 by Rick L. Vinyard, Jr. <rvinyard@cs.nmsu.edu> *
|
||||
* *
|
||||
* 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, version 2 of the License. *
|
||||
* *
|
||||
* This driver 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 software. If not see <http://www.gnu.org/licenses/>. *
|
||||
***************************************************************************/
|
||||
|
||||
#include <linux/hid.h>
|
||||
#include <linux/hid-debug.h>
|
||||
#include <linux/input.h>
|
||||
#include "hid-ids.h"
|
||||
#include "usbhid/usbhid.h"
|
||||
#include <linux/usb.h>
|
||||
|
||||
#include <linux/fb.h>
|
||||
#include <linux/vmalloc.h>
|
||||
#include <linux/backlight.h>
|
||||
#include <linux/lcd.h>
|
||||
|
||||
#include <linux/leds.h>
|
||||
|
||||
#include <linux/seq_file.h>
|
||||
#include <linux/debugfs.h>
|
||||
|
||||
#include <linux/completion.h>
|
||||
#include <linux/uaccess.h>
|
||||
#include <linux/module.h>
|
||||
|
||||
#include "hid-picolcd.h"
|
||||
|
||||
|
||||
void picolcd_leds_set(struct picolcd_data *data)
|
||||
{
|
||||
struct hid_report *report;
|
||||
unsigned long flags;
|
||||
|
||||
if (!data->led[0])
|
||||
return;
|
||||
report = picolcd_out_report(REPORT_LED_STATE, data->hdev);
|
||||
if (!report || report->maxfield != 1 || report->field[0]->report_count != 1)
|
||||
return;
|
||||
|
||||
spin_lock_irqsave(&data->lock, flags);
|
||||
hid_set_field(report->field[0], 0, data->led_state);
|
||||
usbhid_submit_report(data->hdev, report, USB_DIR_OUT);
|
||||
spin_unlock_irqrestore(&data->lock, flags);
|
||||
}
|
||||
|
||||
static void picolcd_led_set_brightness(struct led_classdev *led_cdev,
|
||||
enum led_brightness value)
|
||||
{
|
||||
struct device *dev;
|
||||
struct hid_device *hdev;
|
||||
struct picolcd_data *data;
|
||||
int i, state = 0;
|
||||
|
||||
dev = led_cdev->dev->parent;
|
||||
hdev = container_of(dev, struct hid_device, dev);
|
||||
data = hid_get_drvdata(hdev);
|
||||
for (i = 0; i < 8; i++) {
|
||||
if (led_cdev != data->led[i])
|
||||
continue;
|
||||
state = (data->led_state >> i) & 1;
|
||||
if (value == LED_OFF && state) {
|
||||
data->led_state &= ~(1 << i);
|
||||
picolcd_leds_set(data);
|
||||
} else if (value != LED_OFF && !state) {
|
||||
data->led_state |= 1 << i;
|
||||
picolcd_leds_set(data);
|
||||
}
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
static enum led_brightness picolcd_led_get_brightness(struct led_classdev *led_cdev)
|
||||
{
|
||||
struct device *dev;
|
||||
struct hid_device *hdev;
|
||||
struct picolcd_data *data;
|
||||
int i, value = 0;
|
||||
|
||||
dev = led_cdev->dev->parent;
|
||||
hdev = container_of(dev, struct hid_device, dev);
|
||||
data = hid_get_drvdata(hdev);
|
||||
for (i = 0; i < 8; i++)
|
||||
if (led_cdev == data->led[i]) {
|
||||
value = (data->led_state >> i) & 1;
|
||||
break;
|
||||
}
|
||||
return value ? LED_FULL : LED_OFF;
|
||||
}
|
||||
|
||||
int picolcd_init_leds(struct picolcd_data *data, struct hid_report *report)
|
||||
{
|
||||
struct device *dev = &data->hdev->dev;
|
||||
struct led_classdev *led;
|
||||
size_t name_sz = strlen(dev_name(dev)) + 8;
|
||||
char *name;
|
||||
int i, ret = 0;
|
||||
|
||||
if (!report)
|
||||
return -ENODEV;
|
||||
if (report->maxfield != 1 || report->field[0]->report_count != 1 ||
|
||||
report->field[0]->report_size != 8) {
|
||||
dev_err(dev, "unsupported LED_STATE report");
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
for (i = 0; i < 8; i++) {
|
||||
led = kzalloc(sizeof(struct led_classdev)+name_sz, GFP_KERNEL);
|
||||
if (!led) {
|
||||
dev_err(dev, "can't allocate memory for LED %d\n", i);
|
||||
ret = -ENOMEM;
|
||||
goto err;
|
||||
}
|
||||
name = (void *)(&led[1]);
|
||||
snprintf(name, name_sz, "%s::GPO%d", dev_name(dev), i);
|
||||
led->name = name;
|
||||
led->brightness = 0;
|
||||
led->max_brightness = 1;
|
||||
led->brightness_get = picolcd_led_get_brightness;
|
||||
led->brightness_set = picolcd_led_set_brightness;
|
||||
|
||||
data->led[i] = led;
|
||||
ret = led_classdev_register(dev, data->led[i]);
|
||||
if (ret) {
|
||||
data->led[i] = NULL;
|
||||
kfree(led);
|
||||
dev_err(dev, "can't register LED %d\n", i);
|
||||
goto err;
|
||||
}
|
||||
}
|
||||
return 0;
|
||||
err:
|
||||
for (i = 0; i < 8; i++)
|
||||
if (data->led[i]) {
|
||||
led = data->led[i];
|
||||
data->led[i] = NULL;
|
||||
led_classdev_unregister(led);
|
||||
kfree(led);
|
||||
}
|
||||
return ret;
|
||||
}
|
||||
|
||||
void picolcd_exit_leds(struct picolcd_data *data)
|
||||
{
|
||||
struct led_classdev *led;
|
||||
int i;
|
||||
|
||||
for (i = 0; i < 8; i++) {
|
||||
led = data->led[i];
|
||||
data->led[i] = NULL;
|
||||
if (!led)
|
||||
continue;
|
||||
led_classdev_unregister(led);
|
||||
kfree(led);
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
Reference in New Issue
Block a user