74 static void ske_keypad_set_bits(struct ske_keypad *keypad, u16 addr,  in ske_keypad_set_bits()  argument
79 	spin_lock(&keypad->ske_keypad_lock);  in ske_keypad_set_bits()
81 	ret = readl(keypad->reg_base + addr);  in ske_keypad_set_bits()
84 	writel(ret, keypad->reg_base + addr);  in ske_keypad_set_bits()
86 	spin_unlock(&keypad->ske_keypad_lock);  in ske_keypad_set_bits()
94 static int __init ske_keypad_chip_init(struct ske_keypad *keypad)  in ske_keypad_chip_init()  argument
97 	int timeout = keypad->board->debounce_ms;  in ske_keypad_chip_init()
100 	while ((readl(keypad->reg_base + SKE_RIS) != 0x00000000) && timeout--)  in ske_keypad_chip_init()
111 	spin_lock(&keypad->ske_keypad_lock);  in ske_keypad_chip_init()
112 	value = readl(keypad->reg_base + SKE_DBCR);  in ske_keypad_chip_init()
114 	value |= ((keypad->board->debounce_ms * 32000)/32768) << 8;  in ske_keypad_chip_init()
115 	writel(value, keypad->reg_base + SKE_DBCR);  in ske_keypad_chip_init()
116 	spin_unlock(&keypad->ske_keypad_lock);  in ske_keypad_chip_init()
119 	ske_keypad_set_bits(keypad, SKE_CR, 0x0, SKE_KPMLT);  in ske_keypad_chip_init()
125 	value = (keypad->board->kcol - 1) << 3;  in ske_keypad_chip_init()
126 	ske_keypad_set_bits(keypad, SKE_CR, SKE_KPCN, value);  in ske_keypad_chip_init()
129 	ske_keypad_set_bits(keypad, SKE_ICR, 0x0, SKE_KPICA | SKE_KPICS);  in ske_keypad_chip_init()
132 	ske_keypad_set_bits(keypad, SKE_IMSC, 0x0, SKE_KPIMA);  in ske_keypad_chip_init()
135 	ske_keypad_set_bits(keypad, SKE_CR, 0x0, SKE_KPASEN);  in ske_keypad_chip_init()
140 static void ske_keypad_report(struct ske_keypad *keypad, u8 status, int col)  in ske_keypad_report()  argument
143 	struct input_dev *input = keypad->input;  in ske_keypad_report()
156 		ske_ris = readl(keypad->reg_base + SKE_RIS);  in ske_keypad_report()
160 		input_report_key(input, keypad->keymap[code], key_pressed);  in ske_keypad_report()
166 static void ske_keypad_read_data(struct ske_keypad *keypad)  in ske_keypad_read_data()  argument
180 		ske_asr = readl(keypad->reg_base + SKE_ASR0 + (4 * i));  in ske_keypad_read_data()
188 			ske_keypad_report(keypad, status, col);  in ske_keypad_read_data()
193 			ske_keypad_report(keypad, status, col);  in ske_keypad_read_data()
200 	struct ske_keypad *keypad = dev_id;  in ske_keypad_irq()  local
201 	int timeout = keypad->board->debounce_ms;  in ske_keypad_irq()
204 	ske_keypad_set_bits(keypad, SKE_IMSC, ~SKE_KPIMA, 0x0);  in ske_keypad_irq()
205 	ske_keypad_set_bits(keypad, SKE_ICR, 0x0, SKE_KPICA);  in ske_keypad_irq()
207 	while ((readl(keypad->reg_base + SKE_CR) & SKE_KPASON) && --timeout)  in ske_keypad_irq()
211 	ske_keypad_read_data(keypad);  in ske_keypad_irq()
214 	while ((readl(keypad->reg_base + SKE_RIS)) && --timeout)  in ske_keypad_irq()
218 	ske_keypad_set_bits(keypad, SKE_IMSC, 0x0, SKE_KPIMA);  in ske_keypad_irq()
227 	struct ske_keypad *keypad;  in ske_keypad_probe()  local
250 	keypad = kzalloc(sizeof(struct ske_keypad), GFP_KERNEL);  in ske_keypad_probe()
252 	if (!keypad || !input) {  in ske_keypad_probe()
258 	keypad->irq = irq;  in ske_keypad_probe()
259 	keypad->board = plat;  in ske_keypad_probe()
260 	keypad->input = input;  in ske_keypad_probe()
261 	spin_lock_init(&keypad->ske_keypad_lock);  in ske_keypad_probe()
269 	keypad->reg_base = ioremap(res->start, resource_size(res));  in ske_keypad_probe()
270 	if (!keypad->reg_base) {  in ske_keypad_probe()
276 	keypad->pclk = clk_get(&pdev->dev, "apb_pclk");  in ske_keypad_probe()
277 	if (IS_ERR(keypad->pclk)) {  in ske_keypad_probe()
279 		error = PTR_ERR(keypad->pclk);  in ske_keypad_probe()
283 	keypad->clk = clk_get(&pdev->dev, NULL);  in ske_keypad_probe()
284 	if (IS_ERR(keypad->clk)) {  in ske_keypad_probe()
286 		error = PTR_ERR(keypad->clk);  in ske_keypad_probe()
296 					   keypad->keymap, input);  in ske_keypad_probe()
306 	error = clk_prepare_enable(keypad->pclk);  in ske_keypad_probe()
312 	error = clk_prepare_enable(keypad->clk);  in ske_keypad_probe()
320 	if (keypad->board->init)  in ske_keypad_probe()
321 		keypad->board->init();  in ske_keypad_probe()
323 	error = ske_keypad_chip_init(keypad);  in ske_keypad_probe()
329 	error = request_threaded_irq(keypad->irq, NULL, ske_keypad_irq,  in ske_keypad_probe()
330 				     IRQF_ONESHOT, "ske-keypad", keypad);  in ske_keypad_probe()
332 		dev_err(&pdev->dev, "allocate irq %d failed\n", keypad->irq);  in ske_keypad_probe()
346 	platform_set_drvdata(pdev, keypad);  in ske_keypad_probe()
351 	free_irq(keypad->irq, keypad);  in ske_keypad_probe()
353 	clk_disable_unprepare(keypad->clk);  in ske_keypad_probe()
355 	clk_disable_unprepare(keypad->pclk);  in ske_keypad_probe()
357 	clk_put(keypad->clk);  in ske_keypad_probe()
359 	clk_put(keypad->pclk);  in ske_keypad_probe()
361 	iounmap(keypad->reg_base);  in ske_keypad_probe()
366 	kfree(keypad);  in ske_keypad_probe()
372 	struct ske_keypad *keypad = platform_get_drvdata(pdev);  in ske_keypad_remove()  local
375 	free_irq(keypad->irq, keypad);  in ske_keypad_remove()
377 	input_unregister_device(keypad->input);  in ske_keypad_remove()
379 	clk_disable_unprepare(keypad->clk);  in ske_keypad_remove()
380 	clk_put(keypad->clk);  in ske_keypad_remove()
382 	if (keypad->board->exit)  in ske_keypad_remove()
383 		keypad->board->exit();  in ske_keypad_remove()
385 	iounmap(keypad->reg_base);  in ske_keypad_remove()
387 	kfree(keypad);  in ske_keypad_remove()
396 	struct ske_keypad *keypad = platform_get_drvdata(pdev);  in ske_keypad_suspend()  local
402 		ske_keypad_set_bits(keypad, SKE_IMSC, ~SKE_KPIMA, 0x0);  in ske_keypad_suspend()
410 	struct ske_keypad *keypad = platform_get_drvdata(pdev);  in ske_keypad_resume()  local
416 		ske_keypad_set_bits(keypad, SKE_IMSC, 0x0, SKE_KPIMA);  in ske_keypad_resume()