gpio_keys.c 22.6 KB
Newer Older
1 2 3 4
/*
 * Driver for keys on GPIO lines capable of generating interrupts.
 *
 * Copyright 2005 Phil Blundell
5
 * Copyright 2010, 2011 David Jander <david@protonic.nl>
6 7 8 9 10 11 12 13 14 15 16 17 18 19
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 */

#include <linux/module.h>

#include <linux/init.h>
#include <linux/fs.h>
#include <linux/interrupt.h>
#include <linux/irq.h>
#include <linux/sched.h>
#include <linux/pm.h>
20
#include <linux/slab.h>
21 22 23 24 25
#include <linux/sysctl.h>
#include <linux/proc_fs.h>
#include <linux/delay.h>
#include <linux/platform_device.h>
#include <linux/input.h>
26
#include <linux/gpio_keys.h>
27
#include <linux/workqueue.h>
28
#include <linux/gpio.h>
29
#include <linux/gpio/consumer.h>
30
#include <linux/of.h>
31
#include <linux/of_irq.h>
32
#include <linux/spinlock.h>
33

34
struct gpio_button_data {
35
	const struct gpio_keys_button *button;
36
	struct input_dev *input;
37
	struct gpio_desc *gpiod;
38

39 40
	unsigned short *code;

41 42 43 44 45 46
	struct timer_list release_timer;
	unsigned int release_delay;	/* in msecs, for IRQ-only buttons */

	struct delayed_work work;
	unsigned int software_debounce;	/* in msecs, for GPIO-driven buttons */

47 48
	unsigned int irq;
	spinlock_t lock;
49
	bool disabled;
50
	bool key_pressed;
51 52 53
};

struct gpio_keys_drvdata {
54
	const struct gpio_keys_platform_data *pdata;
55
	struct input_dev *input;
56
	struct mutex disable_lock;
57
	unsigned short *keymap;
58 59 60
	struct gpio_button_data data[0];
};

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
/*
 * SYSFS interface for enabling/disabling keys and switches:
 *
 * There are 4 attributes under /sys/devices/platform/gpio-keys/
 *	keys [ro]              - bitmap of keys (EV_KEY) which can be
 *	                         disabled
 *	switches [ro]          - bitmap of switches (EV_SW) which can be
 *	                         disabled
 *	disabled_keys [rw]     - bitmap of keys currently disabled
 *	disabled_switches [rw] - bitmap of switches currently disabled
 *
 * Userland can change these values and hence disable event generation
 * for each key (or switch). Disabling a key means its interrupt line
 * is disabled.
 *
 * For example, if we have following switches set up as gpio-keys:
 *	SW_DOCK = 5
 *	SW_CAMERA_LENS_COVER = 9
 *	SW_KEYPAD_SLIDE = 10
 *	SW_FRONT_PROXIMITY = 11
 * This is read from switches:
 *	11-9,5
 * Next we want to disable proximity (11) and dock (5), we write:
 *	11,5
 * to file disabled_switches. Now proximity and dock IRQs are disabled.
 * This can be verified by reading the file disabled_switches:
 *	11,5
 * If we now want to enable proximity (11) switch we write:
 *	5
 * to disabled_switches.
 *
 * We can disable only those keys which don't allow sharing the irq.
 */

/**
 * get_n_events_by_type() - returns maximum number of events per @type
 * @type: type of button (%EV_KEY, %EV_SW)
 *
 * Return value of this function can be used to allocate bitmap
 * large enough to hold all bits for given type.
 */
102
static int get_n_events_by_type(int type)
103 104 105 106 107 108
{
	BUG_ON(type != EV_SW && type != EV_KEY);

	return (type == EV_KEY) ? KEY_CNT : SW_CNT;
}

109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124
/**
 * get_bm_events_by_type() - returns bitmap of supported events per @type
 * @input: input device from which bitmap is retrieved
 * @type: type of button (%EV_KEY, %EV_SW)
 *
 * Return value of this function can be used to allocate bitmap
 * large enough to hold all bits for given type.
 */
static const unsigned long *get_bm_events_by_type(struct input_dev *dev,
						  int type)
{
	BUG_ON(type != EV_SW && type != EV_KEY);

	return (type == EV_KEY) ? dev->keybit : dev->swbit;
}

125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141
/**
 * gpio_keys_disable_button() - disables given GPIO button
 * @bdata: button data for button to be disabled
 *
 * Disables button pointed by @bdata. This is done by masking
 * IRQ line. After this function is called, button won't generate
 * input events anymore. Note that one can only disable buttons
 * that don't share IRQs.
 *
 * Make sure that @bdata->disable_lock is locked when entering
 * this function to avoid races when concurrent threads are
 * disabling buttons at the same time.
 */
static void gpio_keys_disable_button(struct gpio_button_data *bdata)
{
	if (!bdata->disabled) {
		/*
142
		 * Disable IRQ and associated timer/work structure.
143
		 */
144
		disable_irq(bdata->irq);
145

146
		if (bdata->gpiod)
147 148 149
			cancel_delayed_work_sync(&bdata->work);
		else
			del_timer_sync(&bdata->release_timer);
150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167

		bdata->disabled = true;
	}
}

/**
 * gpio_keys_enable_button() - enables given GPIO button
 * @bdata: button data for button to be disabled
 *
 * Enables given button pointed by @bdata.
 *
 * Make sure that @bdata->disable_lock is locked when entering
 * this function to avoid races with concurrent threads trying
 * to enable the same button at the same time.
 */
static void gpio_keys_enable_button(struct gpio_button_data *bdata)
{
	if (bdata->disabled) {
168
		enable_irq(bdata->irq);
169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199
		bdata->disabled = false;
	}
}

/**
 * gpio_keys_attr_show_helper() - fill in stringified bitmap of buttons
 * @ddata: pointer to drvdata
 * @buf: buffer where stringified bitmap is written
 * @type: button type (%EV_KEY, %EV_SW)
 * @only_disabled: does caller want only those buttons that are
 *                 currently disabled or all buttons that can be
 *                 disabled
 *
 * This function writes buttons that can be disabled to @buf. If
 * @only_disabled is true, then @buf contains only those buttons
 * that are currently disabled. Returns 0 on success or negative
 * errno on failure.
 */
static ssize_t gpio_keys_attr_show_helper(struct gpio_keys_drvdata *ddata,
					  char *buf, unsigned int type,
					  bool only_disabled)
{
	int n_events = get_n_events_by_type(type);
	unsigned long *bits;
	ssize_t ret;
	int i;

	bits = kcalloc(BITS_TO_LONGS(n_events), sizeof(*bits), GFP_KERNEL);
	if (!bits)
		return -ENOMEM;

200
	for (i = 0; i < ddata->pdata->nbuttons; i++) {
201 202 203 204 205 206 207 208
		struct gpio_button_data *bdata = &ddata->data[i];

		if (bdata->button->type != type)
			continue;

		if (only_disabled && !bdata->disabled)
			continue;

209
		__set_bit(*bdata->code, bits);
210 211
	}

212
	ret = scnprintf(buf, PAGE_SIZE - 1, "%*pbl", n_events, bits);
213 214 215 216 217 218 219 220 221 222 223 224 225 226 227
	buf[ret++] = '\n';
	buf[ret] = '\0';

	kfree(bits);

	return ret;
}

/**
 * gpio_keys_attr_store_helper() - enable/disable buttons based on given bitmap
 * @ddata: pointer to drvdata
 * @buf: buffer from userspace that contains stringified bitmap
 * @type: button type (%EV_KEY, %EV_SW)
 *
 * This function parses stringified bitmap from @buf and disables/enables
228
 * GPIO buttons accordingly. Returns 0 on success and negative error
229 230 231 232 233 234
 * on failure.
 */
static ssize_t gpio_keys_attr_store_helper(struct gpio_keys_drvdata *ddata,
					   const char *buf, unsigned int type)
{
	int n_events = get_n_events_by_type(type);
235
	const unsigned long *bitmap = get_bm_events_by_type(ddata->input, type);
236 237 238 239 240 241 242 243 244 245 246 247 248
	unsigned long *bits;
	ssize_t error;
	int i;

	bits = kcalloc(BITS_TO_LONGS(n_events), sizeof(*bits), GFP_KERNEL);
	if (!bits)
		return -ENOMEM;

	error = bitmap_parselist(buf, bits, n_events);
	if (error)
		goto out;

	/* First validate */
249 250 251 252 253
	if (!bitmap_subset(bits, bitmap, n_events)) {
		error = -EINVAL;
		goto out;
	}

254
	for (i = 0; i < ddata->pdata->nbuttons; i++) {
255 256 257 258 259
		struct gpio_button_data *bdata = &ddata->data[i];

		if (bdata->button->type != type)
			continue;

260
		if (test_bit(*bdata->code, bits) &&
261 262 263 264 265 266 267 268
		    !bdata->button->can_disable) {
			error = -EINVAL;
			goto out;
		}
	}

	mutex_lock(&ddata->disable_lock);

269
	for (i = 0; i < ddata->pdata->nbuttons; i++) {
270 271 272 273 274
		struct gpio_button_data *bdata = &ddata->data[i];

		if (bdata->button->type != type)
			continue;

275
		if (test_bit(*bdata->code, bits))
276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358
			gpio_keys_disable_button(bdata);
		else
			gpio_keys_enable_button(bdata);
	}

	mutex_unlock(&ddata->disable_lock);

out:
	kfree(bits);
	return error;
}

#define ATTR_SHOW_FN(name, type, only_disabled)				\
static ssize_t gpio_keys_show_##name(struct device *dev,		\
				     struct device_attribute *attr,	\
				     char *buf)				\
{									\
	struct platform_device *pdev = to_platform_device(dev);		\
	struct gpio_keys_drvdata *ddata = platform_get_drvdata(pdev);	\
									\
	return gpio_keys_attr_show_helper(ddata, buf,			\
					  type, only_disabled);		\
}

ATTR_SHOW_FN(keys, EV_KEY, false);
ATTR_SHOW_FN(switches, EV_SW, false);
ATTR_SHOW_FN(disabled_keys, EV_KEY, true);
ATTR_SHOW_FN(disabled_switches, EV_SW, true);

/*
 * ATTRIBUTES:
 *
 * /sys/devices/platform/gpio-keys/keys [ro]
 * /sys/devices/platform/gpio-keys/switches [ro]
 */
static DEVICE_ATTR(keys, S_IRUGO, gpio_keys_show_keys, NULL);
static DEVICE_ATTR(switches, S_IRUGO, gpio_keys_show_switches, NULL);

#define ATTR_STORE_FN(name, type)					\
static ssize_t gpio_keys_store_##name(struct device *dev,		\
				      struct device_attribute *attr,	\
				      const char *buf,			\
				      size_t count)			\
{									\
	struct platform_device *pdev = to_platform_device(dev);		\
	struct gpio_keys_drvdata *ddata = platform_get_drvdata(pdev);	\
	ssize_t error;							\
									\
	error = gpio_keys_attr_store_helper(ddata, buf, type);		\
	if (error)							\
		return error;						\
									\
	return count;							\
}

ATTR_STORE_FN(disabled_keys, EV_KEY);
ATTR_STORE_FN(disabled_switches, EV_SW);

/*
 * ATTRIBUTES:
 *
 * /sys/devices/platform/gpio-keys/disabled_keys [rw]
 * /sys/devices/platform/gpio-keys/disables_switches [rw]
 */
static DEVICE_ATTR(disabled_keys, S_IWUSR | S_IRUGO,
		   gpio_keys_show_disabled_keys,
		   gpio_keys_store_disabled_keys);
static DEVICE_ATTR(disabled_switches, S_IWUSR | S_IRUGO,
		   gpio_keys_show_disabled_switches,
		   gpio_keys_store_disabled_switches);

static struct attribute *gpio_keys_attrs[] = {
	&dev_attr_keys.attr,
	&dev_attr_switches.attr,
	&dev_attr_disabled_keys.attr,
	&dev_attr_disabled_switches.attr,
	NULL,
};

static struct attribute_group gpio_keys_attr_group = {
	.attrs = gpio_keys_attrs,
};

359
static void gpio_keys_gpio_report_event(struct gpio_button_data *bdata)
360
{
361
	const struct gpio_keys_button *button = bdata->button;
362
	struct input_dev *input = bdata->input;
363
	unsigned int type = button->type ?: EV_KEY;
364
	int state;
365

366
	state = gpiod_get_value_cansleep(bdata->gpiod);
367
	if (state < 0) {
368 369
		dev_err(input->dev.parent,
			"failed to get gpio state: %d\n", state);
370 371 372
		return;
	}

373 374 375 376
	if (type == EV_ABS) {
		if (state)
			input_event(input, type, button->code, button->value);
	} else {
377
		input_event(input, type, *bdata->code, state);
378
	}
379 380 381
	input_sync(input);
}

382
static void gpio_keys_gpio_work_func(struct work_struct *work)
383 384
{
	struct gpio_button_data *bdata =
385
		container_of(work, struct gpio_button_data, work.work);
386

387
	gpio_keys_gpio_report_event(bdata);
388 389 390

	if (bdata->button->wakeup)
		pm_relax(bdata->input->dev.parent);
391 392
}

393
static irqreturn_t gpio_keys_gpio_isr(int irq, void *dev_id)
394
{
395
	struct gpio_button_data *bdata = dev_id;
396

397
	BUG_ON(irq != bdata->irq);
398

399 400
	if (bdata->button->wakeup)
		pm_stay_awake(bdata->input->dev.parent);
401 402 403 404

	mod_delayed_work(system_wq,
			 &bdata->work,
			 msecs_to_jiffies(bdata->software_debounce));
405

406
	return IRQ_HANDLED;
407 408
}

409 410 411 412 413 414 415 416
static void gpio_keys_irq_timer(unsigned long _data)
{
	struct gpio_button_data *bdata = (struct gpio_button_data *)_data;
	struct input_dev *input = bdata->input;
	unsigned long flags;

	spin_lock_irqsave(&bdata->lock, flags);
	if (bdata->key_pressed) {
417
		input_event(input, EV_KEY, *bdata->code, 0);
418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434
		input_sync(input);
		bdata->key_pressed = false;
	}
	spin_unlock_irqrestore(&bdata->lock, flags);
}

static irqreturn_t gpio_keys_irq_isr(int irq, void *dev_id)
{
	struct gpio_button_data *bdata = dev_id;
	struct input_dev *input = bdata->input;
	unsigned long flags;

	BUG_ON(irq != bdata->irq);

	spin_lock_irqsave(&bdata->lock, flags);

	if (!bdata->key_pressed) {
435 436 437
		if (bdata->button->wakeup)
			pm_wakeup_event(bdata->input->dev.parent, 0);

438
		input_event(input, EV_KEY, *bdata->code, 1);
439 440
		input_sync(input);

441
		if (!bdata->release_delay) {
442
			input_event(input, EV_KEY, *bdata->code, 0);
443 444 445 446 447 448 449
			input_sync(input);
			goto out;
		}

		bdata->key_pressed = true;
	}

450 451 452
	if (bdata->release_delay)
		mod_timer(&bdata->release_timer,
			jiffies + msecs_to_jiffies(bdata->release_delay));
453 454 455 456 457
out:
	spin_unlock_irqrestore(&bdata->lock, flags);
	return IRQ_HANDLED;
}

458 459 460 461
static void gpio_keys_quiesce_key(void *data)
{
	struct gpio_button_data *bdata = data;

462
	if (bdata->gpiod)
463 464 465
		cancel_delayed_work_sync(&bdata->work);
	else
		del_timer_sync(&bdata->release_timer);
466 467
}

B
Bill Pemberton 已提交
468 469
static int gpio_keys_setup_key(struct platform_device *pdev,
				struct input_dev *input,
470
				struct gpio_keys_drvdata *ddata,
471
				const struct gpio_keys_button *button,
472
				int idx,
473
				struct fwnode_handle *child)
474
{
475
	const char *desc = button->desc ? button->desc : "gpio_keys";
476
	struct device *dev = &pdev->dev;
477
	struct gpio_button_data *bdata = &ddata->data[idx];
478
	irq_handler_t isr;
479
	unsigned long irqflags;
480 481
	int irq;
	int error;
482

483 484
	bdata->input = input;
	bdata->button = button;
485
	spin_lock_init(&bdata->lock);
486

487
	if (child) {
488 489 490 491
		bdata->gpiod = devm_fwnode_get_gpiod_from_child(dev, NULL,
								child,
								GPIOD_IN,
								desc);
492 493 494 495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 510 511
		if (IS_ERR(bdata->gpiod)) {
			error = PTR_ERR(bdata->gpiod);
			if (error == -ENOENT) {
				/*
				 * GPIO is optional, we may be dealing with
				 * purely interrupt-driven setup.
				 */
				bdata->gpiod = NULL;
			} else {
				if (error != -EPROBE_DEFER)
					dev_err(dev, "failed to get gpio: %d\n",
						error);
				return error;
			}
		}
	} else if (gpio_is_valid(button->gpio)) {
		/*
		 * Legacy GPIO number, so request the GPIO here and
		 * convert it to descriptor.
		 */
512 513 514 515
		unsigned flags = GPIOF_IN;

		if (button->active_low)
			flags |= GPIOF_ACTIVE_LOW;
516

517
		error = devm_gpio_request_one(dev, button->gpio, flags, desc);
518 519 520 521 522
		if (error < 0) {
			dev_err(dev, "Failed to request GPIO %d, error %d\n",
				button->gpio, error);
			return error;
		}
523

524 525 526
		bdata->gpiod = gpio_to_desc(button->gpio);
		if (!bdata->gpiod)
			return -EINVAL;
527
	}
528

529
	if (bdata->gpiod) {
530
		if (button->debounce_interval) {
531
			error = gpiod_set_debounce(bdata->gpiod,
532 533 534
					button->debounce_interval * 1000);
			/* use timer if gpiolib doesn't provide debounce */
			if (error < 0)
535
				bdata->software_debounce =
536 537 538
						button->debounce_interval;
		}

539 540 541
		if (button->irq) {
			bdata->irq = button->irq;
		} else {
542
			irq = gpiod_to_irq(bdata->gpiod);
543 544 545 546 547 548 549 550
			if (irq < 0) {
				error = irq;
				dev_err(dev,
					"Unable to get irq number for GPIO %d, error %d\n",
					button->gpio, error);
				return error;
			}
			bdata->irq = irq;
551 552
		}

553
		INIT_DELAYED_WORK(&bdata->work, gpio_keys_gpio_work_func);
554 555 556 557 558 559

		isr = gpio_keys_gpio_isr;
		irqflags = IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING;

	} else {
		if (!button->irq) {
560
			dev_err(dev, "Found button without gpio or irq\n");
561 562
			return -EINVAL;
		}
563

564 565 566 567 568 569 570
		bdata->irq = button->irq;

		if (button->type && button->type != EV_KEY) {
			dev_err(dev, "Only EV_KEY allowed for IRQ buttons.\n");
			return -EINVAL;
		}

571 572
		bdata->release_delay = button->debounce_interval;
		setup_timer(&bdata->release_timer,
573 574 575 576
			    gpio_keys_irq_timer, (unsigned long)bdata);

		isr = gpio_keys_irq_isr;
		irqflags = 0;
577 578
	}

579 580 581
	bdata->code = &ddata->keymap[idx];
	*bdata->code = button->code;
	input_set_capability(input, button->type ?: EV_KEY, *bdata->code);
582

583
	/*
584
	 * Install custom action to cancel release timer and
585 586
	 * workqueue item.
	 */
587
	error = devm_add_action(dev, gpio_keys_quiesce_key, bdata);
588
	if (error) {
589
		dev_err(dev, "failed to register quiesce action, error: %d\n",
590 591 592 593
			error);
		return error;
	}

594 595 596 597 598 599 600
	/*
	 * If platform has specified that the button can be disabled,
	 * we don't want it to share the interrupt line.
	 */
	if (!button->can_disable)
		irqflags |= IRQF_SHARED;

601 602
	error = devm_request_any_context_irq(dev, bdata->irq, isr, irqflags,
					     desc, bdata);
603
	if (error < 0) {
604
		dev_err(dev, "Unable to claim irq %d; error %d\n",
605
			bdata->irq, error);
606
		return error;
607 608 609 610 611
	}

	return 0;
}

612 613 614 615 616 617 618
static void gpio_keys_report_state(struct gpio_keys_drvdata *ddata)
{
	struct input_dev *input = ddata->input;
	int i;

	for (i = 0; i < ddata->pdata->nbuttons; i++) {
		struct gpio_button_data *bdata = &ddata->data[i];
619
		if (bdata->gpiod)
620 621 622 623 624
			gpio_keys_gpio_report_event(bdata);
	}
	input_sync(input);
}

625 626 627
static int gpio_keys_open(struct input_dev *input)
{
	struct gpio_keys_drvdata *ddata = input_get_drvdata(input);
628
	const struct gpio_keys_platform_data *pdata = ddata->pdata;
629 630 631 632 633 634 635
	int error;

	if (pdata->enable) {
		error = pdata->enable(input->dev.parent);
		if (error)
			return error;
	}
636

637 638 639 640
	/* Report current state of buttons that are connected to GPIOs */
	gpio_keys_report_state(ddata);

	return 0;
641 642 643 644 645
}

static void gpio_keys_close(struct input_dev *input)
{
	struct gpio_keys_drvdata *ddata = input_get_drvdata(input);
646
	const struct gpio_keys_platform_data *pdata = ddata->pdata;
647

648 649
	if (pdata->disable)
		pdata->disable(input->dev.parent);
650 651
}

652 653 654
/*
 * Handlers for alternative sources of platform_data
 */
655

656
/*
657
 * Translate properties into platform_data
658
 */
B
Bill Pemberton 已提交
659
static struct gpio_keys_platform_data *
660
gpio_keys_get_devtree_pdata(struct device *dev)
661
{
662 663
	struct gpio_keys_platform_data *pdata;
	struct gpio_keys_button *button;
664
	struct fwnode_handle *child;
665
	int nbuttons;
666

667
	nbuttons = device_get_child_node_count(dev);
668 669
	if (nbuttons == 0)
		return ERR_PTR(-ENODEV);
670

671 672 673 674 675
	pdata = devm_kzalloc(dev,
			     sizeof(*pdata) + nbuttons * sizeof(*button),
			     GFP_KERNEL);
	if (!pdata)
		return ERR_PTR(-ENOMEM);
676

677 678 679
	button = (struct gpio_keys_button *)(pdata + 1);

	pdata->buttons = button;
680
	pdata->nbuttons = nbuttons;
681

682
	pdata->rep = device_property_read_bool(dev, "autorepeat");
683

684
	device_property_read_string(dev, "label", &pdata->name);
685

686 687 688 689
	device_for_each_child_node(dev, child) {
		if (is_of_node(child))
			button->irq =
				irq_of_parse_and_map(to_of_node(child), 0);
690

691 692 693 694
		if (fwnode_property_read_u32(child, "linux,code",
					     &button->code)) {
			dev_err(dev, "Button without keycode\n");
			fwnode_handle_put(child);
695
			return ERR_PTR(-EINVAL);
696
		}
697

698
		fwnode_property_read_string(child, "label", &button->desc);
699

700 701
		if (fwnode_property_read_u32(child, "linux,input-type",
					     &button->type))
702 703
			button->type = EV_KEY;

704 705 706 707
		button->wakeup =
			fwnode_property_read_bool(child, "wakeup-source") ||
			/* legacy name */
			fwnode_property_read_bool(child, "gpio-key,wakeup");
708

709 710
		button->can_disable =
			fwnode_property_read_bool(child, "linux,can-disable");
711

712
		if (fwnode_property_read_u32(child, "debounce-interval",
713 714
					 &button->debounce_interval))
			button->debounce_interval = 5;
715 716

		button++;
717 718
	}

719
	return pdata;
720 721
}

722
static const struct of_device_id gpio_keys_of_match[] = {
723 724 725 726 727
	{ .compatible = "gpio-keys", },
	{ },
};
MODULE_DEVICE_TABLE(of, gpio_keys_of_match);

B
Bill Pemberton 已提交
728
static int gpio_keys_probe(struct platform_device *pdev)
729
{
730
	struct device *dev = &pdev->dev;
731
	const struct gpio_keys_platform_data *pdata = dev_get_platdata(dev);
732
	struct fwnode_handle *child = NULL;
733
	struct gpio_keys_drvdata *ddata;
734
	struct input_dev *input;
735
	size_t size;
736
	int i, error;
737
	int wakeup = 0;
738

739
	if (!pdata) {
740 741 742
		pdata = gpio_keys_get_devtree_pdata(dev);
		if (IS_ERR(pdata))
			return PTR_ERR(pdata);
743 744
	}

745 746 747 748
	size = sizeof(struct gpio_keys_drvdata) +
			pdata->nbuttons * sizeof(struct gpio_button_data);
	ddata = devm_kzalloc(dev, size, GFP_KERNEL);
	if (!ddata) {
749
		dev_err(dev, "failed to allocate state\n");
750 751 752
		return -ENOMEM;
	}

753 754 755 756 757 758
	ddata->keymap = devm_kcalloc(dev,
				     pdata->nbuttons, sizeof(ddata->keymap[0]),
				     GFP_KERNEL);
	if (!ddata->keymap)
		return -ENOMEM;

759 760 761 762
	input = devm_input_allocate_device(dev);
	if (!input) {
		dev_err(dev, "failed to allocate input device\n");
		return -ENOMEM;
763
	}
764

765
	ddata->pdata = pdata;
766 767 768
	ddata->input = input;
	mutex_init(&ddata->disable_lock);

769
	platform_set_drvdata(pdev, ddata);
770
	input_set_drvdata(input, ddata);
771

772
	input->name = pdata->name ? : pdev->name;
773
	input->phys = "gpio-keys/input0";
774
	input->dev.parent = dev;
775 776
	input->open = gpio_keys_open;
	input->close = gpio_keys_close;
777 778 779 780 781 782

	input->id.bustype = BUS_HOST;
	input->id.vendor = 0x0001;
	input->id.product = 0x0001;
	input->id.version = 0x0100;

783 784 785 786
	input->keycode = ddata->keymap;
	input->keycodesize = sizeof(ddata->keymap[0]);
	input->keycodemax = pdata->nbuttons;

787 788 789 790
	/* Enable auto repeat feature of Linux input subsystem */
	if (pdata->rep)
		__set_bit(EV_REP, input->evbit);

791
	for (i = 0; i < pdata->nbuttons; i++) {
792
		const struct gpio_keys_button *button = &pdata->buttons[i];
793

794
		if (!dev_get_platdata(dev)) {
795
			child = device_get_next_child_node(dev, child);
796
			if (!child) {
797
				dev_err(dev,
798 799 800 801 802 803
					"missing child device node for entry %d\n",
					i);
				return -EINVAL;
			}
		}

804 805
		error = gpio_keys_setup_key(pdev, input, ddata,
					    button, i, child);
806 807
		if (error) {
			fwnode_handle_put(child);
808
			return error;
809
		}
810

811 812
		if (button->wakeup)
			wakeup = 1;
813 814
	}

815 816
	fwnode_handle_put(child);

817
	error = sysfs_create_group(&dev->kobj, &gpio_keys_attr_group);
818
	if (error) {
819 820
		dev_err(dev, "Unable to export keys/switches, error: %d\n",
			error);
821
		return error;
822 823
	}

824 825 826 827
	error = input_register_device(input);
	if (error) {
		dev_err(dev, "Unable to register input device, error: %d\n",
			error);
828
		goto err_remove_group;
829 830
	}

831
	device_init_wakeup(dev, wakeup);
832

833 834
	return 0;

835
err_remove_group:
836
	sysfs_remove_group(&dev->kobj, &gpio_keys_attr_group);
837 838 839
	return error;
}

B
Bill Pemberton 已提交
840
static int gpio_keys_remove(struct platform_device *pdev)
841
{
842 843
	sysfs_remove_group(&pdev->dev.kobj, &gpio_keys_attr_group);

844 845 846
	return 0;
}

847
static int __maybe_unused gpio_keys_suspend(struct device *dev)
848
{
849
	struct gpio_keys_drvdata *ddata = dev_get_drvdata(dev);
850
	struct input_dev *input = ddata->input;
851 852
	int i;

853
	if (device_may_wakeup(dev)) {
854
		for (i = 0; i < ddata->pdata->nbuttons; i++) {
855 856 857
			struct gpio_button_data *bdata = &ddata->data[i];
			if (bdata->button->wakeup)
				enable_irq_wake(bdata->irq);
858
		}
859 860 861 862 863
	} else {
		mutex_lock(&input->mutex);
		if (input->users)
			gpio_keys_close(input);
		mutex_unlock(&input->mutex);
864 865 866 867 868
	}

	return 0;
}

869
static int __maybe_unused gpio_keys_resume(struct device *dev)
870
{
871
	struct gpio_keys_drvdata *ddata = dev_get_drvdata(dev);
872 873
	struct input_dev *input = ddata->input;
	int error = 0;
874 875
	int i;

876 877 878 879 880 881 882 883 884 885 886
	if (device_may_wakeup(dev)) {
		for (i = 0; i < ddata->pdata->nbuttons; i++) {
			struct gpio_button_data *bdata = &ddata->data[i];
			if (bdata->button->wakeup)
				disable_irq_wake(bdata->irq);
		}
	} else {
		mutex_lock(&input->mutex);
		if (input->users)
			error = gpio_keys_open(input);
		mutex_unlock(&input->mutex);
887
	}
888

889 890
	if (error)
		return error;
891

892
	gpio_keys_report_state(ddata);
893 894 895
	return 0;
}

896 897
static SIMPLE_DEV_PM_OPS(gpio_keys_pm_ops, gpio_keys_suspend, gpio_keys_resume);

898
static struct platform_driver gpio_keys_device_driver = {
899
	.probe		= gpio_keys_probe,
B
Bill Pemberton 已提交
900
	.remove		= gpio_keys_remove,
901 902
	.driver		= {
		.name	= "gpio-keys",
903
		.pm	= &gpio_keys_pm_ops,
904
		.of_match_table = gpio_keys_of_match,
905 906 907 908 909 910 911 912 913 914 915 916 917
	}
};

static int __init gpio_keys_init(void)
{
	return platform_driver_register(&gpio_keys_device_driver);
}

static void __exit gpio_keys_exit(void)
{
	platform_driver_unregister(&gpio_keys_device_driver);
}

918
late_initcall(gpio_keys_init);
919 920 921 922
module_exit(gpio_keys_exit);

MODULE_LICENSE("GPL");
MODULE_AUTHOR("Phil Blundell <pb@handhelds.org>");
923
MODULE_DESCRIPTION("Keyboard driver for GPIOs");
924
MODULE_ALIAS("platform:gpio-keys");