2018-06-20 01:18:50 +07:00
|
|
|
// SPDX-License-Identifier: GPL-2.0
|
|
|
|
//
|
|
|
|
// Driver for the IMX keypad port.
|
|
|
|
// Copyright (C) 2009 Alberto Panizzo <maramaopercheseimorto@gmail.com>
|
2010-02-01 08:52:07 +07:00
|
|
|
|
|
|
|
#include <linux/clk.h>
|
|
|
|
#include <linux/delay.h>
|
|
|
|
#include <linux/device.h>
|
|
|
|
#include <linux/err.h>
|
|
|
|
#include <linux/input/matrix_keypad.h>
|
|
|
|
#include <linux/interrupt.h>
|
|
|
|
#include <linux/io.h>
|
|
|
|
#include <linux/jiffies.h>
|
|
|
|
#include <linux/kernel.h>
|
|
|
|
#include <linux/module.h>
|
2013-01-04 03:25:46 +07:00
|
|
|
#include <linux/of.h>
|
2010-02-01 08:52:07 +07:00
|
|
|
#include <linux/platform_device.h>
|
include cleanup: Update gfp.h and slab.h includes to prepare for breaking implicit slab.h inclusion from percpu.h
percpu.h is included by sched.h and module.h and thus ends up being
included when building most .c files. percpu.h includes slab.h which
in turn includes gfp.h making everything defined by the two files
universally available and complicating inclusion dependencies.
percpu.h -> slab.h dependency is about to be removed. Prepare for
this change by updating users of gfp and slab facilities include those
headers directly instead of assuming availability. As this conversion
needs to touch large number of source files, the following script is
used as the basis of conversion.
http://userweb.kernel.org/~tj/misc/slabh-sweep.py
The script does the followings.
* Scan files for gfp and slab usages and update includes such that
only the necessary includes are there. ie. if only gfp is used,
gfp.h, if slab is used, slab.h.
* When the script inserts a new include, it looks at the include
blocks and try to put the new include such that its order conforms
to its surrounding. It's put in the include block which contains
core kernel includes, in the same order that the rest are ordered -
alphabetical, Christmas tree, rev-Xmas-tree or at the end if there
doesn't seem to be any matching order.
* If the script can't find a place to put a new include (mostly
because the file doesn't have fitting include block), it prints out
an error message indicating which .h file needs to be added to the
file.
The conversion was done in the following steps.
1. The initial automatic conversion of all .c files updated slightly
over 4000 files, deleting around 700 includes and adding ~480 gfp.h
and ~3000 slab.h inclusions. The script emitted errors for ~400
files.
2. Each error was manually checked. Some didn't need the inclusion,
some needed manual addition while adding it to implementation .h or
embedding .c file was more appropriate for others. This step added
inclusions to around 150 files.
3. The script was run again and the output was compared to the edits
from #2 to make sure no file was left behind.
4. Several build tests were done and a couple of problems were fixed.
e.g. lib/decompress_*.c used malloc/free() wrappers around slab
APIs requiring slab.h to be added manually.
5. The script was run on all .h files but without automatically
editing them as sprinkling gfp.h and slab.h inclusions around .h
files could easily lead to inclusion dependency hell. Most gfp.h
inclusion directives were ignored as stuff from gfp.h was usually
wildly available and often used in preprocessor macros. Each
slab.h inclusion directive was examined and added manually as
necessary.
6. percpu.h was updated not to include slab.h.
7. Build test were done on the following configurations and failures
were fixed. CONFIG_GCOV_KERNEL was turned off for all tests (as my
distributed build env didn't work with gcov compiles) and a few
more options had to be turned off depending on archs to make things
build (like ipr on powerpc/64 which failed due to missing writeq).
* x86 and x86_64 UP and SMP allmodconfig and a custom test config.
* powerpc and powerpc64 SMP allmodconfig
* sparc and sparc64 SMP allmodconfig
* ia64 SMP allmodconfig
* s390 SMP allmodconfig
* alpha SMP allmodconfig
* um on x86_64 SMP allmodconfig
8. percpu.h modifications were reverted so that it could be applied as
a separate patch and serve as bisection point.
Given the fact that I had only a couple of failures from tests on step
6, I'm fairly confident about the coverage of this conversion patch.
If there is a breakage, it's likely to be something in one of the arch
headers which should be easily discoverable easily on most builds of
the specific arch.
Signed-off-by: Tejun Heo <tj@kernel.org>
Guess-its-ok-by: Christoph Lameter <cl@linux-foundation.org>
Cc: Ingo Molnar <mingo@redhat.com>
Cc: Lee Schermerhorn <Lee.Schermerhorn@hp.com>
2010-03-24 15:04:11 +07:00
|
|
|
#include <linux/slab.h>
|
2010-02-01 08:52:07 +07:00
|
|
|
#include <linux/timer.h>
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Keypad Controller registers (halfword)
|
|
|
|
*/
|
|
|
|
#define KPCR 0x00 /* Keypad Control Register */
|
|
|
|
|
|
|
|
#define KPSR 0x02 /* Keypad Status Register */
|
|
|
|
#define KBD_STAT_KPKD (0x1 << 0) /* Key Press Interrupt Status bit (w1c) */
|
|
|
|
#define KBD_STAT_KPKR (0x1 << 1) /* Key Release Interrupt Status bit (w1c) */
|
|
|
|
#define KBD_STAT_KDSC (0x1 << 2) /* Key Depress Synch Chain Status bit (w1c)*/
|
|
|
|
#define KBD_STAT_KRSS (0x1 << 3) /* Key Release Synch Status bit (w1c)*/
|
|
|
|
#define KBD_STAT_KDIE (0x1 << 8) /* Key Depress Interrupt Enable Status bit */
|
|
|
|
#define KBD_STAT_KRIE (0x1 << 9) /* Key Release Interrupt Enable */
|
|
|
|
#define KBD_STAT_KPPEN (0x1 << 10) /* Keypad Clock Enable */
|
|
|
|
|
|
|
|
#define KDDR 0x04 /* Keypad Data Direction Register */
|
|
|
|
#define KPDR 0x06 /* Keypad Data Register */
|
|
|
|
|
|
|
|
#define MAX_MATRIX_KEY_ROWS 8
|
|
|
|
#define MAX_MATRIX_KEY_COLS 8
|
|
|
|
#define MATRIX_ROW_SHIFT 3
|
|
|
|
|
|
|
|
#define MAX_MATRIX_KEY_NUM (MAX_MATRIX_KEY_ROWS * MAX_MATRIX_KEY_COLS)
|
|
|
|
|
|
|
|
struct imx_keypad {
|
|
|
|
|
|
|
|
struct clk *clk;
|
|
|
|
struct input_dev *input_dev;
|
|
|
|
void __iomem *mmio_base;
|
|
|
|
|
|
|
|
int irq;
|
|
|
|
struct timer_list check_matrix_timer;
|
|
|
|
|
|
|
|
/*
|
|
|
|
* The matrix is stable only if no changes are detected after
|
|
|
|
* IMX_KEYPAD_SCANS_FOR_STABILITY scans
|
|
|
|
*/
|
|
|
|
#define IMX_KEYPAD_SCANS_FOR_STABILITY 3
|
|
|
|
int stable_count;
|
|
|
|
|
|
|
|
bool enabled;
|
|
|
|
|
|
|
|
/* Masks for enabled rows/cols */
|
|
|
|
unsigned short rows_en_mask;
|
|
|
|
unsigned short cols_en_mask;
|
|
|
|
|
|
|
|
unsigned short keycodes[MAX_MATRIX_KEY_NUM];
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Matrix states:
|
|
|
|
* -stable: achieved after a complete debounce process.
|
|
|
|
* -unstable: used in the debouncing process.
|
|
|
|
*/
|
|
|
|
unsigned short matrix_stable_state[MAX_MATRIX_KEY_COLS];
|
|
|
|
unsigned short matrix_unstable_state[MAX_MATRIX_KEY_COLS];
|
|
|
|
};
|
|
|
|
|
|
|
|
/* Scan the matrix and return the new state in *matrix_volatile_state. */
|
|
|
|
static void imx_keypad_scan_matrix(struct imx_keypad *keypad,
|
|
|
|
unsigned short *matrix_volatile_state)
|
|
|
|
{
|
|
|
|
int col;
|
|
|
|
unsigned short reg_val;
|
|
|
|
|
|
|
|
for (col = 0; col < MAX_MATRIX_KEY_COLS; col++) {
|
|
|
|
if ((keypad->cols_en_mask & (1 << col)) == 0)
|
|
|
|
continue;
|
|
|
|
/*
|
|
|
|
* Discharge keypad capacitance:
|
|
|
|
* 2. write 1s on column data.
|
|
|
|
* 3. configure columns as totem-pole to discharge capacitance.
|
|
|
|
* 4. configure columns as open-drain.
|
|
|
|
*/
|
|
|
|
reg_val = readw(keypad->mmio_base + KPDR);
|
|
|
|
reg_val |= 0xff00;
|
|
|
|
writew(reg_val, keypad->mmio_base + KPDR);
|
|
|
|
|
|
|
|
reg_val = readw(keypad->mmio_base + KPCR);
|
|
|
|
reg_val &= ~((keypad->cols_en_mask & 0xff) << 8);
|
|
|
|
writew(reg_val, keypad->mmio_base + KPCR);
|
|
|
|
|
|
|
|
udelay(2);
|
|
|
|
|
|
|
|
reg_val = readw(keypad->mmio_base + KPCR);
|
|
|
|
reg_val |= (keypad->cols_en_mask & 0xff) << 8;
|
|
|
|
writew(reg_val, keypad->mmio_base + KPCR);
|
|
|
|
|
|
|
|
/*
|
|
|
|
* 5. Write a single column to 0, others to 1.
|
|
|
|
* 6. Sample row inputs and save data.
|
|
|
|
* 7. Repeat steps 2 - 6 for remaining columns.
|
|
|
|
*/
|
|
|
|
reg_val = readw(keypad->mmio_base + KPDR);
|
|
|
|
reg_val &= ~(1 << (8 + col));
|
|
|
|
writew(reg_val, keypad->mmio_base + KPDR);
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Delay added to avoid propagating the 0 from column to row
|
|
|
|
* when scanning.
|
|
|
|
*/
|
|
|
|
udelay(5);
|
|
|
|
|
|
|
|
/*
|
|
|
|
* 1s in matrix_volatile_state[col] means key pressures
|
|
|
|
* throw data from non enabled rows.
|
|
|
|
*/
|
|
|
|
reg_val = readw(keypad->mmio_base + KPDR);
|
|
|
|
matrix_volatile_state[col] = (~reg_val) & keypad->rows_en_mask;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Return in standby mode:
|
|
|
|
* 9. write 0s to columns
|
|
|
|
*/
|
|
|
|
reg_val = readw(keypad->mmio_base + KPDR);
|
|
|
|
reg_val &= 0x00ff;
|
|
|
|
writew(reg_val, keypad->mmio_base + KPDR);
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Compare the new matrix state (volatile) with the stable one stored in
|
|
|
|
* keypad->matrix_stable_state and fire events if changes are detected.
|
|
|
|
*/
|
|
|
|
static void imx_keypad_fire_events(struct imx_keypad *keypad,
|
|
|
|
unsigned short *matrix_volatile_state)
|
|
|
|
{
|
|
|
|
struct input_dev *input_dev = keypad->input_dev;
|
|
|
|
int row, col;
|
|
|
|
|
|
|
|
for (col = 0; col < MAX_MATRIX_KEY_COLS; col++) {
|
|
|
|
unsigned short bits_changed;
|
|
|
|
int code;
|
|
|
|
|
|
|
|
if ((keypad->cols_en_mask & (1 << col)) == 0)
|
|
|
|
continue; /* Column is not enabled */
|
|
|
|
|
|
|
|
bits_changed = keypad->matrix_stable_state[col] ^
|
|
|
|
matrix_volatile_state[col];
|
|
|
|
|
|
|
|
if (bits_changed == 0)
|
|
|
|
continue; /* Column does not contain changes */
|
|
|
|
|
|
|
|
for (row = 0; row < MAX_MATRIX_KEY_ROWS; row++) {
|
|
|
|
if ((keypad->rows_en_mask & (1 << row)) == 0)
|
|
|
|
continue; /* Row is not enabled */
|
|
|
|
if ((bits_changed & (1 << row)) == 0)
|
|
|
|
continue; /* Row does not contain changes */
|
|
|
|
|
|
|
|
code = MATRIX_SCAN_CODE(row, col, MATRIX_ROW_SHIFT);
|
|
|
|
input_event(input_dev, EV_MSC, MSC_SCAN, code);
|
|
|
|
input_report_key(input_dev, keypad->keycodes[code],
|
|
|
|
matrix_volatile_state[col] & (1 << row));
|
|
|
|
dev_dbg(&input_dev->dev, "Event code: %d, val: %d",
|
|
|
|
keypad->keycodes[code],
|
|
|
|
matrix_volatile_state[col] & (1 << row));
|
|
|
|
}
|
|
|
|
}
|
|
|
|
input_sync(input_dev);
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* imx_keypad_check_for_events is the timer handler.
|
|
|
|
*/
|
2017-10-24 23:40:57 +07:00
|
|
|
static void imx_keypad_check_for_events(struct timer_list *t)
|
2010-02-01 08:52:07 +07:00
|
|
|
{
|
2017-10-24 23:40:57 +07:00
|
|
|
struct imx_keypad *keypad = from_timer(keypad, t, check_matrix_timer);
|
2010-02-01 08:52:07 +07:00
|
|
|
unsigned short matrix_volatile_state[MAX_MATRIX_KEY_COLS];
|
|
|
|
unsigned short reg_val;
|
|
|
|
bool state_changed, is_zero_matrix;
|
|
|
|
int i;
|
|
|
|
|
|
|
|
memset(matrix_volatile_state, 0, sizeof(matrix_volatile_state));
|
|
|
|
|
|
|
|
imx_keypad_scan_matrix(keypad, matrix_volatile_state);
|
|
|
|
|
|
|
|
state_changed = false;
|
|
|
|
for (i = 0; i < MAX_MATRIX_KEY_COLS; i++) {
|
|
|
|
if ((keypad->cols_en_mask & (1 << i)) == 0)
|
|
|
|
continue;
|
|
|
|
|
|
|
|
if (keypad->matrix_unstable_state[i] ^ matrix_volatile_state[i]) {
|
|
|
|
state_changed = true;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* If the matrix state is changed from the previous scan
|
|
|
|
* (Re)Begin the debouncing process, saving the new state in
|
|
|
|
* keypad->matrix_unstable_state.
|
|
|
|
* else
|
|
|
|
* Increase the count of number of scans with a stable state.
|
|
|
|
*/
|
|
|
|
if (state_changed) {
|
|
|
|
memcpy(keypad->matrix_unstable_state, matrix_volatile_state,
|
|
|
|
sizeof(matrix_volatile_state));
|
|
|
|
keypad->stable_count = 0;
|
|
|
|
} else
|
|
|
|
keypad->stable_count++;
|
|
|
|
|
|
|
|
/*
|
|
|
|
* If the matrix is not as stable as we want reschedule scan
|
|
|
|
* in the near future.
|
|
|
|
*/
|
|
|
|
if (keypad->stable_count < IMX_KEYPAD_SCANS_FOR_STABILITY) {
|
|
|
|
mod_timer(&keypad->check_matrix_timer,
|
|
|
|
jiffies + msecs_to_jiffies(10));
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* If the matrix state is stable, fire the events and save the new
|
|
|
|
* stable state. Note, if the matrix is kept stable for longer
|
|
|
|
* (keypad->stable_count > IMX_KEYPAD_SCANS_FOR_STABILITY) all
|
|
|
|
* events have already been generated.
|
|
|
|
*/
|
|
|
|
if (keypad->stable_count == IMX_KEYPAD_SCANS_FOR_STABILITY) {
|
|
|
|
imx_keypad_fire_events(keypad, matrix_volatile_state);
|
|
|
|
|
|
|
|
memcpy(keypad->matrix_stable_state, matrix_volatile_state,
|
|
|
|
sizeof(matrix_volatile_state));
|
|
|
|
}
|
|
|
|
|
|
|
|
is_zero_matrix = true;
|
|
|
|
for (i = 0; i < MAX_MATRIX_KEY_COLS; i++) {
|
|
|
|
if (matrix_volatile_state[i] != 0) {
|
|
|
|
is_zero_matrix = false;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
if (is_zero_matrix) {
|
|
|
|
/*
|
|
|
|
* All keys have been released. Enable only the KDI
|
|
|
|
* interrupt for future key presses (clear the KDI
|
|
|
|
* status bit and its sync chain before that).
|
|
|
|
*/
|
|
|
|
reg_val = readw(keypad->mmio_base + KPSR);
|
|
|
|
reg_val |= KBD_STAT_KPKD | KBD_STAT_KDSC;
|
|
|
|
writew(reg_val, keypad->mmio_base + KPSR);
|
|
|
|
|
|
|
|
reg_val = readw(keypad->mmio_base + KPSR);
|
|
|
|
reg_val |= KBD_STAT_KDIE;
|
|
|
|
reg_val &= ~KBD_STAT_KRIE;
|
|
|
|
writew(reg_val, keypad->mmio_base + KPSR);
|
|
|
|
} else {
|
|
|
|
/*
|
|
|
|
* Some keys are still pressed. Schedule a rescan in
|
|
|
|
* attempt to detect multiple key presses and enable
|
|
|
|
* the KRI interrupt to react quickly to key release
|
|
|
|
* event.
|
|
|
|
*/
|
|
|
|
mod_timer(&keypad->check_matrix_timer,
|
|
|
|
jiffies + msecs_to_jiffies(60));
|
|
|
|
|
|
|
|
reg_val = readw(keypad->mmio_base + KPSR);
|
|
|
|
reg_val |= KBD_STAT_KPKR | KBD_STAT_KRSS;
|
|
|
|
writew(reg_val, keypad->mmio_base + KPSR);
|
|
|
|
|
|
|
|
reg_val = readw(keypad->mmio_base + KPSR);
|
|
|
|
reg_val |= KBD_STAT_KRIE;
|
|
|
|
reg_val &= ~KBD_STAT_KDIE;
|
|
|
|
writew(reg_val, keypad->mmio_base + KPSR);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
static irqreturn_t imx_keypad_irq_handler(int irq, void *dev_id)
|
|
|
|
{
|
|
|
|
struct imx_keypad *keypad = dev_id;
|
|
|
|
unsigned short reg_val;
|
|
|
|
|
|
|
|
reg_val = readw(keypad->mmio_base + KPSR);
|
|
|
|
|
|
|
|
/* Disable both interrupt types */
|
|
|
|
reg_val &= ~(KBD_STAT_KRIE | KBD_STAT_KDIE);
|
|
|
|
/* Clear interrupts status bits */
|
|
|
|
reg_val |= KBD_STAT_KPKR | KBD_STAT_KPKD;
|
|
|
|
writew(reg_val, keypad->mmio_base + KPSR);
|
|
|
|
|
|
|
|
if (keypad->enabled) {
|
|
|
|
/* The matrix is supposed to be changed */
|
|
|
|
keypad->stable_count = 0;
|
|
|
|
|
|
|
|
/* Schedule the scanning procedure near in the future */
|
|
|
|
mod_timer(&keypad->check_matrix_timer,
|
|
|
|
jiffies + msecs_to_jiffies(2));
|
|
|
|
}
|
|
|
|
|
|
|
|
return IRQ_HANDLED;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void imx_keypad_config(struct imx_keypad *keypad)
|
|
|
|
{
|
|
|
|
unsigned short reg_val;
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Include enabled rows in interrupt generation (KPCR[7:0])
|
|
|
|
* Configure keypad columns as open-drain (KPCR[15:8])
|
|
|
|
*/
|
|
|
|
reg_val = readw(keypad->mmio_base + KPCR);
|
|
|
|
reg_val |= keypad->rows_en_mask & 0xff; /* rows */
|
|
|
|
reg_val |= (keypad->cols_en_mask & 0xff) << 8; /* cols */
|
|
|
|
writew(reg_val, keypad->mmio_base + KPCR);
|
|
|
|
|
|
|
|
/* Write 0's to KPDR[15:8] (Colums) */
|
|
|
|
reg_val = readw(keypad->mmio_base + KPDR);
|
|
|
|
reg_val &= 0x00ff;
|
|
|
|
writew(reg_val, keypad->mmio_base + KPDR);
|
|
|
|
|
|
|
|
/* Configure columns as output, rows as input (KDDR[15:0]) */
|
|
|
|
writew(0xff00, keypad->mmio_base + KDDR);
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Clear Key Depress and Key Release status bit.
|
|
|
|
* Clear both synchronizer chain.
|
|
|
|
*/
|
|
|
|
reg_val = readw(keypad->mmio_base + KPSR);
|
|
|
|
reg_val |= KBD_STAT_KPKR | KBD_STAT_KPKD |
|
|
|
|
KBD_STAT_KDSC | KBD_STAT_KRSS;
|
|
|
|
writew(reg_val, keypad->mmio_base + KPSR);
|
|
|
|
|
|
|
|
/* Enable KDI and disable KRI (avoid false release events). */
|
|
|
|
reg_val |= KBD_STAT_KDIE;
|
|
|
|
reg_val &= ~KBD_STAT_KRIE;
|
|
|
|
writew(reg_val, keypad->mmio_base + KPSR);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void imx_keypad_inhibit(struct imx_keypad *keypad)
|
|
|
|
{
|
|
|
|
unsigned short reg_val;
|
|
|
|
|
|
|
|
/* Inhibit KDI and KRI interrupts. */
|
|
|
|
reg_val = readw(keypad->mmio_base + KPSR);
|
|
|
|
reg_val &= ~(KBD_STAT_KRIE | KBD_STAT_KDIE);
|
2012-08-22 11:57:15 +07:00
|
|
|
reg_val |= KBD_STAT_KPKR | KBD_STAT_KPKD;
|
2010-02-01 08:52:07 +07:00
|
|
|
writew(reg_val, keypad->mmio_base + KPSR);
|
|
|
|
|
|
|
|
/* Colums as open drain and disable all rows */
|
2012-11-25 14:31:38 +07:00
|
|
|
reg_val = (keypad->cols_en_mask & 0xff) << 8;
|
|
|
|
writew(reg_val, keypad->mmio_base + KPCR);
|
2010-02-01 08:52:07 +07:00
|
|
|
}
|
|
|
|
|
|
|
|
static void imx_keypad_close(struct input_dev *dev)
|
|
|
|
{
|
|
|
|
struct imx_keypad *keypad = input_get_drvdata(dev);
|
|
|
|
|
|
|
|
dev_dbg(&dev->dev, ">%s\n", __func__);
|
|
|
|
|
|
|
|
/* Mark keypad as being inactive */
|
|
|
|
keypad->enabled = false;
|
|
|
|
synchronize_irq(keypad->irq);
|
|
|
|
del_timer_sync(&keypad->check_matrix_timer);
|
|
|
|
|
|
|
|
imx_keypad_inhibit(keypad);
|
|
|
|
|
|
|
|
/* Disable clock unit */
|
2012-07-07 01:26:05 +07:00
|
|
|
clk_disable_unprepare(keypad->clk);
|
2010-02-01 08:52:07 +07:00
|
|
|
}
|
|
|
|
|
|
|
|
static int imx_keypad_open(struct input_dev *dev)
|
|
|
|
{
|
|
|
|
struct imx_keypad *keypad = input_get_drvdata(dev);
|
2012-07-07 01:31:14 +07:00
|
|
|
int error;
|
2010-02-01 08:52:07 +07:00
|
|
|
|
|
|
|
dev_dbg(&dev->dev, ">%s\n", __func__);
|
|
|
|
|
2012-07-07 01:31:14 +07:00
|
|
|
/* Enable the kpp clock */
|
|
|
|
error = clk_prepare_enable(keypad->clk);
|
|
|
|
if (error)
|
|
|
|
return error;
|
|
|
|
|
2010-02-01 08:52:07 +07:00
|
|
|
/* We became active from now */
|
|
|
|
keypad->enabled = true;
|
|
|
|
|
|
|
|
imx_keypad_config(keypad);
|
|
|
|
|
|
|
|
/* Sanity control, not all the rows must be actived now. */
|
|
|
|
if ((readw(keypad->mmio_base + KPDR) & keypad->rows_en_mask) == 0) {
|
|
|
|
dev_err(&dev->dev,
|
|
|
|
"too many keys pressed, control pins initialisation\n");
|
|
|
|
goto open_err;
|
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
|
|
|
|
open_err:
|
|
|
|
imx_keypad_close(dev);
|
|
|
|
return -EIO;
|
|
|
|
}
|
|
|
|
|
2013-01-04 03:25:46 +07:00
|
|
|
#ifdef CONFIG_OF
|
2014-05-08 02:59:47 +07:00
|
|
|
static const struct of_device_id imx_keypad_of_match[] = {
|
2013-01-04 03:25:46 +07:00
|
|
|
{ .compatible = "fsl,imx21-kpp", },
|
|
|
|
{ /* sentinel */ }
|
|
|
|
};
|
|
|
|
MODULE_DEVICE_TABLE(of, imx_keypad_of_match);
|
|
|
|
#endif
|
|
|
|
|
2012-11-24 12:38:25 +07:00
|
|
|
static int imx_keypad_probe(struct platform_device *pdev)
|
2010-02-01 08:52:07 +07:00
|
|
|
{
|
2013-12-06 10:21:10 +07:00
|
|
|
const struct matrix_keymap_data *keymap_data =
|
|
|
|
dev_get_platdata(&pdev->dev);
|
2010-02-01 08:52:07 +07:00
|
|
|
struct imx_keypad *keypad;
|
|
|
|
struct input_dev *input_dev;
|
2013-01-04 03:25:46 +07:00
|
|
|
int irq, error, i, row, col;
|
2010-02-01 08:52:07 +07:00
|
|
|
|
2013-01-04 03:25:46 +07:00
|
|
|
if (!keymap_data && !pdev->dev.of_node) {
|
2010-02-01 08:52:07 +07:00
|
|
|
dev_err(&pdev->dev, "no keymap defined\n");
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
irq = platform_get_irq(pdev, 0);
|
2019-08-15 00:46:38 +07:00
|
|
|
if (irq < 0)
|
2014-02-18 02:31:36 +07:00
|
|
|
return irq;
|
2010-02-01 08:52:07 +07:00
|
|
|
|
2013-03-31 14:38:21 +07:00
|
|
|
input_dev = devm_input_allocate_device(&pdev->dev);
|
2010-02-01 08:52:07 +07:00
|
|
|
if (!input_dev) {
|
|
|
|
dev_err(&pdev->dev, "failed to allocate the input device\n");
|
2013-03-31 14:38:21 +07:00
|
|
|
return -ENOMEM;
|
2010-02-01 08:52:07 +07:00
|
|
|
}
|
|
|
|
|
2015-01-05 05:28:46 +07:00
|
|
|
keypad = devm_kzalloc(&pdev->dev, sizeof(*keypad), GFP_KERNEL);
|
2010-02-01 08:52:07 +07:00
|
|
|
if (!keypad) {
|
|
|
|
dev_err(&pdev->dev, "not enough memory for driver data\n");
|
2013-03-31 14:38:21 +07:00
|
|
|
return -ENOMEM;
|
2010-02-01 08:52:07 +07:00
|
|
|
}
|
|
|
|
|
|
|
|
keypad->input_dev = input_dev;
|
|
|
|
keypad->irq = irq;
|
|
|
|
keypad->stable_count = 0;
|
|
|
|
|
2017-10-24 23:40:57 +07:00
|
|
|
timer_setup(&keypad->check_matrix_timer,
|
|
|
|
imx_keypad_check_for_events, 0);
|
2010-02-01 08:52:07 +07:00
|
|
|
|
2019-05-21 12:11:37 +07:00
|
|
|
keypad->mmio_base = devm_platform_ioremap_resource(pdev, 0);
|
2013-03-31 14:38:21 +07:00
|
|
|
if (IS_ERR(keypad->mmio_base))
|
|
|
|
return PTR_ERR(keypad->mmio_base);
|
2010-02-01 08:52:07 +07:00
|
|
|
|
2013-03-31 14:38:21 +07:00
|
|
|
keypad->clk = devm_clk_get(&pdev->dev, NULL);
|
2010-02-01 08:52:07 +07:00
|
|
|
if (IS_ERR(keypad->clk)) {
|
|
|
|
dev_err(&pdev->dev, "failed to get keypad clock\n");
|
2013-03-31 14:38:21 +07:00
|
|
|
return PTR_ERR(keypad->clk);
|
2010-02-01 08:52:07 +07:00
|
|
|
}
|
|
|
|
|
|
|
|
/* Init the Input device */
|
|
|
|
input_dev->name = pdev->name;
|
|
|
|
input_dev->id.bustype = BUS_HOST;
|
|
|
|
input_dev->dev.parent = &pdev->dev;
|
|
|
|
input_dev->open = imx_keypad_open;
|
|
|
|
input_dev->close = imx_keypad_close;
|
|
|
|
|
2012-05-11 12:37:08 +07:00
|
|
|
error = matrix_keypad_build_keymap(keymap_data, NULL,
|
|
|
|
MAX_MATRIX_KEY_ROWS,
|
|
|
|
MAX_MATRIX_KEY_COLS,
|
|
|
|
keypad->keycodes, input_dev);
|
|
|
|
if (error) {
|
|
|
|
dev_err(&pdev->dev, "failed to build keymap\n");
|
2013-03-31 14:38:21 +07:00
|
|
|
return error;
|
2012-05-11 12:37:08 +07:00
|
|
|
}
|
2010-02-01 08:52:07 +07:00
|
|
|
|
2013-01-04 03:25:46 +07:00
|
|
|
/* Search for rows and cols enabled */
|
|
|
|
for (row = 0; row < MAX_MATRIX_KEY_ROWS; row++) {
|
|
|
|
for (col = 0; col < MAX_MATRIX_KEY_COLS; col++) {
|
|
|
|
i = MATRIX_SCAN_CODE(row, col, MATRIX_ROW_SHIFT);
|
|
|
|
if (keypad->keycodes[i] != KEY_RESERVED) {
|
|
|
|
keypad->rows_en_mask |= 1 << row;
|
|
|
|
keypad->cols_en_mask |= 1 << col;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
dev_dbg(&pdev->dev, "enabled rows mask: %x\n", keypad->rows_en_mask);
|
|
|
|
dev_dbg(&pdev->dev, "enabled cols mask: %x\n", keypad->cols_en_mask);
|
|
|
|
|
2012-05-11 12:37:08 +07:00
|
|
|
__set_bit(EV_REP, input_dev->evbit);
|
2010-02-01 08:52:07 +07:00
|
|
|
input_set_capability(input_dev, EV_MSC, MSC_SCAN);
|
|
|
|
input_set_drvdata(input_dev, keypad);
|
|
|
|
|
|
|
|
/* Ensure that the keypad will stay dormant until opened */
|
2015-06-22 23:22:34 +07:00
|
|
|
error = clk_prepare_enable(keypad->clk);
|
|
|
|
if (error)
|
|
|
|
return error;
|
2010-02-01 08:52:07 +07:00
|
|
|
imx_keypad_inhibit(keypad);
|
2012-09-05 10:27:38 +07:00
|
|
|
clk_disable_unprepare(keypad->clk);
|
2010-02-01 08:52:07 +07:00
|
|
|
|
2013-03-31 14:38:21 +07:00
|
|
|
error = devm_request_irq(&pdev->dev, irq, imx_keypad_irq_handler, 0,
|
2010-02-01 08:52:07 +07:00
|
|
|
pdev->name, keypad);
|
|
|
|
if (error) {
|
|
|
|
dev_err(&pdev->dev, "failed to request IRQ\n");
|
2013-03-31 14:38:21 +07:00
|
|
|
return error;
|
2010-02-01 08:52:07 +07:00
|
|
|
}
|
|
|
|
|
|
|
|
/* Register the input device */
|
|
|
|
error = input_register_device(input_dev);
|
|
|
|
if (error) {
|
|
|
|
dev_err(&pdev->dev, "failed to register input device\n");
|
2013-03-31 14:38:21 +07:00
|
|
|
return error;
|
2010-02-01 08:52:07 +07:00
|
|
|
}
|
|
|
|
|
|
|
|
platform_set_drvdata(pdev, keypad);
|
|
|
|
device_init_wakeup(&pdev->dev, 1);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
Input: imx_keypad - make sure keyboard can always wake up system
There are several scenarios that keyboard can NOT wake up system
from suspend, e.g., if a keyboard is depressed between system
device suspend phase and device noirq suspend phase, the keyboard
ISR will be called and both keyboard depress and release interrupts
will be disabled, then keyboard will no longer be able to wake up
system. Another scenario would be, if a keyboard is kept depressed,
and then system goes into suspend, the expected behavior would be
when keyboard is released, system will be waked up, but current
implementation can NOT achieve that, because both depress and release
interrupts are disabled in ISR, and the event check is still in
progress.
To fix these issues, need to make sure keyboard's depress or release
interrupt is enabled after noirq device suspend phase, this patch
moves the suspend/resume callback to noirq suspend/resume phase, and
enable the corresponding interrupt according to current keyboard status.
Signed-off-by: Anson Huang <Anson.Huang@nxp.com>
Signed-off-by: Dmitry Torokhov <dmitry.torokhov@gmail.com>
2019-06-12 07:50:44 +07:00
|
|
|
static int __maybe_unused imx_kbd_noirq_suspend(struct device *dev)
|
2011-10-13 11:11:16 +07:00
|
|
|
{
|
|
|
|
struct platform_device *pdev = to_platform_device(dev);
|
|
|
|
struct imx_keypad *kbd = platform_get_drvdata(pdev);
|
|
|
|
struct input_dev *input_dev = kbd->input_dev;
|
Input: imx_keypad - make sure keyboard can always wake up system
There are several scenarios that keyboard can NOT wake up system
from suspend, e.g., if a keyboard is depressed between system
device suspend phase and device noirq suspend phase, the keyboard
ISR will be called and both keyboard depress and release interrupts
will be disabled, then keyboard will no longer be able to wake up
system. Another scenario would be, if a keyboard is kept depressed,
and then system goes into suspend, the expected behavior would be
when keyboard is released, system will be waked up, but current
implementation can NOT achieve that, because both depress and release
interrupts are disabled in ISR, and the event check is still in
progress.
To fix these issues, need to make sure keyboard's depress or release
interrupt is enabled after noirq device suspend phase, this patch
moves the suspend/resume callback to noirq suspend/resume phase, and
enable the corresponding interrupt according to current keyboard status.
Signed-off-by: Anson Huang <Anson.Huang@nxp.com>
Signed-off-by: Dmitry Torokhov <dmitry.torokhov@gmail.com>
2019-06-12 07:50:44 +07:00
|
|
|
unsigned short reg_val = readw(kbd->mmio_base + KPSR);
|
2011-10-13 11:11:16 +07:00
|
|
|
|
|
|
|
/* imx kbd can wake up system even clock is disabled */
|
|
|
|
mutex_lock(&input_dev->mutex);
|
|
|
|
|
|
|
|
if (input_dev->users)
|
2012-07-07 01:26:05 +07:00
|
|
|
clk_disable_unprepare(kbd->clk);
|
2011-10-13 11:11:16 +07:00
|
|
|
|
|
|
|
mutex_unlock(&input_dev->mutex);
|
|
|
|
|
Input: imx_keypad - make sure keyboard can always wake up system
There are several scenarios that keyboard can NOT wake up system
from suspend, e.g., if a keyboard is depressed between system
device suspend phase and device noirq suspend phase, the keyboard
ISR will be called and both keyboard depress and release interrupts
will be disabled, then keyboard will no longer be able to wake up
system. Another scenario would be, if a keyboard is kept depressed,
and then system goes into suspend, the expected behavior would be
when keyboard is released, system will be waked up, but current
implementation can NOT achieve that, because both depress and release
interrupts are disabled in ISR, and the event check is still in
progress.
To fix these issues, need to make sure keyboard's depress or release
interrupt is enabled after noirq device suspend phase, this patch
moves the suspend/resume callback to noirq suspend/resume phase, and
enable the corresponding interrupt according to current keyboard status.
Signed-off-by: Anson Huang <Anson.Huang@nxp.com>
Signed-off-by: Dmitry Torokhov <dmitry.torokhov@gmail.com>
2019-06-12 07:50:44 +07:00
|
|
|
if (device_may_wakeup(&pdev->dev)) {
|
|
|
|
if (reg_val & KBD_STAT_KPKD)
|
|
|
|
reg_val |= KBD_STAT_KRIE;
|
|
|
|
if (reg_val & KBD_STAT_KPKR)
|
|
|
|
reg_val |= KBD_STAT_KDIE;
|
|
|
|
writew(reg_val, kbd->mmio_base + KPSR);
|
|
|
|
|
2011-10-13 11:11:16 +07:00
|
|
|
enable_irq_wake(kbd->irq);
|
Input: imx_keypad - make sure keyboard can always wake up system
There are several scenarios that keyboard can NOT wake up system
from suspend, e.g., if a keyboard is depressed between system
device suspend phase and device noirq suspend phase, the keyboard
ISR will be called and both keyboard depress and release interrupts
will be disabled, then keyboard will no longer be able to wake up
system. Another scenario would be, if a keyboard is kept depressed,
and then system goes into suspend, the expected behavior would be
when keyboard is released, system will be waked up, but current
implementation can NOT achieve that, because both depress and release
interrupts are disabled in ISR, and the event check is still in
progress.
To fix these issues, need to make sure keyboard's depress or release
interrupt is enabled after noirq device suspend phase, this patch
moves the suspend/resume callback to noirq suspend/resume phase, and
enable the corresponding interrupt according to current keyboard status.
Signed-off-by: Anson Huang <Anson.Huang@nxp.com>
Signed-off-by: Dmitry Torokhov <dmitry.torokhov@gmail.com>
2019-06-12 07:50:44 +07:00
|
|
|
}
|
2011-10-13 11:11:16 +07:00
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
Input: imx_keypad - make sure keyboard can always wake up system
There are several scenarios that keyboard can NOT wake up system
from suspend, e.g., if a keyboard is depressed between system
device suspend phase and device noirq suspend phase, the keyboard
ISR will be called and both keyboard depress and release interrupts
will be disabled, then keyboard will no longer be able to wake up
system. Another scenario would be, if a keyboard is kept depressed,
and then system goes into suspend, the expected behavior would be
when keyboard is released, system will be waked up, but current
implementation can NOT achieve that, because both depress and release
interrupts are disabled in ISR, and the event check is still in
progress.
To fix these issues, need to make sure keyboard's depress or release
interrupt is enabled after noirq device suspend phase, this patch
moves the suspend/resume callback to noirq suspend/resume phase, and
enable the corresponding interrupt according to current keyboard status.
Signed-off-by: Anson Huang <Anson.Huang@nxp.com>
Signed-off-by: Dmitry Torokhov <dmitry.torokhov@gmail.com>
2019-06-12 07:50:44 +07:00
|
|
|
static int __maybe_unused imx_kbd_noirq_resume(struct device *dev)
|
2011-10-13 11:11:16 +07:00
|
|
|
{
|
|
|
|
struct platform_device *pdev = to_platform_device(dev);
|
|
|
|
struct imx_keypad *kbd = platform_get_drvdata(pdev);
|
|
|
|
struct input_dev *input_dev = kbd->input_dev;
|
2012-07-07 01:31:14 +07:00
|
|
|
int ret = 0;
|
2011-10-13 11:11:16 +07:00
|
|
|
|
|
|
|
if (device_may_wakeup(&pdev->dev))
|
|
|
|
disable_irq_wake(kbd->irq);
|
|
|
|
|
|
|
|
mutex_lock(&input_dev->mutex);
|
|
|
|
|
2012-07-07 01:31:14 +07:00
|
|
|
if (input_dev->users) {
|
|
|
|
ret = clk_prepare_enable(kbd->clk);
|
|
|
|
if (ret)
|
|
|
|
goto err_clk;
|
|
|
|
}
|
2011-10-13 11:11:16 +07:00
|
|
|
|
2012-07-07 01:31:14 +07:00
|
|
|
err_clk:
|
2011-10-13 11:11:16 +07:00
|
|
|
mutex_unlock(&input_dev->mutex);
|
|
|
|
|
2012-07-07 01:31:14 +07:00
|
|
|
return ret;
|
2011-10-13 11:11:16 +07:00
|
|
|
}
|
|
|
|
|
Input: imx_keypad - make sure keyboard can always wake up system
There are several scenarios that keyboard can NOT wake up system
from suspend, e.g., if a keyboard is depressed between system
device suspend phase and device noirq suspend phase, the keyboard
ISR will be called and both keyboard depress and release interrupts
will be disabled, then keyboard will no longer be able to wake up
system. Another scenario would be, if a keyboard is kept depressed,
and then system goes into suspend, the expected behavior would be
when keyboard is released, system will be waked up, but current
implementation can NOT achieve that, because both depress and release
interrupts are disabled in ISR, and the event check is still in
progress.
To fix these issues, need to make sure keyboard's depress or release
interrupt is enabled after noirq device suspend phase, this patch
moves the suspend/resume callback to noirq suspend/resume phase, and
enable the corresponding interrupt according to current keyboard status.
Signed-off-by: Anson Huang <Anson.Huang@nxp.com>
Signed-off-by: Dmitry Torokhov <dmitry.torokhov@gmail.com>
2019-06-12 07:50:44 +07:00
|
|
|
static const struct dev_pm_ops imx_kbd_pm_ops = {
|
|
|
|
SET_NOIRQ_SYSTEM_SLEEP_PM_OPS(imx_kbd_noirq_suspend, imx_kbd_noirq_resume)
|
|
|
|
};
|
2011-10-13 11:11:16 +07:00
|
|
|
|
2010-02-01 08:52:07 +07:00
|
|
|
static struct platform_driver imx_keypad_driver = {
|
|
|
|
.driver = {
|
|
|
|
.name = "imx-keypad",
|
2011-10-13 11:11:16 +07:00
|
|
|
.pm = &imx_kbd_pm_ops,
|
2013-01-04 03:25:46 +07:00
|
|
|
.of_match_table = of_match_ptr(imx_keypad_of_match),
|
2010-02-01 08:52:07 +07:00
|
|
|
},
|
|
|
|
.probe = imx_keypad_probe,
|
|
|
|
};
|
2011-11-30 02:08:39 +07:00
|
|
|
module_platform_driver(imx_keypad_driver);
|
2010-02-01 08:52:07 +07:00
|
|
|
|
|
|
|
MODULE_AUTHOR("Alberto Panizzo <maramaopercheseimorto@gmail.com>");
|
|
|
|
MODULE_DESCRIPTION("IMX Keypad Port Driver");
|
|
|
|
MODULE_LICENSE("GPL v2");
|
|
|
|
MODULE_ALIAS("platform:imx-keypad");
|