Commit 4f528afc authored by Guennadi Liakhovetski's avatar Guennadi Liakhovetski Committed by Mauro Carvalho Chehab

[media] V4L: add CCF support to the v4l2_clk API

V4L2 clocks, e.g. used by camera sensors for their master clock, do not
have to be supplied by a different V4L2 driver, they can also be
supplied by an independent source. In this case the standart kernel
clock API should be used to handle such clocks. This patch adds support
for such cases.
Signed-off-by: default avatarGuennadi Liakhovetski <g.liakhovetski@gmx.de>
Acked-by: default avatarLaurent Pinchart <laurent.pinchart@ideasonboard.com>
Tested-by: default avatarJosh Wu <josh.wu@atmel.com>
Signed-off-by: default avatarMauro Carvalho Chehab <mchehab@osg.samsung.com>
parent a37462b9
...@@ -9,6 +9,7 @@ ...@@ -9,6 +9,7 @@
*/ */
#include <linux/atomic.h> #include <linux/atomic.h>
#include <linux/clk.h>
#include <linux/device.h> #include <linux/device.h>
#include <linux/errno.h> #include <linux/errno.h>
#include <linux/list.h> #include <linux/list.h>
...@@ -37,6 +38,21 @@ static struct v4l2_clk *v4l2_clk_find(const char *dev_id) ...@@ -37,6 +38,21 @@ static struct v4l2_clk *v4l2_clk_find(const char *dev_id)
struct v4l2_clk *v4l2_clk_get(struct device *dev, const char *id) struct v4l2_clk *v4l2_clk_get(struct device *dev, const char *id)
{ {
struct v4l2_clk *clk; struct v4l2_clk *clk;
struct clk *ccf_clk = clk_get(dev, id);
if (PTR_ERR(ccf_clk) == -EPROBE_DEFER)
return ERR_PTR(-EPROBE_DEFER);
if (!IS_ERR_OR_NULL(ccf_clk)) {
clk = kzalloc(sizeof(*clk), GFP_KERNEL);
if (!clk) {
clk_put(ccf_clk);
return ERR_PTR(-ENOMEM);
}
clk->clk = ccf_clk;
return clk;
}
mutex_lock(&clk_lock); mutex_lock(&clk_lock);
clk = v4l2_clk_find(dev_name(dev)); clk = v4l2_clk_find(dev_name(dev));
...@@ -56,6 +72,12 @@ void v4l2_clk_put(struct v4l2_clk *clk) ...@@ -56,6 +72,12 @@ void v4l2_clk_put(struct v4l2_clk *clk)
if (IS_ERR(clk)) if (IS_ERR(clk))
return; return;
if (clk->clk) {
clk_put(clk->clk);
kfree(clk);
return;
}
mutex_lock(&clk_lock); mutex_lock(&clk_lock);
list_for_each_entry(tmp, &clk_list, list) list_for_each_entry(tmp, &clk_list, list)
...@@ -93,8 +115,12 @@ static void v4l2_clk_unlock_driver(struct v4l2_clk *clk) ...@@ -93,8 +115,12 @@ static void v4l2_clk_unlock_driver(struct v4l2_clk *clk)
int v4l2_clk_enable(struct v4l2_clk *clk) int v4l2_clk_enable(struct v4l2_clk *clk)
{ {
int ret = v4l2_clk_lock_driver(clk); int ret;
if (clk->clk)
return clk_prepare_enable(clk->clk);
ret = v4l2_clk_lock_driver(clk);
if (ret < 0) if (ret < 0)
return ret; return ret;
...@@ -120,6 +146,9 @@ void v4l2_clk_disable(struct v4l2_clk *clk) ...@@ -120,6 +146,9 @@ void v4l2_clk_disable(struct v4l2_clk *clk)
{ {
int enable; int enable;
if (clk->clk)
return clk_disable_unprepare(clk->clk);
mutex_lock(&clk->lock); mutex_lock(&clk->lock);
enable = --clk->enable; enable = --clk->enable;
...@@ -137,8 +166,12 @@ EXPORT_SYMBOL(v4l2_clk_disable); ...@@ -137,8 +166,12 @@ EXPORT_SYMBOL(v4l2_clk_disable);
unsigned long v4l2_clk_get_rate(struct v4l2_clk *clk) unsigned long v4l2_clk_get_rate(struct v4l2_clk *clk)
{ {
int ret = v4l2_clk_lock_driver(clk); int ret;
if (clk->clk)
return clk_get_rate(clk->clk);
ret = v4l2_clk_lock_driver(clk);
if (ret < 0) if (ret < 0)
return ret; return ret;
...@@ -157,7 +190,16 @@ EXPORT_SYMBOL(v4l2_clk_get_rate); ...@@ -157,7 +190,16 @@ EXPORT_SYMBOL(v4l2_clk_get_rate);
int v4l2_clk_set_rate(struct v4l2_clk *clk, unsigned long rate) int v4l2_clk_set_rate(struct v4l2_clk *clk, unsigned long rate)
{ {
int ret = v4l2_clk_lock_driver(clk); int ret;
if (clk->clk) {
long r = clk_round_rate(clk->clk, rate);
if (r < 0)
return r;
return clk_set_rate(clk->clk, r);
}
ret = v4l2_clk_lock_driver(clk);
if (ret < 0) if (ret < 0)
return ret; return ret;
......
...@@ -22,6 +22,7 @@ ...@@ -22,6 +22,7 @@
struct module; struct module;
struct device; struct device;
struct clk;
struct v4l2_clk { struct v4l2_clk {
struct list_head list; struct list_head list;
const struct v4l2_clk_ops *ops; const struct v4l2_clk_ops *ops;
...@@ -29,6 +30,7 @@ struct v4l2_clk { ...@@ -29,6 +30,7 @@ struct v4l2_clk {
int enable; int enable;
struct mutex lock; /* Protect the enable count */ struct mutex lock; /* Protect the enable count */
atomic_t use_count; atomic_t use_count;
struct clk *clk;
void *priv; void *priv;
}; };
......
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