diff -drupN a/drivers/input/keyboard/sunxi-keyboard.c b/drivers/input/keyboard/sunxi-keyboard.c
--- a/drivers/input/keyboard/sunxi-keyboard.c 1970-01-01 03:00:00.000000000 +0300
+++ b/drivers/input/keyboard/sunxi-keyboard.c 2022-06-12 05:28:14.000000000 +0300
@@ -0,0 +1,681 @@
+/*
+ * Based on drivers/input/keyboard/sunxi-keyboard.c
+ *
+ * Copyright (C) 2015 Allwinnertech Ltd.
+ *
+ * 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.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program. If not, see .
+ */
+#include
+#include
+#include
+#include
+#include
+#include
+#include
+#include
+#include
+#include
+#include
+#include
+#include
+#include
+#include
+#include
+
+#include
+#include
+#include
+
+#if defined(CONFIG_PM)
+#include
+#endif
+#include "sunxi-keyboard.h"
+
+static unsigned char keypad_mapindex[64] = {
+ 0, 0, 0, 0, 0, 0, 0, 0, 0, /* key 1, 0-8 */
+ 1, 1, 1, 1, 1, /* key 2, 9-13 */
+ 2, 2, 2, 2, 2, 2, /* key 3, 14-19 */
+ 3, 3, 3, 3, 3, 3, /* key 4, 20-25 */
+ 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, /* key 5, 26-36 */
+ 5, 5, 5, 5, 5, 5, 5, 5, 5, 5, 5, /* key 6, 37-39 */
+ 6, 6, 6, 6, 6, 6, 6, 6, 6, /* key 7, 40-49 */
+ 7, 7, 7, 7, 7, 7, 7 /* key 8, 50-63 */
+};
+
+#define INITIAL_VALUE (0xff)
+#define VOL_NUM KEY_MAX_CNT
+
+struct sunxi_key_data {
+ struct platform_device *pdev;
+ struct clk *mclk;
+ struct clk *pclk;
+ struct input_dev *input_dev;
+ struct sunxi_adc_disc *disc;
+ void __iomem *reg_base;
+ u32 scankeycodes[KEY_MAX_CNT];
+ int irq_num;
+ u32 key_val;
+ unsigned char compare_later;
+ unsigned char compare_before;
+ u8 key_code;
+ u8 last_key_code;
+ char key_name[16];
+ u8 key_cnt;
+ int wakeup;
+};
+
+static struct sunxi_adc_disc disc_1350 = {
+ .measure = 1350,
+ .resol = 21,
+};
+static struct sunxi_adc_disc disc_1200 = {
+ .measure = 1200,
+ .resol = 19,
+};
+static struct sunxi_adc_disc disc_2000 = {
+ .measure = 2000,
+ .resol = 31,
+};
+
+#ifdef CONFIG_OF
+/*
+ * Translate OpenFirmware node properties into platform_data
+ */
+static struct of_device_id const sunxi_keyboard_of_match[] = {
+ { .compatible = "allwinner,keyboard_1350mv",
+ .data = &disc_1350 },
+ { .compatible = "allwinner,keyboard_1200mv",
+ .data = &disc_1200 },
+ { .compatible = "allwinner,keyboard_2000mv",
+ .data = &disc_2000 },
+ { },
+};
+MODULE_DEVICE_TABLE(of, sunxi_keyboard_of_match);
+#else /* !CONFIG_OF */
+#endif
+
+static void sunxi_keyboard_ctrl_set(void __iomem *reg_base,
+ enum key_mode key_mode, u32 para)
+{
+ u32 ctrl_reg = 0;
+
+ if (para != 0)
+ ctrl_reg = readl(reg_base + LRADC_CTRL);
+ if (CONCERT_DLY_SET & key_mode)
+ ctrl_reg |= (FIRST_CONCERT_DLY & para);
+ if (ADC_CHAN_SET & key_mode)
+ ctrl_reg |= (ADC_CHAN_SELECT & para);
+ if (KEY_MODE_SET & key_mode)
+ ctrl_reg |= (KEY_MODE_SELECT & para);
+ if (LRADC_HOLD_SET & key_mode)
+ ctrl_reg |= (LRADC_HOLD_EN & para);
+ if (LEVELB_VOL_SET & key_mode) {
+ ctrl_reg |= (LEVELB_VOL & para);
+#if defined(CONFIG_ARCH_SUN8IW18)
+ ctrl_reg &= ~(u32)(3 << 4);
+#endif
+ }
+ if (LRADC_SAMPLE_SET & key_mode)
+ ctrl_reg |= (LRADC_SAMPLE_250HZ & para);
+ if (LRADC_EN_SET & key_mode)
+ ctrl_reg |= (LRADC_EN & para);
+
+ writel(ctrl_reg, reg_base + LRADC_CTRL);
+}
+
+static void sunxi_keyboard_int_set(void __iomem *reg_base,
+ enum int_mode int_mode, u32 para)
+{
+ u32 ctrl_reg = 0;
+
+ if (para != 0)
+ ctrl_reg = readl(reg_base + LRADC_INTC);
+
+ if (ADC0_DOWN_INT_SET & int_mode)
+ ctrl_reg |= (LRADC_ADC0_DOWN_EN & para);
+ if (ADC0_UP_INT_SET & int_mode)
+ ctrl_reg |= (LRADC_ADC0_UP_EN & para);
+ if (ADC0_DATA_INT_SET & int_mode)
+ ctrl_reg |= (LRADC_ADC0_DATA_EN & para);
+
+ writel(ctrl_reg, reg_base + LRADC_INTC);
+}
+
+static u32 sunxi_keyboard_read_ints(void __iomem *reg_base)
+{
+ u32 reg_val;
+
+ reg_val = readl(reg_base + LRADC_INT_STA);
+
+ return reg_val;
+}
+
+static void sunxi_keyboard_clr_ints(void __iomem *reg_base, u32 reg_val)
+{
+ writel(reg_val, reg_base + LRADC_INT_STA);
+}
+
+static u32 sunxi_keyboard_read_data(void __iomem *reg_base)
+{
+ u32 reg_val;
+
+ reg_val = readl(reg_base + LRADC_DATA0);
+
+ return reg_val;
+}
+
+#ifdef CONFIG_PM
+static int sunxi_keyboard_suspend(struct device *dev)
+{
+ struct platform_device *pdev = to_platform_device(dev);
+ struct sunxi_key_data *key_data = platform_get_drvdata(pdev);
+
+ pr_debug("[%s] enter standby\n", __func__);
+
+ if (device_may_wakeup(dev)) {
+ if (key_data->wakeup)
+ enable_irq_wake(key_data->irq_num);
+ } else {
+ disable_irq_nosync(key_data->irq_num);
+
+ sunxi_keyboard_ctrl_set(key_data->reg_base, 0, 0);
+
+ if (IS_ERR_OR_NULL(key_data->mclk))
+ pr_warn("%s apb1_keyadc mclk handle is invalid!\n",
+ __func__);
+ else
+ clk_disable_unprepare(key_data->mclk);
+ }
+
+ return 0;
+}
+
+static int sunxi_keyboard_resume(struct device *dev)
+{
+ struct platform_device *pdev = to_platform_device(dev);
+ struct sunxi_key_data *key_data = platform_get_drvdata(pdev);
+ unsigned long mode, para;
+
+ pr_debug("[%s] return from standby\n", __func__);
+
+ if (device_may_wakeup(dev)) {
+ if (key_data->wakeup)
+ disable_irq_wake(key_data->irq_num);
+ } else {
+ if (IS_ERR_OR_NULL(key_data->mclk))
+ pr_warn("%s apb1_keyadc mclk handle is invalid!\n",
+ __func__);
+ else
+ clk_prepare_enable(key_data->mclk);
+
+ mode = ADC0_DOWN_INT_SET | ADC0_UP_INT_SET | ADC0_DATA_INT_SET;
+ para = LRADC_ADC0_DOWN_EN | LRADC_ADC0_UP_EN
+ | LRADC_ADC0_DATA_EN;
+ sunxi_keyboard_int_set(key_data->reg_base, mode, para);
+ mode = CONCERT_DLY_SET | ADC_CHAN_SET | KEY_MODE_SET
+ | LRADC_HOLD_SET | LEVELB_VOL_SET
+ | LRADC_SAMPLE_SET | LRADC_EN_SET;
+ para = FIRST_CONCERT_DLY | LEVELB_VOL|KEY_MODE_SELECT
+ | LRADC_HOLD_EN | ADC_CHAN_SELECT
+ | LRADC_SAMPLE_250HZ|LRADC_EN;
+ sunxi_keyboard_ctrl_set(key_data->reg_base, mode, para);
+
+ enable_irq(key_data->irq_num);
+ }
+
+ return 0;
+}
+#endif
+
+static void sunxi_report_key_down_event(struct sunxi_key_data *key_data)
+{
+ if (key_data->last_key_code == INITIAL_VALUE) {
+ /* first time report key down event */
+ input_report_key(key_data->input_dev,
+ key_data->scankeycodes[key_data->key_code], 1);
+ input_sync(key_data->input_dev);
+ key_data->last_key_code = key_data->key_code;
+ return;
+ }
+ if (key_data->scankeycodes[key_data->key_code] ==
+ key_data->scankeycodes[key_data->last_key_code]) {
+#ifdef REPORT_REPEAT_KEY_BY_INPUT_CORE
+ /* report repeat key down event */
+ input_report_key(key_data->input_dev,
+ key_data->scankeycodes[key_data->key_code], 1);
+ input_sync(key_data->input_dev);
+#endif
+ } else {
+ /* report previous key up event
+ * and report current key down event
+ */
+ input_report_key(key_data->input_dev,
+ key_data->scankeycodes[key_data->last_key_code], 0);
+ input_sync(key_data->input_dev);
+ input_report_key(key_data->input_dev,
+ key_data->scankeycodes[key_data->key_code], 1);
+ input_sync(key_data->input_dev);
+ key_data->last_key_code = key_data->key_code;
+ }
+}
+
+static irqreturn_t sunxi_isr_key(int irq, void *dummy)
+{
+ struct sunxi_key_data *key_data = (struct sunxi_key_data *)dummy;
+ u32 reg_val = 0;
+ u32 key_val = 0;
+
+ pr_debug("Key Interrupt\n");
+ reg_val = sunxi_keyboard_read_ints(key_data->reg_base);
+ if (reg_val & LRADC_ADC0_DOWNPEND)
+ pr_debug("key down\n");
+
+ if (reg_val & LRADC_ADC0_DATAPEND) {
+ key_data->key_cnt++;
+ key_val = sunxi_keyboard_read_data(key_data->reg_base);
+ key_data->compare_before = key_val&0x3f;
+ if (key_data->compare_before == key_data->compare_later) {
+ key_data->key_code = keypad_mapindex[key_val&0x3f];
+ sunxi_report_key_down_event(key_data);
+ key_data->key_cnt = 0;
+ }
+ if (key_data->key_cnt == 2) {
+ key_data->compare_later = key_data->compare_before;
+ key_data->key_cnt = 0;
+ }
+ }
+
+ if (reg_val & LRADC_ADC0_UPPEND) {
+ if (key_data->wakeup)
+ pm_wakeup_event(key_data->input_dev->dev.parent, 0);
+ pr_debug("report data:%8d key_val:%8d\n",
+ key_data->scankeycodes[key_data->key_code],
+ key_val);
+ input_report_key(key_data->input_dev,
+ key_data->scankeycodes[key_data->key_code], 0);
+ input_sync(key_data->input_dev);
+ pr_debug("key up\n");
+ key_data->key_cnt = 0;
+ key_data->compare_later = 0;
+ key_data->last_key_code = INITIAL_VALUE;
+ }
+
+ sunxi_keyboard_clr_ints(key_data->reg_base, reg_val);
+
+ return IRQ_HANDLED;
+}
+
+static int sunxi_keyboard_startup(struct sunxi_key_data *key_data,
+ struct platform_device *pdev)
+{
+ struct device_node *np = NULL;
+ int ret = 0;
+
+ np = pdev->dev.of_node;
+ if (!of_device_is_available(np)) {
+ pr_err("%s: sunxi keyboard is disable\n", __func__);
+ return -EPERM;
+ }
+ key_data->reg_base = of_iomap(np, 0);
+ if (key_data->reg_base == 0) {
+ pr_err("%s:Failed to ioremap() io memory region.\n", __func__);
+ ret = -EBUSY;
+ } else
+ pr_debug("key base: %p !\n", key_data->reg_base);
+
+ key_data->irq_num = irq_of_parse_and_map(np, 0);
+ if (key_data->irq_num == 0) {
+ pr_err("%s:Failed to map irq.\n", __func__);
+ ret = -EBUSY;
+ } else
+ pr_debug("ir irq num: %d !\n", key_data->irq_num);
+
+ /* some IC will use clock gating while others HW use 24MHZ, So just try
+ * to get the clock, if it doesn't exist, give warning instead of error
+ */
+ key_data->mclk = of_clk_get(np, 0);
+ if (IS_ERR_OR_NULL(key_data->mclk)) {
+ pr_debug("%s: keyboard has no clk.\n", __func__);
+ } else{
+ if (clk_prepare_enable(key_data->mclk)) {
+ pr_err("%s enable apb1_keyadc clock failed!\n",
+ __func__);
+ return -EINVAL;
+ }
+ }
+ return ret;
+}
+
+static int sunxikbd_key_init(struct sunxi_key_data *key_data,
+ struct platform_device *pdev)
+{
+ struct device_node *np = NULL;
+ const struct of_device_id *match;
+ struct sunxi_adc_disc *disc;
+ int i, j = 0;
+ u32 val[2] = {0, 0};
+ u32 key_num = 0;
+ u32 key_vol[VOL_NUM];
+
+ np = pdev->dev.of_node;
+ match = of_match_node(sunxi_keyboard_of_match, np);
+ disc = (struct sunxi_adc_disc *)match->data;
+ key_data->disc = disc;
+ if (of_property_read_u32(np, "key_cnt", &key_num)) {
+ pr_err("%s: get key count failed", __func__);
+ return -EBUSY;
+ }
+ pr_debug("%s key number = %d.\n", __func__, key_num);
+ if (key_num < 1 || key_num > VOL_NUM) {
+ pr_err("incorrect key number.\n");
+ return -1;
+ }
+ for (i = 0; i < key_num; i++) {
+ sprintf(key_data->key_name, "key%d", i);
+ if (of_property_read_u32_array(np, key_data->key_name,
+ val, ARRAY_SIZE(val))) {
+ pr_err("%s:get%s err!\n", __func__, key_data->key_name);
+ return -EBUSY;
+ }
+ key_vol[i] = val[0];
+ key_data->scankeycodes[i] = val[1];
+ pr_debug("%s: key%d vol= %d code= %d\n", __func__, i,
+ key_vol[i], key_data->scankeycodes[i]);
+ }
+ key_vol[key_num] = disc->measure;
+ for (i = 0; i < key_num; i++)
+ key_vol[i] += (key_vol[i+1] - key_vol[i])/2;
+
+ for (i = 0; i < 64; i++) {
+ if (i * disc->resol > key_vol[j])
+ j++;
+ keypad_mapindex[i] = j;
+ }
+
+ key_data->wakeup = of_property_read_bool(np, "wakeup-source");
+ device_init_wakeup(&pdev->dev, key_data->wakeup);
+
+ key_data->last_key_code = INITIAL_VALUE;
+
+ return 0;
+}
+
+#ifdef CONFIG_IIO
+struct sunxi_lradc_iio {
+ struct sunxi_key_data *key_data;
+};
+
+static const struct iio_chan_spec sunxi_lradc_channels[] = {
+ {
+ .indexed = 1,
+ .type = IIO_VOLTAGE,
+ .channel = 0,
+ .datasheet_name = "LRADC",
+ .info_mask_separate = BIT(IIO_CHAN_INFO_RAW),
+ },
+};
+
+/* default maps used by iio consumer (axp charger driver) */
+static struct iio_map sunxi_lradc_default_iio_maps[] = {
+ {
+ .consumer_dev_name = "axp-charger",
+ .consumer_channel = "axp-battery-lradc",
+ .adc_channel_label = "LRADC",
+ },
+ { }
+};
+
+static int sunxi_lradc_read_raw(struct iio_dev *indio_dev,
+ struct iio_chan_spec const *chan,
+ int *val, int *val2, long mask)
+{
+ int ret = 0;
+ int key_val, id_vol;
+ struct sunxi_lradc_iio *info = iio_priv(indio_dev);
+ struct sunxi_key_data *key_data = info->key_data;
+ struct sunxi_adc_disc *disc = key_data->disc;
+
+ mutex_lock(&indio_dev->mlock);
+ switch (mask) {
+ case IIO_CHAN_INFO_RAW:
+ key_val = sunxi_keyboard_read_data(key_data->reg_base) & 0x3f;
+ id_vol = key_val * disc->resol;
+ *val = id_vol;
+ break;
+ default:
+ ret = -EINVAL;
+ }
+ mutex_unlock(&indio_dev->mlock);
+
+ return ret;
+}
+
+static const struct iio_info sunxi_lradc_iio_info = {
+ .read_raw = &sunxi_lradc_read_raw,
+ .driver_module = THIS_MODULE,
+};
+
+static void sunxi_lradc_remove_iio(void *_data)
+{
+ struct iio_dev *indio_dev = _data;
+
+ if (IS_ERR_OR_NULL(indio_dev)) {
+ pr_err("indio_dev is null\n");
+ } else {
+ iio_device_unregister(indio_dev);
+ iio_map_array_unregister(indio_dev);
+ }
+}
+
+static int sunxi_keyboard_iio_init(struct platform_device *pdev)
+{
+ int ret;
+ struct iio_dev *indio_dev;
+ struct sunxi_lradc_iio *info;
+ struct sunxi_key_data *key_data = platform_get_drvdata(pdev);
+
+ indio_dev = devm_iio_device_alloc(&pdev->dev, sizeof(*info));
+ if (!indio_dev)
+ return -ENOMEM;
+
+ info = iio_priv(indio_dev);
+ info->key_data = key_data;
+
+ indio_dev->dev.parent = &pdev->dev;
+ indio_dev->name = pdev->name;
+ indio_dev->channels = sunxi_lradc_channels;
+ indio_dev->num_channels = ARRAY_SIZE(sunxi_lradc_channels);
+ indio_dev->info = &sunxi_lradc_iio_info;
+ indio_dev->modes = INDIO_DIRECT_MODE;
+ ret = iio_map_array_register(indio_dev, sunxi_lradc_default_iio_maps);
+ if (ret < 0)
+ return ret;
+
+ ret = iio_device_register(indio_dev);
+ if (ret < 0) {
+ dev_err(&pdev->dev, "unable to register iio device\n");
+ goto err_array_unregister;
+ }
+
+ ret = devm_add_action(&pdev->dev,
+ sunxi_lradc_remove_iio, indio_dev);
+ if (ret) {
+ dev_err(&pdev->dev, "unable to add iio cleanup action\n");
+ goto err_iio_unregister;
+ }
+
+ return 0;
+
+err_iio_unregister:
+ iio_device_unregister(indio_dev);
+
+err_array_unregister:
+ iio_map_array_unregister(indio_dev);
+
+ return ret;
+}
+#else
+static inline int sunxi_keyboard_iio_init(struct platform_device *pdev)
+{
+ return -ENODEV;
+}
+#endif
+
+static int sunxi_keyboard_probe(struct platform_device *pdev)
+{
+ static struct input_dev *sunxikbd_dev;
+ struct sunxi_key_data *key_data;
+ unsigned long mode, para;
+ int i;
+ int err = 0;
+
+ key_data = kzalloc(sizeof(*key_data), GFP_KERNEL);
+ if (IS_ERR_OR_NULL(key_data)) {
+ pr_err("key_data: not enough memory for key data\n");
+ return -ENOMEM;
+ }
+
+ pr_debug("sunxikbd_init\n");
+ if (pdev->dev.of_node) {
+ /* get dt and sysconfig */
+ err = sunxi_keyboard_startup(key_data, pdev);
+ } else {
+ pr_err("sunxi keyboard device tree err!\n");
+ return -EBUSY;
+ }
+
+ if (err < 0)
+ goto fail1;
+
+ if (sunxikbd_key_init(key_data, pdev)) {
+ err = -EFAULT;
+ goto fail1;
+ }
+
+ sunxikbd_dev = input_allocate_device();
+ if (!sunxikbd_dev) {
+ pr_err("sunxikbd: not enough memory for input device\n");
+ err = -ENOMEM;
+ goto fail1;
+ }
+
+ sunxikbd_dev->name = INPUT_DEV_NAME;
+ sunxikbd_dev->phys = "sunxikbd/input0";
+ sunxikbd_dev->id.bustype = BUS_HOST;
+ sunxikbd_dev->id.vendor = 0x0001;
+ sunxikbd_dev->id.product = 0x0001;
+ sunxikbd_dev->id.version = 0x0100;
+
+#ifdef REPORT_REPEAT_KEY_BY_INPUT_CORE
+ sunxikbd_dev->evbit[0] = BIT_MASK(EV_KEY)|BIT_MASK(EV_REP);
+ pr_info("support report repeat key value.\n");
+#else
+ sunxikbd_dev->evbit[0] = BIT_MASK(EV_KEY);
+#endif
+
+ for (i = 0; i < KEY_MAX_CNT; i++)
+ set_bit(key_data->scankeycodes[i], sunxikbd_dev->keybit);
+ key_data->input_dev = sunxikbd_dev;
+ platform_set_drvdata(pdev, key_data);
+#ifdef ONE_CHANNEL
+ mode = ADC0_DOWN_INT_SET | ADC0_UP_INT_SET | ADC0_DATA_INT_SET;
+ para = LRADC_ADC0_DOWN_EN | LRADC_ADC0_UP_EN | LRADC_ADC0_DATA_EN;
+ sunxi_keyboard_int_set(key_data->reg_base, mode, para);
+ mode = CONCERT_DLY_SET | ADC_CHAN_SET | KEY_MODE_SET
+ | LRADC_HOLD_SET | LEVELB_VOL_SET
+ | LRADC_SAMPLE_SET | LRADC_EN_SET;
+ para = FIRST_CONCERT_DLY|LEVELB_VOL|KEY_MODE_SELECT
+ |LRADC_HOLD_EN|ADC_CHAN_SELECT
+ |LRADC_SAMPLE_250HZ|LRADC_EN;
+ sunxi_keyboard_ctrl_set(key_data->reg_base, mode, para);
+#else
+#endif
+ if (request_irq(key_data->irq_num, sunxi_isr_key, 0,
+ "sunxikbd", key_data)) {
+ err = -EBUSY;
+ pr_err("request irq failure.\n");
+ goto fail2;
+ }
+ err = input_register_device(key_data->input_dev);
+ if (err)
+ goto fail3;
+
+ sunxi_keyboard_iio_init(pdev);
+
+ pr_debug("sunxikbd_init end\n");
+ return 0;
+
+fail3:
+ free_irq(key_data->irq_num, NULL);
+fail2:
+ input_free_device(key_data->input_dev);
+fail1:
+ kfree(key_data);
+ pr_err("sunxikbd_init failed.\n");
+
+ return err;
+}
+
+static int sunxi_keyboard_remove(struct platform_device *pdev)
+{
+ struct sunxi_key_data *key_data = platform_get_drvdata(pdev);
+
+ free_irq(key_data->irq_num, key_data);
+ input_unregister_device(key_data->input_dev);
+ device_init_wakeup(&pdev->dev, 0);
+ kfree(key_data);
+ return 0;
+}
+
+#ifdef CONFIG_PM
+static const struct dev_pm_ops sunxi_keyboard_pm_ops = {
+ .suspend = sunxi_keyboard_suspend,
+ .resume = sunxi_keyboard_resume,
+};
+
+#define SUNXI_KEYBOARD_PM_OPS (&sunxi_keyboard_pm_ops)
+#endif
+
+static struct platform_driver sunxi_keyboard_driver = {
+ .probe = sunxi_keyboard_probe,
+ .remove = sunxi_keyboard_remove,
+ .driver = {
+ .name = "sunxi-keyboard",
+ .owner = THIS_MODULE,
+#ifdef CONFIG_PM
+ .pm = SUNXI_KEYBOARD_PM_OPS,
+#endif
+ .of_match_table = of_match_ptr(sunxi_keyboard_of_match),
+ },
+};
+
+static int __init sunxi_keyboard_init(void)
+{
+ int ret;
+
+ ret = platform_driver_register(&sunxi_keyboard_driver);
+
+ return ret;
+}
+
+static void __exit sunxi_keyboard_exit(void)
+{
+ platform_driver_unregister(&sunxi_keyboard_driver);
+}
+
+subsys_initcall_sync(sunxi_keyboard_init);
+module_exit(sunxi_keyboard_exit);
+
+MODULE_AUTHOR(" Qin");
+MODULE_DESCRIPTION("sunxi-keyboard driver");
+MODULE_LICENSE("GPL");