1/***************************************************************************
  2 *   Copyright (C) 2010-2012 by Bruno Prémont <bonbons@linux-vserver.org>  *
  3 *                                                                         *
  4 *   Based on Logitech G13 driver (v0.4)                                   *
  5 *     Copyright (C) 2009 by Rick L. Vinyard, Jr. <rvinyard@cs.nmsu.edu>   *
  6 *                                                                         *
  7 *   This program is free software: you can redistribute it and/or modify  *
  8 *   it under the terms of the GNU General Public License as published by  *
  9 *   the Free Software Foundation, version 2 of the License.               *
 10 *                                                                         *
 11 *   This driver is distributed in the hope that it will be useful, but    *
 12 *   WITHOUT ANY WARRANTY; without even the implied warranty of            *
 13 *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU      *
 14 *   General Public License for more details.                              *
 15 *                                                                         *
 16 *   You should have received a copy of the GNU General Public License     *
 17 *   along with this software. If not see <http://www.gnu.org/licenses/>.  *
 18 ***************************************************************************/
 19
 20#include <linux/hid.h>
 21#include <linux/hid-debug.h>
 22#include <linux/input.h>
 23#include "hid-ids.h"
 24
 25#include <linux/fb.h>
 26#include <linux/vmalloc.h>
 27#include <linux/backlight.h>
 28#include <linux/lcd.h>
 29
 30#include <linux/leds.h>
 31
 32#include <linux/seq_file.h>
 33#include <linux/debugfs.h>
 34
 35#include <linux/completion.h>
 36#include <linux/uaccess.h>
 37#include <linux/module.h>
 38
 39#include "hid-picolcd.h"
 40
 41
 42void picolcd_leds_set(struct picolcd_data *data)
 43{
 44	struct hid_report *report;
 45	unsigned long flags;
 46
 47	if (!data->led[0])
 48		return;
 49	report = picolcd_out_report(REPORT_LED_STATE, data->hdev);
 50	if (!report || report->maxfield != 1 || report->field[0]->report_count != 1)
 51		return;
 52
 53	spin_lock_irqsave(&data->lock, flags);
 54	hid_set_field(report->field[0], 0, data->led_state);
 55	if (!(data->status & PICOLCD_FAILED))
 56		hid_hw_request(data->hdev, report, HID_REQ_SET_REPORT);
 57	spin_unlock_irqrestore(&data->lock, flags);
 58}
 59
 60static void picolcd_led_set_brightness(struct led_classdev *led_cdev,
 61			enum led_brightness value)
 62{
 63	struct device *dev;
 64	struct hid_device *hdev;
 65	struct picolcd_data *data;
 66	int i, state = 0;
 67
 68	dev  = led_cdev->dev->parent;
 69	hdev = to_hid_device(dev);
 70	data = hid_get_drvdata(hdev);
 71	if (!data)
 72		return;
 73	for (i = 0; i < 8; i++) {
 74		if (led_cdev != data->led[i])
 75			continue;
 76		state = (data->led_state >> i) & 1;
 77		if (value == LED_OFF && state) {
 78			data->led_state &= ~(1 << i);
 79			picolcd_leds_set(data);
 80		} else if (value != LED_OFF && !state) {
 81			data->led_state |= 1 << i;
 82			picolcd_leds_set(data);
 83		}
 84		break;
 85	}
 86}
 87
 88static enum led_brightness picolcd_led_get_brightness(struct led_classdev *led_cdev)
 89{
 90	struct device *dev;
 91	struct hid_device *hdev;
 92	struct picolcd_data *data;
 93	int i, value = 0;
 94
 95	dev  = led_cdev->dev->parent;
 96	hdev = to_hid_device(dev);
 97	data = hid_get_drvdata(hdev);
 98	for (i = 0; i < 8; i++)
 99		if (led_cdev == data->led[i]) {
100			value = (data->led_state >> i) & 1;
101			break;
102		}
103	return value ? LED_FULL : LED_OFF;
104}
105
106int picolcd_init_leds(struct picolcd_data *data, struct hid_report *report)
107{
108	struct device *dev = &data->hdev->dev;
109	struct led_classdev *led;
110	size_t name_sz = strlen(dev_name(dev)) + 8;
111	char *name;
112	int i, ret = 0;
113
114	if (!report)
115		return -ENODEV;
116	if (report->maxfield != 1 || report->field[0]->report_count != 1 ||
117			report->field[0]->report_size != 8) {
118		dev_err(dev, "unsupported LED_STATE report");
119		return -EINVAL;
120	}
121
122	for (i = 0; i < 8; i++) {
123		led = kzalloc(sizeof(struct led_classdev)+name_sz, GFP_KERNEL);
124		if (!led) {
125			dev_err(dev, "can't allocate memory for LED %d\n", i);
126			ret = -ENOMEM;
127			goto err;
128		}
129		name = (void *)(&led[1]);
130		snprintf(name, name_sz, "%s::GPO%d", dev_name(dev), i);
131		led->name = name;
132		led->brightness = 0;
133		led->max_brightness = 1;
134		led->brightness_get = picolcd_led_get_brightness;
135		led->brightness_set = picolcd_led_set_brightness;
136
137		data->led[i] = led;
138		ret = led_classdev_register(dev, data->led[i]);
139		if (ret) {
140			data->led[i] = NULL;
141			kfree(led);
142			dev_err(dev, "can't register LED %d\n", i);
143			goto err;
144		}
145	}
146	return 0;
147err:
148	for (i = 0; i < 8; i++)
149		if (data->led[i]) {
150			led = data->led[i];
151			data->led[i] = NULL;
152			led_classdev_unregister(led);
153			kfree(led);
154		}
155	return ret;
156}
157
158void picolcd_exit_leds(struct picolcd_data *data)
159{
160	struct led_classdev *led;
161	int i;
162
163	for (i = 0; i < 8; i++) {
164		led = data->led[i];
165		data->led[i] = NULL;
166		if (!led)
167			continue;
168		led_classdev_unregister(led);
169		kfree(led);
170	}
171}
172
173