1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
22
23#include <linux/module.h>
24#include <linux/pci.h>
25#include <linux/gpio.h>
26#include <linux/platform_device.h>
27#include <linux/mfd/lpc_ich.h>
28
29#define DRV_NAME "gpio_ich"
30
31
32
33
34
35
36
37
38
39
40enum GPIO_REG {
41 GPIO_USE_SEL = 0,
42 GPIO_IO_SEL,
43 GPIO_LVL,
44};
45
46static const u8 ichx_regs[3][3] = {
47 {0x00, 0x30, 0x40},
48 {0x04, 0x34, 0x44},
49 {0x0c, 0x38, 0x48},
50};
51
52static const u8 ichx_reglen[3] = {
53 0x30, 0x10, 0x10,
54};
55
56#define ICHX_WRITE(val, reg, base_res) outl(val, (reg) + (base_res)->start)
57#define ICHX_READ(reg, base_res) inl((reg) + (base_res)->start)
58
59struct ichx_desc {
60
61 uint ngpio;
62
63
64 bool uses_gpe0;
65
66
67 u32 use_sel_ignore[3];
68
69
70 int (*request)(struct gpio_chip *chip, unsigned offset);
71 int (*get)(struct gpio_chip *chip, unsigned offset);
72};
73
74static struct {
75 spinlock_t lock;
76 struct platform_device *dev;
77 struct gpio_chip chip;
78 struct resource *gpio_base;
79 struct resource *pm_base;
80 struct ichx_desc *desc;
81 u32 orig_gpio_ctrl;
82 u8 use_gpio;
83} ichx_priv;
84
85static int modparam_gpiobase = -1;
86module_param_named(gpiobase, modparam_gpiobase, int, 0444);
87MODULE_PARM_DESC(gpiobase, "The GPIO number base. -1 means dynamic, "
88 "which is the default.");
89
90static int ichx_write_bit(int reg, unsigned nr, int val, int verify)
91{
92 unsigned long flags;
93 u32 data, tmp;
94 int reg_nr = nr / 32;
95 int bit = nr & 0x1f;
96 int ret = 0;
97
98 spin_lock_irqsave(&ichx_priv.lock, flags);
99
100 data = ICHX_READ(ichx_regs[reg][reg_nr], ichx_priv.gpio_base);
101 if (val)
102 data |= 1 << bit;
103 else
104 data &= ~(1 << bit);
105 ICHX_WRITE(data, ichx_regs[reg][reg_nr], ichx_priv.gpio_base);
106 tmp = ICHX_READ(ichx_regs[reg][reg_nr], ichx_priv.gpio_base);
107 if (verify && data != tmp)
108 ret = -EPERM;
109
110 spin_unlock_irqrestore(&ichx_priv.lock, flags);
111
112 return ret;
113}
114
115static int ichx_read_bit(int reg, unsigned nr)
116{
117 unsigned long flags;
118 u32 data;
119 int reg_nr = nr / 32;
120 int bit = nr & 0x1f;
121
122 spin_lock_irqsave(&ichx_priv.lock, flags);
123
124 data = ICHX_READ(ichx_regs[reg][reg_nr], ichx_priv.gpio_base);
125
126 spin_unlock_irqrestore(&ichx_priv.lock, flags);
127
128 return data & (1 << bit) ? 1 : 0;
129}
130
131static int ichx_gpio_check_available(struct gpio_chip *gpio, unsigned nr)
132{
133 return (ichx_priv.use_gpio & (1 << (nr / 32))) ? 0 : -ENXIO;
134}
135
136static int ichx_gpio_direction_input(struct gpio_chip *gpio, unsigned nr)
137{
138 if (!ichx_gpio_check_available(gpio, nr))
139 return -ENXIO;
140
141
142
143
144
145 if (ichx_write_bit(GPIO_IO_SEL, nr, 1, 1))
146 return -EINVAL;
147
148 return 0;
149}
150
151static int ichx_gpio_direction_output(struct gpio_chip *gpio, unsigned nr,
152 int val)
153{
154 if (!ichx_gpio_check_available(gpio, nr))
155 return -ENXIO;
156
157
158 ichx_write_bit(GPIO_LVL, nr, val, 0);
159
160
161
162
163
164 if (ichx_write_bit(GPIO_IO_SEL, nr, 0, 1))
165 return -EINVAL;
166
167 return 0;
168}
169
170static int ichx_gpio_get(struct gpio_chip *chip, unsigned nr)
171{
172 if (!ichx_gpio_check_available(chip, nr))
173 return -ENXIO;
174
175 return ichx_read_bit(GPIO_LVL, nr);
176}
177
178static int ich6_gpio_get(struct gpio_chip *chip, unsigned nr)
179{
180 unsigned long flags;
181 u32 data;
182
183 if (!ichx_gpio_check_available(chip, nr))
184 return -ENXIO;
185
186
187
188
189
190 if (nr < 16) {
191 if (!ichx_priv.pm_base)
192 return -ENXIO;
193
194 spin_lock_irqsave(&ichx_priv.lock, flags);
195
196
197 ICHX_WRITE(1 << (16 + nr), 0, ichx_priv.pm_base);
198 data = ICHX_READ(0, ichx_priv.pm_base);
199
200 spin_unlock_irqrestore(&ichx_priv.lock, flags);
201
202 return (data >> 16) & (1 << nr) ? 1 : 0;
203 } else {
204 return ichx_gpio_get(chip, nr);
205 }
206}
207
208static int ichx_gpio_request(struct gpio_chip *chip, unsigned nr)
209{
210
211
212
213
214
215
216 if (ichx_priv.desc->use_sel_ignore[nr / 32] & (1 << (nr & 0x1f)))
217 return 1;
218
219 return ichx_read_bit(GPIO_USE_SEL, nr) ? 0 : -ENODEV;
220}
221
222static int ich6_gpio_request(struct gpio_chip *chip, unsigned nr)
223{
224
225
226
227
228
229
230 if (nr == 16 || nr == 17)
231 nr -= 16;
232
233 return ichx_gpio_request(chip, nr);
234}
235
236static void ichx_gpio_set(struct gpio_chip *chip, unsigned nr, int val)
237{
238 ichx_write_bit(GPIO_LVL, nr, val, 0);
239}
240
241static void __devinit ichx_gpiolib_setup(struct gpio_chip *chip)
242{
243 chip->owner = THIS_MODULE;
244 chip->label = DRV_NAME;
245 chip->dev = &ichx_priv.dev->dev;
246
247
248 chip->request = ichx_priv.desc->request ?
249 ichx_priv.desc->request : ichx_gpio_request;
250 chip->get = ichx_priv.desc->get ?
251 ichx_priv.desc->get : ichx_gpio_get;
252
253 chip->set = ichx_gpio_set;
254 chip->direction_input = ichx_gpio_direction_input;
255 chip->direction_output = ichx_gpio_direction_output;
256 chip->base = modparam_gpiobase;
257 chip->ngpio = ichx_priv.desc->ngpio;
258 chip->can_sleep = 0;
259 chip->dbg_show = NULL;
260}
261
262
263static struct ichx_desc ich6_desc = {
264
265 .request = ich6_gpio_request,
266 .get = ich6_gpio_get,
267
268
269 .uses_gpe0 = true,
270
271 .ngpio = 50,
272};
273
274
275static struct ichx_desc i3100_desc = {
276
277
278
279
280
281 .use_sel_ignore = {0x00130000, 0x00010000, 0x0},
282
283
284 .request = ich6_gpio_request,
285 .get = ich6_gpio_get,
286
287
288 .uses_gpe0 = true,
289
290 .ngpio = 50,
291};
292
293
294static struct ichx_desc ich7_desc = {
295 .ngpio = 50,
296};
297
298
299static struct ichx_desc ich9_desc = {
300 .ngpio = 61,
301};
302
303
304static struct ichx_desc ich10_cons_desc = {
305 .ngpio = 61,
306};
307static struct ichx_desc ich10_corp_desc = {
308 .ngpio = 72,
309};
310
311
312static struct ichx_desc intel5_desc = {
313 .ngpio = 76,
314};
315
316static int __devinit ichx_gpio_request_regions(struct resource *res_base,
317 const char *name, u8 use_gpio)
318{
319 int i;
320
321 if (!res_base || !res_base->start || !res_base->end)
322 return -ENODEV;
323
324 for (i = 0; i < ARRAY_SIZE(ichx_regs[0]); i++) {
325 if (!(use_gpio & (1 << i)))
326 continue;
327 if (!request_region(res_base->start + ichx_regs[0][i],
328 ichx_reglen[i], name))
329 goto request_err;
330 }
331 return 0;
332
333request_err:
334
335 for (i--; i >= 0; i--) {
336 if (!(use_gpio & (1 << i)))
337 continue;
338 release_region(res_base->start + ichx_regs[0][i],
339 ichx_reglen[i]);
340 }
341 return -EBUSY;
342}
343
344static void ichx_gpio_release_regions(struct resource *res_base, u8 use_gpio)
345{
346 int i;
347
348 for (i = 0; i < ARRAY_SIZE(ichx_regs[0]); i++) {
349 if (!(use_gpio & (1 << i)))
350 continue;
351 release_region(res_base->start + ichx_regs[0][i],
352 ichx_reglen[i]);
353 }
354}
355
356static int __devinit ichx_gpio_probe(struct platform_device *pdev)
357{
358 struct resource *res_base, *res_pm;
359 int err;
360 struct lpc_ich_info *ich_info = pdev->dev.platform_data;
361
362 if (!ich_info)
363 return -ENODEV;
364
365 ichx_priv.dev = pdev;
366
367 switch (ich_info->gpio_version) {
368 case ICH_I3100_GPIO:
369 ichx_priv.desc = &i3100_desc;
370 break;
371 case ICH_V5_GPIO:
372 ichx_priv.desc = &intel5_desc;
373 break;
374 case ICH_V6_GPIO:
375 ichx_priv.desc = &ich6_desc;
376 break;
377 case ICH_V7_GPIO:
378 ichx_priv.desc = &ich7_desc;
379 break;
380 case ICH_V9_GPIO:
381 ichx_priv.desc = &ich9_desc;
382 break;
383 case ICH_V10CORP_GPIO:
384 ichx_priv.desc = &ich10_corp_desc;
385 break;
386 case ICH_V10CONS_GPIO:
387 ichx_priv.desc = &ich10_cons_desc;
388 break;
389 default:
390 return -ENODEV;
391 }
392
393 res_base = platform_get_resource(pdev, IORESOURCE_IO, ICH_RES_GPIO);
394 ichx_priv.use_gpio = ich_info->use_gpio;
395 err = ichx_gpio_request_regions(res_base, pdev->name,
396 ichx_priv.use_gpio);
397 if (err)
398 return err;
399
400 ichx_priv.gpio_base = res_base;
401
402
403
404
405
406
407 if (!ichx_priv.desc->uses_gpe0)
408 goto init;
409
410 res_pm = platform_get_resource(pdev, IORESOURCE_IO, ICH_RES_GPE0);
411 if (!res_pm) {
412 pr_warn("ACPI BAR is unavailable, GPI 0 - 15 unavailable\n");
413 goto init;
414 }
415
416 if (!request_region(res_pm->start, resource_size(res_pm),
417 pdev->name)) {
418 pr_warn("ACPI BAR is busy, GPI 0 - 15 unavailable\n");
419 goto init;
420 }
421
422 ichx_priv.pm_base = res_pm;
423
424init:
425 ichx_gpiolib_setup(&ichx_priv.chip);
426 err = gpiochip_add(&ichx_priv.chip);
427 if (err) {
428 pr_err("Failed to register GPIOs\n");
429 goto add_err;
430 }
431
432 pr_info("GPIO from %d to %d on %s\n", ichx_priv.chip.base,
433 ichx_priv.chip.base + ichx_priv.chip.ngpio - 1, DRV_NAME);
434
435 return 0;
436
437add_err:
438 ichx_gpio_release_regions(ichx_priv.gpio_base, ichx_priv.use_gpio);
439 if (ichx_priv.pm_base)
440 release_region(ichx_priv.pm_base->start,
441 resource_size(ichx_priv.pm_base));
442 return err;
443}
444
445static int __devexit ichx_gpio_remove(struct platform_device *pdev)
446{
447 int err;
448
449 err = gpiochip_remove(&ichx_priv.chip);
450 if (err) {
451 dev_err(&pdev->dev, "%s failed, %d\n",
452 "gpiochip_remove()", err);
453 return err;
454 }
455
456 ichx_gpio_release_regions(ichx_priv.gpio_base, ichx_priv.use_gpio);
457 if (ichx_priv.pm_base)
458 release_region(ichx_priv.pm_base->start,
459 resource_size(ichx_priv.pm_base));
460
461 return 0;
462}
463
464static struct platform_driver ichx_gpio_driver = {
465 .driver = {
466 .owner = THIS_MODULE,
467 .name = DRV_NAME,
468 },
469 .probe = ichx_gpio_probe,
470 .remove = __devexit_p(ichx_gpio_remove),
471};
472
473module_platform_driver(ichx_gpio_driver);
474
475MODULE_AUTHOR("Peter Tyser <ptyser@xes-inc.com>");
476MODULE_DESCRIPTION("GPIO interface for Intel ICH series");
477MODULE_LICENSE("GPL");
478MODULE_ALIAS("platform:"DRV_NAME);
479