cregit-Linux how code gets into the kernel

Release 4.11 drivers/input/keyboard/samsung-keypad.c

/*
 * Samsung keypad driver
 *
 * Copyright (C) 2010 Samsung Electronics Co.Ltd
 * Author: Joonyoung Shim <jy0922.shim@samsung.com>
 * Author: Donghwa Lee <dh09.lee@samsung.com>
 *
 * 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;  either version 2 of the  License, or (at your
 * option) any later version.
 */

#include <linux/clk.h>
#include <linux/delay.h>
#include <linux/err.h>
#include <linux/input.h>
#include <linux/interrupt.h>
#include <linux/io.h>
#include <linux/module.h>
#include <linux/platform_device.h>
#include <linux/pm.h>
#include <linux/pm_runtime.h>
#include <linux/slab.h>
#include <linux/of.h>
#include <linux/sched.h>
#include <linux/input/samsung-keypad.h>


#define SAMSUNG_KEYIFCON			0x00

#define SAMSUNG_KEYIFSTSCLR			0x04

#define SAMSUNG_KEYIFCOL			0x08

#define SAMSUNG_KEYIFROW			0x0c

#define SAMSUNG_KEYIFFC				0x10

/* SAMSUNG_KEYIFCON */

#define SAMSUNG_KEYIFCON_INT_F_EN		(1 << 0)

#define SAMSUNG_KEYIFCON_INT_R_EN		(1 << 1)

#define SAMSUNG_KEYIFCON_DF_EN			(1 << 2)

#define SAMSUNG_KEYIFCON_FC_EN			(1 << 3)

#define SAMSUNG_KEYIFCON_WAKEUPEN		(1 << 4)

/* SAMSUNG_KEYIFSTSCLR */

#define SAMSUNG_KEYIFSTSCLR_P_INT_MASK		(0xff << 0)

#define SAMSUNG_KEYIFSTSCLR_R_INT_MASK		(0xff << 8)

#define SAMSUNG_KEYIFSTSCLR_R_INT_OFFSET	8

#define S5PV210_KEYIFSTSCLR_P_INT_MASK		(0x3fff << 0)

#define S5PV210_KEYIFSTSCLR_R_INT_MASK		(0x3fff << 16)

#define S5PV210_KEYIFSTSCLR_R_INT_OFFSET	16

/* SAMSUNG_KEYIFCOL */

#define SAMSUNG_KEYIFCOL_MASK			(0xff << 0)

#define S5PV210_KEYIFCOLEN_MASK			(0xff << 8)

/* SAMSUNG_KEYIFROW */

#define SAMSUNG_KEYIFROW_MASK			(0xff << 0)

#define S5PV210_KEYIFROW_MASK			(0x3fff << 0)

/* SAMSUNG_KEYIFFC */

#define SAMSUNG_KEYIFFC_MASK			(0x3ff << 0)


enum samsung_keypad_type {
	
KEYPAD_TYPE_SAMSUNG,
	
KEYPAD_TYPE_S5PV210,
};


struct samsung_keypad {
	
struct input_dev *input_dev;
	
struct platform_device *pdev;
	
struct clk *clk;
	
void __iomem *base;
	
wait_queue_head_t wait;
	
bool stopped;
	
bool wake_enabled;
	
int irq;
	
enum samsung_keypad_type type;
	
unsigned int row_shift;
	
unsigned int rows;
	
unsigned int cols;
	
unsigned int row_state[SAMSUNG_MAX_COLS];
	
unsigned short keycodes[];
};


static void samsung_keypad_scan(struct samsung_keypad *keypad, unsigned int *row_state) { unsigned int col; unsigned int val; for (col = 0; col < keypad->cols; col++) { if (keypad->type == KEYPAD_TYPE_S5PV210) { val = S5PV210_KEYIFCOLEN_MASK; val &= ~(1 << col) << 8; } else { val = SAMSUNG_KEYIFCOL_MASK; val &= ~(1 << col); } writel(val, keypad->base + SAMSUNG_KEYIFCOL); mdelay(1); val = readl(keypad->base + SAMSUNG_KEYIFROW); row_state[col] = ~val & ((1 << keypad->rows) - 1); } /* KEYIFCOL reg clear */ writel(0, keypad->base + SAMSUNG_KEYIFCOL); }

Contributors

PersonTokensPropCommitsCommitProp
Joonyoung Shim13696.45%150.00%
Thomas Abraham53.55%150.00%
Total141100.00%2100.00%


static bool samsung_keypad_report(struct samsung_keypad *keypad, unsigned int *row_state) { struct input_dev *input_dev = keypad->input_dev; unsigned int changed; unsigned int pressed; unsigned int key_down = 0; unsigned int val; unsigned int col, row; for (col = 0; col < keypad->cols; col++) { changed = row_state[col] ^ keypad->row_state[col]; key_down |= row_state[col]; if (!changed) continue; for (row = 0; row < keypad->rows; row++) { if (!(changed & (1 << row))) continue; pressed = row_state[col] & (1 << row); dev_dbg(&keypad->input_dev->dev, "key %s, row: %d, col: %d\n", pressed ? "pressed" : "released", row, col); val = MATRIX_SCAN_CODE(row, col, keypad->row_shift); input_event(input_dev, EV_MSC, MSC_SCAN, val); input_report_key(input_dev, keypad->keycodes[val], pressed); } input_sync(keypad->input_dev); } memcpy(keypad->row_state, row_state, sizeof(keypad->row_state)); return key_down; }

Contributors

PersonTokensPropCommitsCommitProp
Joonyoung Shim223100.00%1100.00%
Total223100.00%1100.00%


static irqreturn_t samsung_keypad_irq(int irq, void *dev_id) { struct samsung_keypad *keypad = dev_id; unsigned int row_state[SAMSUNG_MAX_COLS]; unsigned int val; bool key_down; pm_runtime_get_sync(&keypad->pdev->dev); do { val = readl(keypad->base + SAMSUNG_KEYIFSTSCLR); /* Clear interrupt. */ writel(~0x0, keypad->base + SAMSUNG_KEYIFSTSCLR); samsung_keypad_scan(keypad, row_state); key_down = samsung_keypad_report(keypad, row_state); if (key_down) wait_event_timeout(keypad->wait, keypad->stopped, msecs_to_jiffies(50)); } while (key_down && !keypad->stopped); pm_runtime_put(&keypad->pdev->dev); return IRQ_HANDLED; }

Contributors

PersonTokensPropCommitsCommitProp
Joonyoung Shim11084.62%133.33%
Mark Brown2015.38%266.67%
Total130100.00%3100.00%


static void samsung_keypad_start(struct samsung_keypad *keypad) { unsigned int val; pm_runtime_get_sync(&keypad->pdev->dev); /* Tell IRQ thread that it may poll the device. */ keypad->stopped = false; clk_enable(keypad->clk); /* Enable interrupt bits. */ val = readl(keypad->base + SAMSUNG_KEYIFCON); val |= SAMSUNG_KEYIFCON_INT_F_EN | SAMSUNG_KEYIFCON_INT_R_EN; writel(val, keypad->base + SAMSUNG_KEYIFCON); /* KEYIFCOL reg clear. */ writel(0, keypad->base + SAMSUNG_KEYIFCOL); pm_runtime_put(&keypad->pdev->dev); }

Contributors

PersonTokensPropCommitsCommitProp
Joonyoung Shim7077.78%133.33%
Mark Brown2022.22%266.67%
Total90100.00%3100.00%


static void samsung_keypad_stop(struct samsung_keypad *keypad) { unsigned int val; pm_runtime_get_sync(&keypad->pdev->dev); /* Signal IRQ thread to stop polling and disable the handler. */ keypad->stopped = true; wake_up(&keypad->wait); disable_irq(keypad->irq); /* Clear interrupt. */ writel(~0x0, keypad->base + SAMSUNG_KEYIFSTSCLR); /* Disable interrupt bits. */ val = readl(keypad->base + SAMSUNG_KEYIFCON); val &= ~(SAMSUNG_KEYIFCON_INT_F_EN | SAMSUNG_KEYIFCON_INT_R_EN); writel(val, keypad->base + SAMSUNG_KEYIFCON); clk_disable(keypad->clk); /* * Now that chip should not generate interrupts we can safely * re-enable the handler. */ enable_irq(keypad->irq); pm_runtime_put(&keypad->pdev->dev); }

Contributors

PersonTokensPropCommitsCommitProp
Joonyoung Shim8068.38%120.00%
Thomas Abraham1714.53%120.00%
Mark Brown108.55%120.00%
Linus Torvalds97.69%120.00%
Dmitry Torokhov10.85%120.00%
Total117100.00%5100.00%


static int samsung_keypad_open(struct input_dev *input_dev) { struct samsung_keypad *keypad = input_get_drvdata(input_dev); samsung_keypad_start(keypad); return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Thomas Abraham29100.00%1100.00%
Total29100.00%1100.00%


static void samsung_keypad_close(struct input_dev *input_dev) { struct samsung_keypad *keypad = input_get_drvdata(input_dev); samsung_keypad_stop(keypad); }

Contributors

PersonTokensPropCommitsCommitProp
Thomas Abraham26100.00%1100.00%
Total26100.00%1100.00%

#ifdef CONFIG_OF
static struct samsung_keypad_platdata * samsung_keypad_parse_dt(struct device *dev) { struct samsung_keypad_platdata *pdata; struct matrix_keymap_data *keymap_data; uint32_t *keymap, num_rows = 0, num_cols = 0; struct device_node *np = dev->of_node, *key_np; unsigned int key_count; if (!np) { dev_err(dev, "missing device tree data\n"); return ERR_PTR(-EINVAL); } pdata = devm_kzalloc(dev, sizeof(*pdata), GFP_KERNEL); if (!pdata) { dev_err(dev, "could not allocate memory for platform data\n"); return ERR_PTR(-ENOMEM); } of_property_read_u32(np, "samsung,keypad-num-rows", &num_rows); of_property_read_u32(np, "samsung,keypad-num-columns", &num_cols); if (!num_rows || !num_cols) { dev_err(dev, "number of keypad rows/columns not specified\n"); return ERR_PTR(-EINVAL); } pdata->rows = num_rows; pdata->cols = num_cols; keymap_data = devm_kzalloc(dev, sizeof(*keymap_data), GFP_KERNEL); if (!keymap_data) { dev_err(dev, "could not allocate memory for keymap data\n"); return ERR_PTR(-ENOMEM); } pdata->keymap_data = keymap_data; key_count = of_get_child_count(np); keymap_data->keymap_size = key_count; keymap = devm_kzalloc(dev, sizeof(uint32_t) * key_count, GFP_KERNEL); if (!keymap) { dev_err(dev, "could not allocate memory for keymap\n"); return ERR_PTR(-ENOMEM); } keymap_data->keymap = keymap; for_each_child_of_node(np, key_np) { u32 row, col, key_code; of_property_read_u32(key_np, "keypad,row", &row); of_property_read_u32(key_np, "keypad,column", &col); of_property_read_u32(key_np, "linux,code", &key_code); *keymap++ = KEY(row, col, key_code); } if (of_get_property(np, "linux,input-no-autorepeat", NULL)) pdata->no_autorepeat = true; pdata->wakeup = of_property_read_bool(np, "wakeup-source") || /* legacy name */ of_property_read_bool(np, "linux,input-wakeup"); return pdata; }

Contributors

PersonTokensPropCommitsCommitProp
Thomas Abraham30183.84%125.00%
Dmitry Torokhov5415.04%250.00%
Tobias Klauser41.11%125.00%
Total359100.00%4100.00%

#else
static struct samsung_keypad_platdata * samsung_keypad_parse_dt(struct device *dev) { dev_err(dev, "no platform data defined\n"); return ERR_PTR(-EINVAL); }

Contributors

PersonTokensPropCommitsCommitProp
Dmitry Torokhov1244.44%133.33%
Joonyoung Shim933.33%133.33%
Thomas Abraham622.22%133.33%
Total27100.00%3100.00%

#endif
static int samsung_keypad_probe(struct platform_device *pdev) { const struct samsung_keypad_platdata *pdata; const struct matrix_keymap_data *keymap_data; struct samsung_keypad *keypad; struct resource *res; struct input_dev *input_dev; unsigned int row_shift; unsigned int keymap_size; int error; pdata = dev_get_platdata(&pdev->dev); if (!pdata) { pdata = samsung_keypad_parse_dt(&pdev->dev); if (IS_ERR(pdata)) return PTR_ERR(pdata); } keymap_data = pdata->keymap_data; if (!keymap_data) { dev_err(&pdev->dev, "no keymap data defined\n"); return -EINVAL; } if (!pdata->rows || pdata->rows > SAMSUNG_MAX_ROWS) return -EINVAL; if (!pdata->cols || pdata->cols > SAMSUNG_MAX_COLS) return -EINVAL; /* initialize the gpio */ if (pdata->cfg_gpio) pdata->cfg_gpio(pdata->rows, pdata->cols); row_shift = get_count_order(pdata->cols); keymap_size = (pdata->rows << row_shift) * sizeof(keypad->keycodes[0]); keypad = devm_kzalloc(&pdev->dev, sizeof(*keypad) + keymap_size, GFP_KERNEL); input_dev = devm_input_allocate_device(&pdev->dev); if (!keypad || !input_dev) return -ENOMEM; res = platform_get_resource(pdev, IORESOURCE_MEM, 0); if (!res) return -ENODEV; keypad->base = devm_ioremap(&pdev->dev, res->start, resource_size(res)); if (!keypad->base) return -EBUSY; keypad->clk = devm_clk_get(&pdev->dev, "keypad"); if (IS_ERR(keypad->clk)) { dev_err(&pdev->dev, "failed to get keypad clk\n"); return PTR_ERR(keypad->clk); } error = clk_prepare(keypad->clk); if (error) { dev_err(&pdev->dev, "keypad clock prepare failed\n"); return error; } keypad->input_dev = input_dev; keypad->pdev = pdev; keypad->row_shift = row_shift; keypad->rows = pdata->rows; keypad->cols = pdata->cols; keypad->stopped = true; init_waitqueue_head(&keypad->wait); if (pdev->dev.of_node) keypad->type = of_device_is_compatible(pdev->dev.of_node, "samsung,s5pv210-keypad"); else keypad->type = platform_get_device_id(pdev)->driver_data; input_dev->name = pdev->name; input_dev->id.bustype = BUS_HOST; input_dev->dev.parent = &pdev->dev; input_dev->open = samsung_keypad_open; input_dev->close = samsung_keypad_close; error = matrix_keypad_build_keymap(keymap_data, NULL, pdata->rows, pdata->cols, keypad->keycodes, input_dev); if (error) { dev_err(&pdev->dev, "failed to build keymap\n"); goto err_unprepare_clk; } input_set_capability(input_dev, EV_MSC, MSC_SCAN); if (!pdata->no_autorepeat) __set_bit(EV_REP, input_dev->evbit); input_set_drvdata(input_dev, keypad); keypad->irq = platform_get_irq(pdev, 0); if (keypad->irq < 0) { error = keypad->irq; goto err_unprepare_clk; } error = devm_request_threaded_irq(&pdev->dev, keypad->irq, NULL, samsung_keypad_irq, IRQF_ONESHOT, dev_name(&pdev->dev), keypad); if (error) { dev_err(&pdev->dev, "failed to register keypad interrupt\n"); goto err_unprepare_clk; } device_init_wakeup(&pdev->dev, pdata->wakeup); platform_set_drvdata(pdev, keypad); pm_runtime_enable(&pdev->dev); error = input_register_device(keypad->input_dev); if (error) goto err_disable_runtime_pm; if (pdev->dev.of_node) { devm_kfree(&pdev->dev, (void *)pdata->keymap_data->keymap); devm_kfree(&pdev->dev, (void *)pdata->keymap_data); devm_kfree(&pdev->dev, (void *)pdata); } return 0; err_disable_runtime_pm: pm_runtime_disable(&pdev->dev); err_unprepare_clk: clk_unprepare(keypad->clk); return error; }

Contributors

PersonTokensPropCommitsCommitProp
Joonyoung Shim49164.18%112.50%
Thomas Abraham12816.73%225.00%
Dmitry Torokhov587.58%225.00%
Mark Brown435.62%112.50%
Sachin Kamat415.36%112.50%
Jingoo Han40.52%112.50%
Total765100.00%8100.00%


static int samsung_keypad_remove(struct platform_device *pdev) { struct samsung_keypad *keypad = platform_get_drvdata(pdev); pm_runtime_disable(&pdev->dev); input_unregister_device(keypad->input_dev); clk_unprepare(keypad->clk); return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Joonyoung Shim3167.39%133.33%
Mark Brown817.39%133.33%
Thomas Abraham715.22%133.33%
Total46100.00%3100.00%

#ifdef CONFIG_PM
static int samsung_keypad_runtime_suspend(struct device *dev) { struct platform_device *pdev = to_platform_device(dev); struct samsung_keypad *keypad = platform_get_drvdata(pdev); unsigned int val; int error; if (keypad->stopped) return 0; /* This may fail on some SoCs due to lack of controller support */ error = enable_irq_wake(keypad->irq); if (!error) keypad->wake_enabled = true; val = readl(keypad->base + SAMSUNG_KEYIFCON); val |= SAMSUNG_KEYIFCON_WAKEUPEN; writel(val, keypad->base + SAMSUNG_KEYIFCON); clk_disable(keypad->clk); return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Mark Brown9187.50%150.00%
Joonyoung Shim1312.50%150.00%
Total104100.00%2100.00%


static int samsung_keypad_runtime_resume(struct device *dev) { struct platform_device *pdev = to_platform_device(dev); struct samsung_keypad *keypad = platform_get_drvdata(pdev); unsigned int val; if (keypad->stopped) return 0; clk_enable(keypad->clk); val = readl(keypad->base + SAMSUNG_KEYIFCON); val &= ~SAMSUNG_KEYIFCON_WAKEUPEN; writel(val, keypad->base + SAMSUNG_KEYIFCON); if (keypad->wake_enabled) disable_irq_wake(keypad->irq); return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Mark Brown8893.62%150.00%
Joonyoung Shim66.38%150.00%
Total94100.00%2100.00%

#endif #ifdef CONFIG_PM_SLEEP
static void samsung_keypad_toggle_wakeup(struct samsung_keypad *keypad, bool enable) { unsigned int val; clk_enable(keypad->clk); val = readl(keypad->base + SAMSUNG_KEYIFCON); if (enable) { val |= SAMSUNG_KEYIFCON_WAKEUPEN; if (device_may_wakeup(&keypad->pdev->dev)) enable_irq_wake(keypad->irq); } else { val &= ~SAMSUNG_KEYIFCON_WAKEUPEN; if (device_may_wakeup(&keypad->pdev->dev)) disable_irq_wake(keypad->irq); } writel(val, keypad->base + SAMSUNG_KEYIFCON); clk_disable(keypad->clk); }

Contributors

PersonTokensPropCommitsCommitProp
Joonyoung Shim8375.45%150.00%
Mark Brown2724.55%150.00%
Total110100.00%2100.00%


static int samsung_keypad_suspend(struct device *dev) { struct platform_device *pdev = to_platform_device(dev); struct samsung_keypad *keypad = platform_get_drvdata(pdev); struct input_dev *input_dev = keypad->input_dev; mutex_lock(&input_dev->mutex); if (input_dev->users) samsung_keypad_stop(keypad); samsung_keypad_toggle_wakeup(keypad, true); mutex_unlock(&input_dev->mutex); return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Joonyoung Shim77100.00%1100.00%
Total77100.00%1100.00%


static int samsung_keypad_resume(struct device *dev) { struct platform_device *pdev = to_platform_device(dev); struct samsung_keypad *keypad = platform_get_drvdata(pdev); struct input_dev *input_dev = keypad->input_dev; mutex_lock(&input_dev->mutex); samsung_keypad_toggle_wakeup(keypad, false); if (input_dev->users) samsung_keypad_start(keypad); mutex_unlock(&input_dev->mutex); return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Joonyoung Shim77100.00%1100.00%
Total77100.00%1100.00%

#endif static const struct dev_pm_ops samsung_keypad_pm_ops = { SET_SYSTEM_SLEEP_PM_OPS(samsung_keypad_suspend, samsung_keypad_resume) SET_RUNTIME_PM_OPS(samsung_keypad_runtime_suspend, samsung_keypad_runtime_resume, NULL) }; #ifdef CONFIG_OF static const struct of_device_id samsung_keypad_dt_match[] = { { .compatible = "samsung,s3c6410-keypad" }, { .compatible = "samsung,s5pv210-keypad" }, {}, }; MODULE_DEVICE_TABLE(of, samsung_keypad_dt_match); #endif static const struct platform_device_id samsung_keypad_driver_ids[] = { { .name = "samsung-keypad", .driver_data = KEYPAD_TYPE_SAMSUNG, }, { .name = "s5pv210-keypad", .driver_data = KEYPAD_TYPE_S5PV210, }, { }, }; MODULE_DEVICE_TABLE(platform, samsung_keypad_driver_ids); static struct platform_driver samsung_keypad_driver = { .probe = samsung_keypad_probe, .remove = samsung_keypad_remove, .driver = { .name = "samsung-keypad", .of_match_table = of_match_ptr(samsung_keypad_dt_match), .pm = &samsung_keypad_pm_ops, }, .id_table = samsung_keypad_driver_ids, }; module_platform_driver(samsung_keypad_driver); MODULE_DESCRIPTION("Samsung keypad driver"); MODULE_AUTHOR("Joonyoung Shim <jy0922.shim@samsung.com>"); MODULE_AUTHOR("Donghwa Lee <dh09.lee@samsung.com>"); MODULE_LICENSE("GPL");

Overall Contributors

PersonTokensPropCommitsCommitProp
Joonyoung Shim169660.36%15.26%
Thomas Abraham57420.43%210.53%
Mark Brown34412.24%210.53%
Dmitry Torokhov1324.70%631.58%
Sachin Kamat411.46%15.26%
Linus Torvalds90.32%15.26%
Tobias Klauser70.25%210.53%
Jingoo Han40.14%15.26%
JJ Ding10.04%15.26%
Krzysztof Kozlowski10.04%15.26%
Rafael J. Wysocki10.04%15.26%
Total2810100.00%19100.00%
Information contained on this website is for historical information purposes only and does not indicate or represent copyright ownership.
Created with cregit.