Commit a42b6dd6 authored by Magnus Damm's avatar Magnus Damm Committed by Paul Mundt

sh: sh_mobile ceu clock framework support

Add clock framework support to the sh_mobile ceu and
adjust the board specific code accordingly.
Signed-off-by: default avatarMagnus Damm <damm@igel.co.jp>
Signed-off-by: default avatarPaul Mundt <lethal@linux-sh.org>
parent 090d951b
...@@ -303,6 +303,7 @@ static struct resource ceu_resources[] = { ...@@ -303,6 +303,7 @@ static struct resource ceu_resources[] = {
static struct platform_device ceu_device = { static struct platform_device ceu_device = {
.name = "sh_mobile_ceu", .name = "sh_mobile_ceu",
.id = 0, /* "ceu0" clock */
.num_resources = ARRAY_SIZE(ceu_resources), .num_resources = ARRAY_SIZE(ceu_resources),
.resource = ceu_resources, .resource = ceu_resources,
.dev = { .dev = {
...@@ -375,7 +376,6 @@ static int __init ap325rxa_devices_setup(void) ...@@ -375,7 +376,6 @@ static int __init ap325rxa_devices_setup(void)
gpio_direction_output(GPIO_PTS3, 1); gpio_direction_output(GPIO_PTS3, 1);
/* CEU */ /* CEU */
clk_always_enable("mstp203");
gpio_request(GPIO_FN_VIO_CLK2, NULL); gpio_request(GPIO_FN_VIO_CLK2, NULL);
gpio_request(GPIO_FN_VIO_VD2, NULL); gpio_request(GPIO_FN_VIO_VD2, NULL);
gpio_request(GPIO_FN_VIO_HD2, NULL); gpio_request(GPIO_FN_VIO_HD2, NULL);
......
...@@ -433,6 +433,7 @@ static struct resource migor_ceu_resources[] = { ...@@ -433,6 +433,7 @@ static struct resource migor_ceu_resources[] = {
static struct platform_device migor_ceu_device = { static struct platform_device migor_ceu_device = {
.name = "sh_mobile_ceu", .name = "sh_mobile_ceu",
.id = 0, /* "ceu0" clock */
.num_resources = ARRAY_SIZE(migor_ceu_resources), .num_resources = ARRAY_SIZE(migor_ceu_resources),
.resource = migor_ceu_resources, .resource = migor_ceu_resources,
.dev = { .dev = {
...@@ -554,7 +555,6 @@ static int __init migor_devices_setup(void) ...@@ -554,7 +555,6 @@ static int __init migor_devices_setup(void)
#endif #endif
/* CEU */ /* CEU */
clk_always_enable("mstp203"); /* CEU */
gpio_request(GPIO_FN_VIO_CLK2, NULL); gpio_request(GPIO_FN_VIO_CLK2, NULL);
gpio_request(GPIO_FN_VIO_VD2, NULL); gpio_request(GPIO_FN_VIO_VD2, NULL);
gpio_request(GPIO_FN_VIO_HD2, NULL); gpio_request(GPIO_FN_VIO_HD2, NULL);
......
...@@ -31,6 +31,7 @@ ...@@ -31,6 +31,7 @@
#include <linux/platform_device.h> #include <linux/platform_device.h>
#include <linux/mutex.h> #include <linux/mutex.h>
#include <linux/videodev2.h> #include <linux/videodev2.h>
#include <linux/clk.h>
#include <media/v4l2-common.h> #include <media/v4l2-common.h>
#include <media/v4l2-dev.h> #include <media/v4l2-dev.h>
...@@ -89,6 +90,7 @@ struct sh_mobile_ceu_dev { ...@@ -89,6 +90,7 @@ struct sh_mobile_ceu_dev {
unsigned int irq; unsigned int irq;
void __iomem *base; void __iomem *base;
struct clk *clk;
unsigned long video_limit; unsigned long video_limit;
/* lock used to protect videobuf */ /* lock used to protect videobuf */
...@@ -309,6 +311,8 @@ static int sh_mobile_ceu_add_device(struct soc_camera_device *icd) ...@@ -309,6 +311,8 @@ static int sh_mobile_ceu_add_device(struct soc_camera_device *icd)
if (ret) if (ret)
goto err; goto err;
clk_enable(pcdev->clk);
ceu_write(pcdev, CAPSR, 1 << 16); /* reset */ ceu_write(pcdev, CAPSR, 1 << 16); /* reset */
while (ceu_read(pcdev, CSTSR) & 1) while (ceu_read(pcdev, CSTSR) & 1)
msleep(1); msleep(1);
...@@ -342,6 +346,8 @@ static void sh_mobile_ceu_remove_device(struct soc_camera_device *icd) ...@@ -342,6 +346,8 @@ static void sh_mobile_ceu_remove_device(struct soc_camera_device *icd)
} }
spin_unlock_irqrestore(&pcdev->lock, flags); spin_unlock_irqrestore(&pcdev->lock, flags);
clk_disable(pcdev->clk);
icd->ops->release(icd); icd->ops->release(icd);
dev_info(&icd->dev, dev_info(&icd->dev,
...@@ -550,6 +556,7 @@ static int sh_mobile_ceu_probe(struct platform_device *pdev) ...@@ -550,6 +556,7 @@ static int sh_mobile_ceu_probe(struct platform_device *pdev)
struct sh_mobile_ceu_dev *pcdev; struct sh_mobile_ceu_dev *pcdev;
struct resource *res; struct resource *res;
void __iomem *base; void __iomem *base;
char clk_name[8];
unsigned int irq; unsigned int irq;
int err = 0; int err = 0;
...@@ -615,6 +622,14 @@ static int sh_mobile_ceu_probe(struct platform_device *pdev) ...@@ -615,6 +622,14 @@ static int sh_mobile_ceu_probe(struct platform_device *pdev)
goto exit_release_mem; goto exit_release_mem;
} }
snprintf(clk_name, sizeof(clk_name), "ceu%d", pdev->id);
pcdev->clk = clk_get(&pdev->dev, clk_name);
if (IS_ERR(pcdev->clk)) {
dev_err(&pdev->dev, "cannot get clock \"%s\"\n", clk_name);
err = PTR_ERR(pcdev->clk);
goto exit_free_irq;
}
pcdev->ici.priv = pcdev; pcdev->ici.priv = pcdev;
pcdev->ici.dev.parent = &pdev->dev; pcdev->ici.dev.parent = &pdev->dev;
pcdev->ici.nr = pdev->id; pcdev->ici.nr = pdev->id;
...@@ -623,10 +638,12 @@ static int sh_mobile_ceu_probe(struct platform_device *pdev) ...@@ -623,10 +638,12 @@ static int sh_mobile_ceu_probe(struct platform_device *pdev)
err = soc_camera_host_register(&pcdev->ici); err = soc_camera_host_register(&pcdev->ici);
if (err) if (err)
goto exit_free_irq; goto exit_free_clk;
return 0; return 0;
exit_free_clk:
clk_put(pcdev->clk);
exit_free_irq: exit_free_irq:
free_irq(pcdev->irq, pcdev); free_irq(pcdev->irq, pcdev);
exit_release_mem: exit_release_mem:
...@@ -645,6 +662,7 @@ static int sh_mobile_ceu_remove(struct platform_device *pdev) ...@@ -645,6 +662,7 @@ static int sh_mobile_ceu_remove(struct platform_device *pdev)
struct sh_mobile_ceu_dev *pcdev = platform_get_drvdata(pdev); struct sh_mobile_ceu_dev *pcdev = platform_get_drvdata(pdev);
soc_camera_host_unregister(&pcdev->ici); soc_camera_host_unregister(&pcdev->ici);
clk_put(pcdev->clk);
free_irq(pcdev->irq, pcdev); free_irq(pcdev->irq, pcdev);
if (platform_get_resource(pdev, IORESOURCE_MEM, 1)) if (platform_get_resource(pdev, IORESOURCE_MEM, 1))
dma_release_declared_memory(&pdev->dev); dma_release_declared_memory(&pdev->dev);
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment