Blame view

kernel/linux-imx6_3.14.28/drivers/hid/hid-picolcd_leds.c 4.79 KB
6b13f685e   김민수   BSP 최초 추가
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
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
88
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
  /***************************************************************************
   *   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 <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);
  	if (!(data->status & PICOLCD_FAILED))
  		hid_hw_request(data->hdev, report, HID_REQ_SET_REPORT);
  	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);
  	if (!data)
  		return;
  	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
  ", 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
  ", 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);
  	}
  }