AuxXxilium/linux_dsm_epyc7002
1
0
Fork 0
mirror of https://github.com/AuxXxilium/linux_dsm_epyc7002.git synced 2024-11-24 12:40:53 +07:00
Code Issues Actions Packages Projects Releases Wiki Activity

sh: sh_mobile keysc clock framework support

Browse Source 
Add clock framework support to the sh_mobile keysc driver and
adjust the board specific code accordingly.

Signed-off-by: Magnus Damm <damm@igel.co.jp>
Signed-off-by: Paul Mundt <lethal@linux-sh.org>
This commit is contained in:
Magnus Damm 2008-10-31 20:21:23 +09:00 committed by Paul Mundt
parent a5616bd0f1
commit 090d951b69
3 changed files with 25 additions and 8 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
arch/sh/boards/mach-migor/setup.c
View File

@ -89,6 +89,7 @@ static struct resource sh_keysc_resources[] = {
static struct platform_device sh_keysc_device = { static struct platform_device sh_keysc_device = {
.name = "sh_keysc", .name = "sh_keysc",
.id = 0, /* "keysc0" clock */
.num_resources = ARRAY_SIZE(sh_keysc_resources), .num_resources = ARRAY_SIZE(sh_keysc_resources),
.resource = sh_keysc_resources, .resource = sh_keysc_resources,
.dev = { .dev = {
@ -479,7 +480,6 @@ static int __init migor_devices_setup(void)
ctrl_outl(0x00110080, BSC_CS4WCR); ctrl_outl(0x00110080, BSC_CS4WCR);
/* KEYSC */ /* KEYSC */
clk_always_enable("mstp214"); /* KEYSC */
gpio_request(GPIO_FN_KEYOUT0, NULL); gpio_request(GPIO_FN_KEYOUT0, NULL);
gpio_request(GPIO_FN_KEYOUT1, NULL); gpio_request(GPIO_FN_KEYOUT1, NULL);
gpio_request(GPIO_FN_KEYOUT2, NULL); gpio_request(GPIO_FN_KEYOUT2, NULL);

3
arch/sh/boards/mach-se/7722/setup.c
View File

@ -130,6 +130,7 @@ static struct resource sh_keysc_resources[] = {
static struct platform_device sh_keysc_device = { static struct platform_device sh_keysc_device = {
.name = "sh_keysc", .name = "sh_keysc",
.id = 0, /* "keysc0" clock */
.num_resources = ARRAY_SIZE(sh_keysc_resources), .num_resources = ARRAY_SIZE(sh_keysc_resources),
.resource = sh_keysc_resources, .resource = sh_keysc_resources,
.dev = { .dev = {
@ -146,8 +147,6 @@ static struct platform_device *se7722_devices[] __initdata = {
static int __init se7722_devices_setup(void) static int __init se7722_devices_setup(void)
{ {
clk_always_enable("mstp214"); /* KEYSC */
return platform_add_devices(se7722_devices, return platform_add_devices(se7722_devices,
ARRAY_SIZE(se7722_devices)); ARRAY_SIZE(se7722_devices));
} }

28
drivers/input/keyboard/sh_keysc.c
View File

@ -18,6 +18,7 @@
#include <linux/delay.h> #include <linux/delay.h>
#include <linux/platform_device.h> #include <linux/platform_device.h>
#include <linux/input.h> #include <linux/input.h>
#include <linux/clk.h>
#include <linux/io.h> #include <linux/io.h>
#include <asm/sh_keysc.h> #include <asm/sh_keysc.h>
@ -39,6 +40,7 @@ static const struct {
struct sh_keysc_priv { struct sh_keysc_priv {
void __iomem *iomem_base; void __iomem *iomem_base;
struct clk *clk;
unsigned long last_keys; unsigned long last_keys;
struct input_dev *input; struct input_dev *input;
struct sh_keysc_info pdata; struct sh_keysc_info pdata;
@ -125,6 +127,7 @@ static int __devinit sh_keysc_probe(struct platform_device *pdev)
struct sh_keysc_info *pdata; struct sh_keysc_info *pdata;
struct resource *res; struct resource *res;
struct input_dev *input; struct input_dev *input;
char clk_name[8];
int i, k; int i, k;
int irq, error; int irq, error;
@ -165,11 +168,19 @@ static int __devinit sh_keysc_probe(struct platform_device *pdev)
goto err1; goto err1;
} }
snprintf(clk_name, sizeof(clk_name), "keysc%d", pdev->id);
priv->clk = clk_get(&pdev->dev, clk_name);
if (IS_ERR(priv->clk)) {
dev_err(&pdev->dev, "cannot get clock \"%s\"\n", clk_name);
error = PTR_ERR(priv->clk);
goto err2;
}
priv->input = input_allocate_device(); priv->input = input_allocate_device();
if (!priv->input) { if (!priv->input) {
dev_err(&pdev->dev, "failed to allocate input device\n"); dev_err(&pdev->dev, "failed to allocate input device\n");
error = -ENOMEM; error = -ENOMEM;
goto err2; goto err3;
} }
input = priv->input; input = priv->input;
@ -187,7 +198,7 @@ static int __devinit sh_keysc_probe(struct platform_device *pdev)
error = request_irq(irq, sh_keysc_isr, 0, pdev->name, pdev); error = request_irq(irq, sh_keysc_isr, 0, pdev->name, pdev);
if (error) { if (error) {
dev_err(&pdev->dev, "failed to request IRQ\n"); dev_err(&pdev->dev, "failed to request IRQ\n");
goto err3; goto err4;
} }
for (i = 0; i < SH_KEYSC_MAXKEYS; i++) { for (i = 0; i < SH_KEYSC_MAXKEYS; i++) {
@ -199,18 +210,22 @@ static int __devinit sh_keysc_probe(struct platform_device *pdev)
error = input_register_device(input); error = input_register_device(input);
if (error) { if (error) {
dev_err(&pdev->dev, "failed to register input device\n"); dev_err(&pdev->dev, "failed to register input device\n");
goto err4; goto err5;
} }
clk_enable(priv->clk);
iowrite16((sh_keysc_mode[pdata->mode].kymd << 8) | iowrite16((sh_keysc_mode[pdata->mode].kymd << 8) |
pdata->scan_timing, priv->iomem_base + KYCR1_OFFS); pdata->scan_timing, priv->iomem_base + KYCR1_OFFS);
iowrite16(0, priv->iomem_base + KYOUTDR_OFFS); iowrite16(0, priv->iomem_base + KYOUTDR_OFFS);
iowrite16(KYCR2_IRQ_LEVEL, priv->iomem_base + KYCR2_OFFS); iowrite16(KYCR2_IRQ_LEVEL, priv->iomem_base + KYCR2_OFFS);
return 0; return 0;
err4: err5:
free_irq(irq, pdev); free_irq(irq, pdev);
err3: err4:
input_free_device(input); input_free_device(input);
err3:
clk_put(priv->clk);
err2: err2:
iounmap(priv->iomem_base); iounmap(priv->iomem_base);
err1: err1:
@ -230,6 +245,9 @@ static int __devexit sh_keysc_remove(struct platform_device *pdev)
free_irq(platform_get_irq(pdev, 0), pdev); free_irq(platform_get_irq(pdev, 0), pdev);
iounmap(priv->iomem_base); iounmap(priv->iomem_base);
clk_disable(priv->clk);
clk_put(priv->clk);
platform_set_drvdata(pdev, NULL); platform_set_drvdata(pdev, NULL);
kfree(priv); kfree(priv);
return 0; return 0;