mirror of
https://mirrors.bfsu.edu.cn/git/linux.git
synced 2024-12-15 15:04:27 +08:00
bc0e8d91fe
Switch all drivers accessing sub-device state to use the stream-aware functions. We will soon remove the old ones. This patch has been generated using the following Coccinelle script: ---------8<------------ @@ expression E1, E2, E3; @@ - v4l2_subdev_get_pad_format(E1, E2, E3) + v4l2_subdev_state_get_format(E2, E3) @@ expression E1, E2, E3; @@ - v4l2_subdev_get_pad_crop(E1, E2, E3) + v4l2_subdev_state_get_crop(E2, E3) @@ expression E1, E2, E3; @@ - v4l2_subdev_get_pad_compose(E1, E2, E3) + v4l2_subdev_state_get_compose(E2, E3) @@ expression E1, E2, E3; @@ - v4l2_subdev_get_try_format(E1, E2, E3) + v4l2_subdev_state_get_format(E2, E3) @@ expression E1, E2, E3; @@ - v4l2_subdev_get_try_crop(E1, E2, E3) + v4l2_subdev_state_get_crop(E2, E3) @@ expression E1, E2, E3; @@ - v4l2_subdev_get_try_compose(E1, E2, E3) + v4l2_subdev_state_get_compose(E2, E3) ---------8<------------ Additionally drivers/media/i2c/s5k5baf.c and drivers/media/platform/samsung/s3c-camif/camif-capture.c have been manually changed as Coccinelle didn't. Further local variables have been removed as they became unused as a result of the other changes. Also Coccinelle introduced indentation by space in files drivers/media/i2c/st-mipid02.c and drivers/media/platform/rockchip/rkisp1/rkisp1-isp.c. This has been also corrected. The diff from Coccinelle-generated changes are: > diff --git b/drivers/media/i2c/imx319.c a/drivers/media/i2c/imx319.c > index e549692ff478..420984382173 100644 > --- b/drivers/media/i2c/imx319.c > +++ a/drivers/media/i2c/imx319.c > @@ -2001,7 +2001,6 @@ static int imx319_do_get_pad_format(struct imx319 *imx319, > struct v4l2_subdev_format *fmt) > { > struct v4l2_mbus_framefmt *framefmt; > - struct v4l2_subdev *sd = &imx319->sd; > > if (fmt->which == V4L2_SUBDEV_FORMAT_TRY) { > framefmt = v4l2_subdev_state_get_format(sd_state, fmt->pad); > diff --git b/drivers/media/i2c/imx355.c a/drivers/media/i2c/imx355.c > index 96bdde685d65..e1b1d2fc79dd 100644 > --- b/drivers/media/i2c/imx355.c > +++ a/drivers/media/i2c/imx355.c > @@ -1299,7 +1299,6 @@ static int imx355_do_get_pad_format(struct imx355 *imx355, > struct v4l2_subdev_format *fmt) > { > struct v4l2_mbus_framefmt *framefmt; > - struct v4l2_subdev *sd = &imx355->sd; > > if (fmt->which == V4L2_SUBDEV_FORMAT_TRY) { > framefmt = v4l2_subdev_state_get_format(sd_state, fmt->pad); > diff --git b/drivers/media/i2c/ov08x40.c a/drivers/media/i2c/ov08x40.c > index ca799bbcfdb7..abbb0b774d43 100644 > --- b/drivers/media/i2c/ov08x40.c > +++ a/drivers/media/i2c/ov08x40.c > @@ -2774,7 +2774,6 @@ static int ov08x40_do_get_pad_format(struct ov08x40 *ov08x, > struct v4l2_subdev_format *fmt) > { > struct v4l2_mbus_framefmt *framefmt; > - struct v4l2_subdev *sd = &ov08x->sd; > > if (fmt->which == V4L2_SUBDEV_FORMAT_TRY) { > framefmt = v4l2_subdev_state_get_format(sd_state, fmt->pad); > diff --git b/drivers/media/i2c/ov13858.c a/drivers/media/i2c/ov13858.c > index 7816d9787c61..09387e335d80 100644 > --- b/drivers/media/i2c/ov13858.c > +++ a/drivers/media/i2c/ov13858.c > @@ -1316,7 +1316,6 @@ static int ov13858_do_get_pad_format(struct ov13858 *ov13858, > struct v4l2_subdev_format *fmt) > { > struct v4l2_mbus_framefmt *framefmt; > - struct v4l2_subdev *sd = &ov13858->sd; > > if (fmt->which == V4L2_SUBDEV_FORMAT_TRY) { > framefmt = v4l2_subdev_state_get_format(sd_state, fmt->pad); > diff --git b/drivers/media/i2c/ov13b10.c a/drivers/media/i2c/ov13b10.c > index 268cd4b03f9c..c06411d5ee2b 100644 > --- b/drivers/media/i2c/ov13b10.c > +++ a/drivers/media/i2c/ov13b10.c > @@ -1001,7 +1001,6 @@ static int ov13b10_do_get_pad_format(struct ov13b10 *ov13b, > struct v4l2_subdev_format *fmt) > { > struct v4l2_mbus_framefmt *framefmt; > - struct v4l2_subdev *sd = &ov13b->sd; > > if (fmt->which == V4L2_SUBDEV_FORMAT_TRY) { > framefmt = v4l2_subdev_state_get_format(sd_state, fmt->pad); > diff --git b/drivers/media/i2c/s5c73m3/s5c73m3-core.c a/drivers/media/i2c/s5c73m3/s5c73m3-core.c > index 47605e36bc60..8f9b5713daf7 100644 > --- b/drivers/media/i2c/s5c73m3/s5c73m3-core.c > +++ a/drivers/media/i2c/s5c73m3/s5c73m3-core.c > @@ -819,7 +819,6 @@ static void s5c73m3_oif_try_format(struct s5c73m3 *state, > struct v4l2_subdev_format *fmt, > const struct s5c73m3_frame_size **fs) > { > - struct v4l2_subdev *sd = &state->sensor_sd; > u32 code; > > switch (fmt->pad) { > diff --git a/drivers/media/i2c/s5k5baf.c b/drivers/media/i2c/s5k5baf.c > index 67da2045f543..03ccfb0e1e11 100644 > --- a/drivers/media/i2c/s5k5baf.c > +++ b/drivers/media/i2c/s5k5baf.c > @@ -1472,14 +1472,11 @@ static int s5k5baf_set_selection(struct v4l2_subdev *sd, > > if (sel->which == V4L2_SUBDEV_FORMAT_TRY) { > rects = (struct v4l2_rect * []) { > - &s5k5baf_cis_rect, > - v4l2_subdev_get_try_crop(sd, sd_state, > - PAD_CIS), > - v4l2_subdev_get_try_compose(sd, sd_state, > - PAD_CIS), > - v4l2_subdev_get_try_crop(sd, sd_state, > - PAD_OUT) > - }; > + &s5k5baf_cis_rect, > + v4l2_subdev_state_get_crop(sd_state, PAD_CIS), > + v4l2_subdev_state_get_compose(sd_state, PAD_CIS), > + v4l2_subdev_state_get_crop(sd_state, PAD_OUT) > + }; > s5k5baf_set_rect_and_adjust(rects, rtype, &sel->r); > return 0; > } > diff --git b/drivers/media/platform/samsung/s3c-camif/camif-capture.c a/drivers/media/platform/samsung/s3c-camif/camif-capture.c > index 295e083f38e8..be58260ea67e 100644 > --- b/drivers/media/platform/samsung/s3c-camif/camif-capture.c > +++ a/drivers/media/platform/samsung/s3c-camif/camif-capture.c > @@ -1216,7 +1216,7 @@ static int s3c_camif_subdev_get_fmt(struct v4l2_subdev *sd, > struct v4l2_mbus_framefmt *mf = &fmt->format; > > if (fmt->which == V4L2_SUBDEV_FORMAT_TRY) { > - mf = v4l2_subdev_get_try_format(sd, sd_state, fmt->pad); > + mf = v4l2_subdev_state_get_format(sd_state, fmt->pad); > fmt->format = *mf; > return 0; > } > @@ -1305,7 +1305,7 @@ static int s3c_camif_subdev_set_fmt(struct v4l2_subdev *sd, > __camif_subdev_try_format(camif, mf, fmt->pad); > > if (fmt->which == V4L2_SUBDEV_FORMAT_TRY) { > - mf = v4l2_subdev_get_try_format(sd, sd_state, fmt->pad); > + mf = v4l2_subdev_state_get_format(sd_state, fmt->pad); > *mf = fmt->format; > mutex_unlock(&camif->lock); > return 0; > diff --git b/drivers/media/platform/ti/cal/cal-camerarx.c a/drivers/media/platform/ti/cal/cal-camerarx.c > index cea454ed9c20..61433744c6c4 100644 > --- b/drivers/media/platform/ti/cal/cal-camerarx.c > +++ a/drivers/media/platform/ti/cal/cal-camerarx.c > @@ -621,8 +621,6 @@ static int cal_camerarx_sd_enum_mbus_code(struct v4l2_subdev *sd, > struct v4l2_subdev_state *state, > struct v4l2_subdev_mbus_code_enum *code) > { > - struct cal_camerarx *phy = to_cal_camerarx(sd); > - > /* No transcoding, source and sink codes must match. */ > if (cal_rx_pad_is_source(code->pad)) { > struct v4l2_mbus_framefmt *fmt; > diff --git b/drivers/staging/media/imx/imx-ic-prp.c a/drivers/staging/media/imx/imx-ic-prp.c > index dd558fac6477..61d69f19657e 100644 > --- b/drivers/staging/media/imx/imx-ic-prp.c > +++ a/drivers/staging/media/imx/imx-ic-prp.c > @@ -82,8 +82,6 @@ static struct v4l2_mbus_framefmt * > __prp_get_fmt(struct prp_priv *priv, struct v4l2_subdev_state *sd_state, > unsigned int pad, enum v4l2_subdev_format_whence which) > { > - struct imx_ic_priv *ic_priv = priv->ic_priv; > - > if (which == V4L2_SUBDEV_FORMAT_TRY) > return v4l2_subdev_state_get_format(sd_state, pad); > else > diff --git b/drivers/staging/media/imx/imx-ic-prpencvf.c a/drivers/staging/media/imx/imx-ic-prpencvf.c > index 02db7dbb884b..ec73c901079e 100644 > --- b/drivers/staging/media/imx/imx-ic-prpencvf.c > +++ a/drivers/staging/media/imx/imx-ic-prpencvf.c > @@ -790,8 +790,6 @@ static struct v4l2_mbus_framefmt * > __prp_get_fmt(struct prp_priv *priv, struct v4l2_subdev_state *sd_state, > unsigned int pad, enum v4l2_subdev_format_whence which) > { > - struct imx_ic_priv *ic_priv = priv->ic_priv; > - > if (which == V4L2_SUBDEV_FORMAT_TRY) > return v4l2_subdev_state_get_format(sd_state, pad); > else > diff --git a/drivers/media/i2c/st-mipid02.c b/drivers/media/i2c/st-mipid02.c > index 9c9361354c00..b08a249b5fdd 100644 > --- a/drivers/media/i2c/st-mipid02.c > +++ b/drivers/media/i2c/st-mipid02.c > @@ -751,7 +751,7 @@ static void mipid02_set_fmt_source(struct v4l2_subdev *sd, > format->format = bridge->fmt; > else > format->format = *v4l2_subdev_state_get_format(sd_state, > - MIPID02_SINK_0); > + MIPID02_SINK_0); > > /* but code may need to be converted */ > format->format.code = serial_to_parallel_code(format->format.code); > diff --git a/drivers/media/platform/rockchip/rkisp1/rkisp1-isp.c b/drivers/media/platform/rockchip/rkisp1/rkisp1-isp.c > index 117912d3bfbd..96353648c032 100644 > --- a/drivers/media/platform/rockchip/rkisp1/rkisp1-isp.c > +++ b/drivers/media/platform/rockchip/rkisp1/rkisp1-isp.c > @@ -319,7 +319,7 @@ static void rkisp1_isp_start(struct rkisp1_isp *isp, > rkisp1_write(rkisp1, RKISP1_CIF_ISP_CTRL, val); > > src_fmt = v4l2_subdev_state_get_format(sd_state, > - RKISP1_ISP_PAD_SOURCE_VIDEO); > + RKISP1_ISP_PAD_SOURCE_VIDEO); > src_info = rkisp1_mbus_info_get_by_code(src_fmt->code); > > if (src_info->pixel_enc != V4L2_PIXEL_ENC_BAYER) > @@ -475,9 +475,9 @@ static void rkisp1_isp_set_src_fmt(struct rkisp1_isp *isp, > sink_fmt = v4l2_subdev_state_get_format(sd_state, > RKISP1_ISP_PAD_SINK_VIDEO); > src_fmt = v4l2_subdev_state_get_format(sd_state, > - RKISP1_ISP_PAD_SOURCE_VIDEO); > + RKISP1_ISP_PAD_SOURCE_VIDEO); > src_crop = v4l2_subdev_state_get_crop(sd_state, > - RKISP1_ISP_PAD_SOURCE_VIDEO); > + RKISP1_ISP_PAD_SOURCE_VIDEO); > > /* > * Media bus code. The ISP can operate in pass-through mode (Bayer in, Signed-off-by: Sakari Ailus <sakari.ailus@linux.intel.com> Reviewed-by: Laurent Pinchart <laurent.pinchart@ideasonboard.com> Signed-off-by: Mauro Carvalho Chehab <mchehab@kernel.org>
384 lines
9.2 KiB
C
384 lines
9.2 KiB
C
// SPDX-License-Identifier: GPL-2.0-only
|
|
/*
|
|
* Samsung S5K6A3 image sensor driver
|
|
*
|
|
* Copyright (C) 2013 Samsung Electronics Co., Ltd.
|
|
* Author: Sylwester Nawrocki <s.nawrocki@samsung.com>
|
|
*/
|
|
|
|
#include <linux/clk.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/device.h>
|
|
#include <linux/err.h>
|
|
#include <linux/errno.h>
|
|
#include <linux/gpio/consumer.h>
|
|
#include <linux/i2c.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/module.h>
|
|
#include <linux/pm_runtime.h>
|
|
#include <linux/regulator/consumer.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/videodev2.h>
|
|
#include <media/v4l2-async.h>
|
|
#include <media/v4l2-subdev.h>
|
|
|
|
#define S5K6A3_SENSOR_MAX_WIDTH 1412
|
|
#define S5K6A3_SENSOR_MAX_HEIGHT 1412
|
|
#define S5K6A3_SENSOR_MIN_WIDTH 32
|
|
#define S5K6A3_SENSOR_MIN_HEIGHT 32
|
|
|
|
#define S5K6A3_DEFAULT_WIDTH 1296
|
|
#define S5K6A3_DEFAULT_HEIGHT 732
|
|
|
|
#define S5K6A3_DRV_NAME "S5K6A3"
|
|
#define S5K6A3_CLK_NAME "extclk"
|
|
#define S5K6A3_DEFAULT_CLK_FREQ 24000000U
|
|
|
|
enum {
|
|
S5K6A3_SUPP_VDDA,
|
|
S5K6A3_SUPP_VDDIO,
|
|
S5K6A3_SUPP_AFVDD,
|
|
S5K6A3_NUM_SUPPLIES,
|
|
};
|
|
|
|
/**
|
|
* struct s5k6a3 - fimc-is sensor data structure
|
|
* @dev: pointer to this I2C client device structure
|
|
* @subdev: the image sensor's v4l2 subdev
|
|
* @pad: subdev media source pad
|
|
* @supplies: image sensor's voltage regulator supplies
|
|
* @gpio_reset: GPIO connected to the sensor's reset pin
|
|
* @lock: mutex protecting the structure's members below
|
|
* @format: media bus format at the sensor's source pad
|
|
* @clock: pointer to &struct clk.
|
|
* @clock_frequency: clock frequency
|
|
* @power_count: stores state if device is powered
|
|
*/
|
|
struct s5k6a3 {
|
|
struct device *dev;
|
|
struct v4l2_subdev subdev;
|
|
struct media_pad pad;
|
|
struct regulator_bulk_data supplies[S5K6A3_NUM_SUPPLIES];
|
|
struct gpio_desc *gpio_reset;
|
|
struct mutex lock;
|
|
struct v4l2_mbus_framefmt format;
|
|
struct clk *clock;
|
|
u32 clock_frequency;
|
|
int power_count;
|
|
};
|
|
|
|
static const char * const s5k6a3_supply_names[] = {
|
|
[S5K6A3_SUPP_VDDA] = "svdda",
|
|
[S5K6A3_SUPP_VDDIO] = "svddio",
|
|
[S5K6A3_SUPP_AFVDD] = "afvdd",
|
|
};
|
|
|
|
static inline struct s5k6a3 *sd_to_s5k6a3(struct v4l2_subdev *sd)
|
|
{
|
|
return container_of(sd, struct s5k6a3, subdev);
|
|
}
|
|
|
|
static const struct v4l2_mbus_framefmt s5k6a3_formats[] = {
|
|
{
|
|
.code = MEDIA_BUS_FMT_SGRBG10_1X10,
|
|
.colorspace = V4L2_COLORSPACE_SRGB,
|
|
.field = V4L2_FIELD_NONE,
|
|
}
|
|
};
|
|
|
|
static const struct v4l2_mbus_framefmt *find_sensor_format(
|
|
struct v4l2_mbus_framefmt *mf)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < ARRAY_SIZE(s5k6a3_formats); i++)
|
|
if (mf->code == s5k6a3_formats[i].code)
|
|
return &s5k6a3_formats[i];
|
|
|
|
return &s5k6a3_formats[0];
|
|
}
|
|
|
|
static int s5k6a3_enum_mbus_code(struct v4l2_subdev *sd,
|
|
struct v4l2_subdev_state *sd_state,
|
|
struct v4l2_subdev_mbus_code_enum *code)
|
|
{
|
|
if (code->index >= ARRAY_SIZE(s5k6a3_formats))
|
|
return -EINVAL;
|
|
|
|
code->code = s5k6a3_formats[code->index].code;
|
|
return 0;
|
|
}
|
|
|
|
static void s5k6a3_try_format(struct v4l2_mbus_framefmt *mf)
|
|
{
|
|
const struct v4l2_mbus_framefmt *fmt;
|
|
|
|
fmt = find_sensor_format(mf);
|
|
mf->code = fmt->code;
|
|
mf->field = V4L2_FIELD_NONE;
|
|
v4l_bound_align_image(&mf->width, S5K6A3_SENSOR_MIN_WIDTH,
|
|
S5K6A3_SENSOR_MAX_WIDTH, 0,
|
|
&mf->height, S5K6A3_SENSOR_MIN_HEIGHT,
|
|
S5K6A3_SENSOR_MAX_HEIGHT, 0, 0);
|
|
}
|
|
|
|
static struct v4l2_mbus_framefmt *__s5k6a3_get_format(
|
|
struct s5k6a3 *sensor, struct v4l2_subdev_state *sd_state,
|
|
u32 pad, enum v4l2_subdev_format_whence which)
|
|
{
|
|
if (which == V4L2_SUBDEV_FORMAT_TRY)
|
|
return sd_state ? v4l2_subdev_state_get_format(sd_state, pad) : NULL;
|
|
|
|
return &sensor->format;
|
|
}
|
|
|
|
static int s5k6a3_set_fmt(struct v4l2_subdev *sd,
|
|
struct v4l2_subdev_state *sd_state,
|
|
struct v4l2_subdev_format *fmt)
|
|
{
|
|
struct s5k6a3 *sensor = sd_to_s5k6a3(sd);
|
|
struct v4l2_mbus_framefmt *mf;
|
|
|
|
s5k6a3_try_format(&fmt->format);
|
|
|
|
mf = __s5k6a3_get_format(sensor, sd_state, fmt->pad, fmt->which);
|
|
if (mf) {
|
|
mutex_lock(&sensor->lock);
|
|
*mf = fmt->format;
|
|
mutex_unlock(&sensor->lock);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static int s5k6a3_get_fmt(struct v4l2_subdev *sd,
|
|
struct v4l2_subdev_state *sd_state,
|
|
struct v4l2_subdev_format *fmt)
|
|
{
|
|
struct s5k6a3 *sensor = sd_to_s5k6a3(sd);
|
|
struct v4l2_mbus_framefmt *mf;
|
|
|
|
mf = __s5k6a3_get_format(sensor, sd_state, fmt->pad, fmt->which);
|
|
|
|
mutex_lock(&sensor->lock);
|
|
fmt->format = *mf;
|
|
mutex_unlock(&sensor->lock);
|
|
return 0;
|
|
}
|
|
|
|
static const struct v4l2_subdev_pad_ops s5k6a3_pad_ops = {
|
|
.enum_mbus_code = s5k6a3_enum_mbus_code,
|
|
.get_fmt = s5k6a3_get_fmt,
|
|
.set_fmt = s5k6a3_set_fmt,
|
|
};
|
|
|
|
static int s5k6a3_open(struct v4l2_subdev *sd, struct v4l2_subdev_fh *fh)
|
|
{
|
|
struct v4l2_mbus_framefmt *format = v4l2_subdev_state_get_format(fh->state,
|
|
0);
|
|
|
|
*format = s5k6a3_formats[0];
|
|
format->width = S5K6A3_DEFAULT_WIDTH;
|
|
format->height = S5K6A3_DEFAULT_HEIGHT;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct v4l2_subdev_internal_ops s5k6a3_sd_internal_ops = {
|
|
.open = s5k6a3_open,
|
|
};
|
|
|
|
static int __s5k6a3_power_on(struct s5k6a3 *sensor)
|
|
{
|
|
int i = S5K6A3_SUPP_VDDA;
|
|
int ret;
|
|
|
|
ret = clk_set_rate(sensor->clock, sensor->clock_frequency);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
ret = pm_runtime_get(sensor->dev);
|
|
if (ret < 0)
|
|
goto error_rpm_put;
|
|
|
|
ret = regulator_enable(sensor->supplies[i].consumer);
|
|
if (ret < 0)
|
|
goto error_rpm_put;
|
|
|
|
ret = clk_prepare_enable(sensor->clock);
|
|
if (ret < 0)
|
|
goto error_reg_dis;
|
|
|
|
for (i++; i < S5K6A3_NUM_SUPPLIES; i++) {
|
|
ret = regulator_enable(sensor->supplies[i].consumer);
|
|
if (ret < 0)
|
|
goto error_clk;
|
|
}
|
|
|
|
gpiod_set_value_cansleep(sensor->gpio_reset, 0);
|
|
usleep_range(600, 800);
|
|
gpiod_set_value_cansleep(sensor->gpio_reset, 1);
|
|
usleep_range(600, 800);
|
|
gpiod_set_value_cansleep(sensor->gpio_reset, 0);
|
|
|
|
/* Delay needed for the sensor initialization */
|
|
msleep(20);
|
|
return 0;
|
|
|
|
error_clk:
|
|
clk_disable_unprepare(sensor->clock);
|
|
error_reg_dis:
|
|
for (--i; i >= 0; --i)
|
|
regulator_disable(sensor->supplies[i].consumer);
|
|
error_rpm_put:
|
|
pm_runtime_put(sensor->dev);
|
|
return ret;
|
|
}
|
|
|
|
static int __s5k6a3_power_off(struct s5k6a3 *sensor)
|
|
{
|
|
int i;
|
|
|
|
gpiod_set_value_cansleep(sensor->gpio_reset, 1);
|
|
|
|
for (i = S5K6A3_NUM_SUPPLIES - 1; i >= 0; i--)
|
|
regulator_disable(sensor->supplies[i].consumer);
|
|
|
|
clk_disable_unprepare(sensor->clock);
|
|
pm_runtime_put(sensor->dev);
|
|
return 0;
|
|
}
|
|
|
|
static int s5k6a3_s_power(struct v4l2_subdev *sd, int on)
|
|
{
|
|
struct s5k6a3 *sensor = sd_to_s5k6a3(sd);
|
|
int ret = 0;
|
|
|
|
mutex_lock(&sensor->lock);
|
|
|
|
if (sensor->power_count == !on) {
|
|
if (on)
|
|
ret = __s5k6a3_power_on(sensor);
|
|
else
|
|
ret = __s5k6a3_power_off(sensor);
|
|
|
|
if (ret == 0)
|
|
sensor->power_count += on ? 1 : -1;
|
|
}
|
|
|
|
mutex_unlock(&sensor->lock);
|
|
return ret;
|
|
}
|
|
|
|
static const struct v4l2_subdev_core_ops s5k6a3_core_ops = {
|
|
.s_power = s5k6a3_s_power,
|
|
};
|
|
|
|
static const struct v4l2_subdev_ops s5k6a3_subdev_ops = {
|
|
.core = &s5k6a3_core_ops,
|
|
.pad = &s5k6a3_pad_ops,
|
|
};
|
|
|
|
static int s5k6a3_probe(struct i2c_client *client)
|
|
{
|
|
struct device *dev = &client->dev;
|
|
struct s5k6a3 *sensor;
|
|
struct v4l2_subdev *sd;
|
|
int i, ret;
|
|
|
|
sensor = devm_kzalloc(dev, sizeof(*sensor), GFP_KERNEL);
|
|
if (!sensor)
|
|
return -ENOMEM;
|
|
|
|
mutex_init(&sensor->lock);
|
|
sensor->dev = dev;
|
|
|
|
sensor->clock = devm_clk_get(sensor->dev, S5K6A3_CLK_NAME);
|
|
if (IS_ERR(sensor->clock))
|
|
return PTR_ERR(sensor->clock);
|
|
|
|
sensor->gpio_reset = devm_gpiod_get(dev, NULL, GPIOD_OUT_HIGH);
|
|
ret = PTR_ERR_OR_ZERO(sensor->gpio_reset);
|
|
if (ret)
|
|
return ret;
|
|
|
|
if (of_property_read_u32(dev->of_node, "clock-frequency",
|
|
&sensor->clock_frequency)) {
|
|
sensor->clock_frequency = S5K6A3_DEFAULT_CLK_FREQ;
|
|
dev_info(dev, "using default %u Hz clock frequency\n",
|
|
sensor->clock_frequency);
|
|
}
|
|
|
|
for (i = 0; i < S5K6A3_NUM_SUPPLIES; i++)
|
|
sensor->supplies[i].supply = s5k6a3_supply_names[i];
|
|
|
|
ret = devm_regulator_bulk_get(&client->dev, S5K6A3_NUM_SUPPLIES,
|
|
sensor->supplies);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
sd = &sensor->subdev;
|
|
v4l2_i2c_subdev_init(sd, client, &s5k6a3_subdev_ops);
|
|
sensor->subdev.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;
|
|
sd->internal_ops = &s5k6a3_sd_internal_ops;
|
|
|
|
sensor->format.code = s5k6a3_formats[0].code;
|
|
sensor->format.width = S5K6A3_DEFAULT_WIDTH;
|
|
sensor->format.height = S5K6A3_DEFAULT_HEIGHT;
|
|
|
|
sd->entity.function = MEDIA_ENT_F_CAM_SENSOR;
|
|
sensor->pad.flags = MEDIA_PAD_FL_SOURCE;
|
|
ret = media_entity_pads_init(&sd->entity, 1, &sensor->pad);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
pm_runtime_no_callbacks(dev);
|
|
pm_runtime_enable(dev);
|
|
|
|
ret = v4l2_async_register_subdev(sd);
|
|
|
|
if (ret < 0) {
|
|
pm_runtime_disable(&client->dev);
|
|
media_entity_cleanup(&sd->entity);
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
static void s5k6a3_remove(struct i2c_client *client)
|
|
{
|
|
struct v4l2_subdev *sd = i2c_get_clientdata(client);
|
|
|
|
pm_runtime_disable(&client->dev);
|
|
v4l2_async_unregister_subdev(sd);
|
|
media_entity_cleanup(&sd->entity);
|
|
}
|
|
|
|
static const struct i2c_device_id s5k6a3_ids[] = {
|
|
{ }
|
|
};
|
|
MODULE_DEVICE_TABLE(i2c, s5k6a3_ids);
|
|
|
|
#ifdef CONFIG_OF
|
|
static const struct of_device_id s5k6a3_of_match[] = {
|
|
{ .compatible = "samsung,s5k6a3" },
|
|
{ /* sentinel */ }
|
|
};
|
|
MODULE_DEVICE_TABLE(of, s5k6a3_of_match);
|
|
#endif
|
|
|
|
static struct i2c_driver s5k6a3_driver = {
|
|
.driver = {
|
|
.of_match_table = of_match_ptr(s5k6a3_of_match),
|
|
.name = S5K6A3_DRV_NAME,
|
|
},
|
|
.probe = s5k6a3_probe,
|
|
.remove = s5k6a3_remove,
|
|
.id_table = s5k6a3_ids,
|
|
};
|
|
|
|
module_i2c_driver(s5k6a3_driver);
|
|
|
|
MODULE_DESCRIPTION("S5K6A3 image sensor subdev driver");
|
|
MODULE_AUTHOR("Sylwester Nawrocki <s.nawrocki@samsung.com>");
|
|
MODULE_LICENSE("GPL v2");
|