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