这周周末要搞懂的一个S5PV210 android驱动入门函数s3c_keypad_probe

static int __init s3c_keypad_probe(struct platform_device *pdev)
{
struct resource *res, *keypad_mem, *keypad_irq;
struct input_dev *input_dev;
struct s3c_keypad *s3c_keypad;
int ret, size;
int key, code;


res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
if (res == NULL) {
dev_err(&pdev->dev, "no memory resource specified\n");
return -ENOENT;
}


size = (res->end - res->start) + 1;


keypad_mem = request_mem_region(res->start, size, pdev->name);
if (keypad_mem == NULL) {
dev_err(&pdev->dev, "failed to get memory region\n");
ret = -ENOENT;
goto err_req;
}


key_base = ioremap(res->start, size);
if (key_base == NULL) {
pr_err("Failed to remap register block\n");
ret = -ENOMEM;
goto err_map;
}


keypad_clock = clk_get(&pdev->dev, "keypad");
if (IS_ERR(keypad_clock)) {
dev_err(&pdev->dev, "failed to find keypad clock source\n");
ret = PTR_ERR(keypad_clock);
goto err_clk;
}


clk_enable(keypad_clock);


s3c_keypad = kzalloc(sizeof(struct s3c_keypad), GFP_KERNEL);
input_dev = input_allocate_device();


if (!s3c_keypad || !input_dev) {
ret = -ENOMEM;
goto err_alloc;
}


platform_set_drvdata(pdev, s3c_keypad);
s3c_keypad->dev = input_dev;


writel(KEYIFCON_INIT, key_base+S3C_KEYIFCON);
writel(KEYIFFC_DIV, key_base+S3C_KEYIFFC);


/* Set GPIO Port for keypad mode and pull-up disable*/


#if defined(CONFIG_KEYPAD_S3C_MSM)
s3c_setup_keypad_cfg_gpio();
#else
s3c_setup_keypad_cfg_gpio(KEYPAD_ROWS, KEYPAD_COLUMNS);
#endif
writel(KEYIFCOL_CLEAR, key_base+S3C_KEYIFCOL);


/* create and register the input driver */
set_bit(EV_KEY, input_dev->evbit);
s3c_keypad->nr_rows = KEYPAD_ROWS;
s3c_keypad->no_cols = KEYPAD_COLUMNS;
s3c_keypad->total_keys = MAX_KEYPAD_NR;


for (key = 0; key < s3c_keypad->total_keys; key++) {
code = s3c_keypad->keycodes[key] = keypad_keycode[key];
if (code <= 0)
continue;
set_bit(code & KEY_MAX, input_dev->keybit);
}


input_dev->name = DEVICE_NAME;
input_dev->phys = "s3c-keypad/input0";


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


input_dev->keycode = keypad_keycode;


/* Scan timer init */
init_timer(&keypad_timer);
keypad_timer.function = keypad_timer_handler;
keypad_timer.data = (unsigned long)s3c_keypad;


/* For IRQ_KEYPAD */
keypad_irq = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
if (keypad_irq == NULL) {
dev_err(&pdev->dev, "no irq resource specified\n");
ret = -ENOENT;
goto err_irq;
}
ret = request_irq(keypad_irq->start, s3c_keypad_isr, 0,
DEVICE_NAME, (void *) pdev);
if (ret) {
pr_err("request_irq failed (IRQ_KEYPAD)\n");
ret = -EIO;
goto err_irq;
}


ret = input_register_device(input_dev);
if (ret) {
pr_err("Unable to register s3c-keypad input device!!!\n");
goto out;
}


keypad_timer.expires = jiffies + (HZ/10);


if (is_timer_on == false) {
add_timer(&keypad_timer);
is_timer_on = true;
} else {
mod_timer(&keypad_timer, keypad_timer.expires);
}


pr_info(DEVICE_NAME " Initialized\n");
return 0;


out:
free_irq(keypad_irq->start, input_dev);
free_irq(keypad_irq->end, input_dev);


err_irq:
input_free_device(input_dev);
kfree(s3c_keypad);


err_alloc:
clk_disable(keypad_clock);
clk_put(keypad_clock);


err_clk:
iounmap(key_base);


err_map:
release_resource(keypad_mem);
kfree(keypad_mem);


err_req:
return ret;
}