diff options
Diffstat (limited to 'drivers/media/i2c')
-rw-r--r-- | drivers/media/i2c/Kconfig | 8 | ||||
-rw-r--r-- | drivers/media/i2c/Makefile | 1 | ||||
-rw-r--r-- | drivers/media/i2c/s5k8b1.c | 369 |
3 files changed, 378 insertions, 0 deletions
diff --git a/drivers/media/i2c/Kconfig b/drivers/media/i2c/Kconfig index 6e3f1d03ae3..66ee7ab60c1 100644 --- a/drivers/media/i2c/Kconfig +++ b/drivers/media/i2c/Kconfig @@ -601,6 +601,14 @@ config VIDEO_S5K5BAF This is a V4L2 sensor-level driver for Samsung S5K5BAF 2M camera sensor with an embedded SoC image signal processor. +config VIDEO_S5K8B1 + tristate "Samsung S5K8B1 sensor support" + depends on MEDIA_CAMERA_SUPPORT + depends on I2C && VIDEO_V4L2 && VIDEO_V4L2_SUBDEV_API && OF + ---help--- + This is a V4L2 sensor-level driver for Samsung S5K8B1 raw + camera sensor. + source "drivers/media/i2c/smiapp/Kconfig" config VIDEO_S5C73M3 diff --git a/drivers/media/i2c/Makefile b/drivers/media/i2c/Makefile index 01ae9328e58..06914b838ed 100644 --- a/drivers/media/i2c/Makefile +++ b/drivers/media/i2c/Makefile @@ -69,6 +69,7 @@ obj-$(CONFIG_VIDEO_S5K6AA) += s5k6aa.o obj-$(CONFIG_VIDEO_S5K6A3) += s5k6a3.o obj-$(CONFIG_VIDEO_S5K4ECGX) += s5k4ecgx.o obj-$(CONFIG_VIDEO_S5K5BAF) += s5k5baf.o +obj-$(CONFIG_VIDEO_S5K8B1) += s5k8b1.o obj-$(CONFIG_VIDEO_S5C73M3) += s5c73m3/ obj-$(CONFIG_VIDEO_ADP1653) += adp1653.o obj-$(CONFIG_VIDEO_AS3645A) += as3645a.o diff --git a/drivers/media/i2c/s5k8b1.c b/drivers/media/i2c/s5k8b1.c new file mode 100644 index 00000000000..3076de5ae7a --- /dev/null +++ b/drivers/media/i2c/s5k8b1.c @@ -0,0 +1,369 @@ +/* + * Samsung S5K8B1 image sensor driver + * + * Copyright (C) 2014 Samsung Electronics Co., Ltd. + * Author: Sylwester Nawrocki <s.nawrocki@samsung.com> + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License version 2 as + * published by the Free Software Foundation. + */ + +#include <linux/clk.h> +#include <linux/delay.h> +#include <linux/device.h> +#include <linux/errno.h> +#include <linux/gpio.h> +#include <linux/i2c.h> +#include <linux/kernel.h> +#include <linux/module.h> +#include <linux/of_gpio.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 S5K8B1_SENSOR_MAX_WIDTH 1936 +#define S5K8B1_SENSOR_MAX_HEIGHT 1096 +#define S5K8B1_SENSOR_MIN_WIDTH 32 +#define S5K8B1_SENSOR_MIN_HEIGHT 32 + +#define S5K8B1_DEFAULT_WIDTH 1296 +#define S5K8B1_DEFAULT_HEIGHT 732 + +#define S5K8B1_DRV_NAME "S5K8B1" +#define S5K8B1_CLK_NAME "extclk" +#define S5K8B1_DEFAULT_CLK_FREQ 24000000U + +enum { + S5K8B1_SUPP_VDDA, + S5K8B1_SUPP_VDDIO, + S5K8B1_SUPP_VDDD, + S5K8B1_NUM_SUPPLIES, +}; + +/** + * struct s5k8b1 - 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 + */ +struct s5k8b1 { + struct device *dev; + struct v4l2_subdev subdev; + struct media_pad pad; + struct regulator_bulk_data supplies[S5K8B1_NUM_SUPPLIES]; + int gpio_reset; + struct mutex lock; + struct v4l2_mbus_framefmt format; + struct clk *clock; + u32 clock_frequency; +}; + +static const char * const s5k8b1_supply_names[] = { + [S5K8B1_SUPP_VDDA] = "vdda", + [S5K8B1_SUPP_VDDIO] = "vddio", + [S5K8B1_SUPP_VDDD] = "vddd", +}; + +static inline struct s5k8b1 *sd_to_s5k8b1(struct v4l2_subdev *sd) +{ + return container_of(sd, struct s5k8b1, subdev); +} + +static const struct v4l2_mbus_framefmt s5k8b1_formats[] = { + { + .code = V4L2_MBUS_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(s5k8b1_formats); i++) + if (mf->code == s5k8b1_formats[i].code) + return &s5k8b1_formats[i]; + + return &s5k8b1_formats[0]; +} + +static int s5k8b1_enum_mbus_code(struct v4l2_subdev *sd, + struct v4l2_subdev_fh *fh, + struct v4l2_subdev_mbus_code_enum *code) +{ + if (code->index >= ARRAY_SIZE(s5k8b1_formats)) + return -EINVAL; + + code->code = s5k8b1_formats[code->index].code; + return 0; +} + +static void s5k8b1_try_format(struct v4l2_mbus_framefmt *mf) +{ + const struct v4l2_mbus_framefmt *fmt; + + fmt = find_sensor_format(mf); + mf->code = fmt->code; + v4l_bound_align_image(&mf->width, S5K8B1_SENSOR_MIN_WIDTH, + S5K8B1_SENSOR_MAX_WIDTH, 0, + &mf->height, S5K8B1_SENSOR_MIN_HEIGHT, + S5K8B1_SENSOR_MAX_HEIGHT, 0, 0); +} + +static struct v4l2_mbus_framefmt *__s5k8b1_get_format( + struct s5k8b1 *sensor, struct v4l2_subdev_fh *fh, + u32 pad, enum v4l2_subdev_format_whence which) +{ + if (which == V4L2_SUBDEV_FORMAT_TRY) + return fh ? v4l2_subdev_get_try_format(fh, pad) : NULL; + + return &sensor->format; +} + +static int s5k8b1_set_fmt(struct v4l2_subdev *sd, + struct v4l2_subdev_fh *fh, + struct v4l2_subdev_format *fmt) +{ + struct s5k8b1 *sensor = sd_to_s5k8b1(sd); + struct v4l2_mbus_framefmt *mf; + + s5k8b1_try_format(&fmt->format); + + mf = __s5k8b1_get_format(sensor, fh, fmt->pad, fmt->which); + if (mf) { + mutex_lock(&sensor->lock); + if (fmt->which == V4L2_SUBDEV_FORMAT_ACTIVE) + *mf = fmt->format; + mutex_unlock(&sensor->lock); + } + return 0; +} + +static int s5k8b1_get_fmt(struct v4l2_subdev *sd, + struct v4l2_subdev_fh *fh, + struct v4l2_subdev_format *fmt) +{ + struct s5k8b1 *sensor = sd_to_s5k8b1(sd); + struct v4l2_mbus_framefmt *mf; + + mf = __s5k8b1_get_format(sensor, fh, fmt->pad, fmt->which); + + mutex_lock(&sensor->lock); + fmt->format = *mf; + mutex_unlock(&sensor->lock); + return 0; +} + +static struct v4l2_subdev_pad_ops s5k8b1_pad_ops = { + .enum_mbus_code = s5k8b1_enum_mbus_code, + .get_fmt = s5k8b1_get_fmt, + .set_fmt = s5k8b1_set_fmt, +}; + +static int s5k8b1_open(struct v4l2_subdev *sd, struct v4l2_subdev_fh *fh) +{ + struct v4l2_mbus_framefmt *format = v4l2_subdev_get_try_format(fh, 0); + + *format = s5k8b1_formats[0]; + format->width = S5K8B1_DEFAULT_WIDTH; + format->height = S5K8B1_DEFAULT_HEIGHT; + + return 0; +} + +static const struct v4l2_subdev_internal_ops s5k8b1_sd_internal_ops = { + .open = s5k8b1_open, +}; + +static int __s5k8b1_power_on(struct s5k8b1 *sensor) +{ + 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) + return ret; + + ret = clk_prepare_enable(sensor->clock); + if (ret < 0) + goto error_rpm_put; + + ret = regulator_bulk_enable(ARRAY_SIZE(sensor->supplies), + sensor->supplies); + if (ret < 0) + goto error_clk_dis; + + gpio_set_value(sensor->gpio_reset, 1); + usleep_range(600, 800); + gpio_set_value(sensor->gpio_reset, 0); + usleep_range(600, 800); + gpio_set_value(sensor->gpio_reset, 1); + + usleep_range(20000, 20500); + return 0; + +error_clk_dis: + clk_disable_unprepare(sensor->clock); +error_rpm_put: + pm_runtime_put(sensor->dev); + return ret; +} + +static int __s5k8b1_power_off(struct s5k8b1 *sensor) +{ + int i; + + gpio_set_value(sensor->gpio_reset, 0); + + for (i = S5K8B1_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 s5k8b1_s_power(struct v4l2_subdev *sd, int on) +{ + struct s5k8b1 *sensor = sd_to_s5k8b1(sd); + + if (on) + return __s5k8b1_power_on(sensor); + else + return __s5k8b1_power_off(sensor); +} + +static struct v4l2_subdev_core_ops s5k8b1_core_ops = { + .s_power = s5k8b1_s_power, +}; + +static struct v4l2_subdev_ops s5k8b1_subdev_ops = { + .core = &s5k8b1_core_ops, + .pad = &s5k8b1_pad_ops, +}; + +static int s5k8b1_probe(struct i2c_client *client, + const struct i2c_device_id *id) +{ + struct device *dev = &client->dev; + struct s5k8b1 *sensor; + struct v4l2_subdev *sd; + int gpio, i, ret; + + sensor = devm_kzalloc(dev, sizeof(*sensor), GFP_KERNEL); + if (!sensor) + return -ENOMEM; + + mutex_init(&sensor->lock); + sensor->gpio_reset = -EINVAL; + sensor->clock = ERR_PTR(-EINVAL); + sensor->dev = dev; + + gpio = of_get_named_gpio_flags(dev->of_node, "xshutdown-gpios", + 0, NULL); + if (!gpio_is_valid(gpio)) + return gpio; + + ret = devm_gpio_request_one(dev, gpio, GPIOF_OUT_INIT_LOW, + S5K8B1_DRV_NAME); + if (ret < 0) + return ret; + + sensor->gpio_reset = gpio; + + if (of_property_read_u32(dev->of_node, "clock-frequency", + &sensor->clock_frequency)) { + sensor->clock_frequency = S5K8B1_DEFAULT_CLK_FREQ; + dev_info(dev, "using default %u Hz clock frequency\n", + sensor->clock_frequency); + } + + for (i = 0; i < S5K8B1_NUM_SUPPLIES; i++) + sensor->supplies[i].supply = s5k8b1_supply_names[i]; + + ret = devm_regulator_bulk_get(&client->dev, S5K8B1_NUM_SUPPLIES, + sensor->supplies); + if (ret < 0) + return ret; + + sensor->clock = devm_clk_get(dev, S5K8B1_CLK_NAME); + if (IS_ERR(sensor->clock)) + return -EPROBE_DEFER; + + sd = &sensor->subdev; + v4l2_i2c_subdev_init(sd, client, &s5k8b1_subdev_ops); + sensor->subdev.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE; + + sensor->format.code = s5k8b1_formats[0].code; + sensor->format.width = S5K8B1_DEFAULT_WIDTH; + sensor->format.height = S5K8B1_DEFAULT_HEIGHT; + + sensor->pad.flags = MEDIA_PAD_FL_SOURCE; + ret = media_entity_init(&sd->entity, 1, &sensor->pad, 0); + 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 int s5k8b1_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); + return 0; +} + +static const struct i2c_device_id s5k8b1_ids[] = { + { } +}; + +#ifdef CONFIG_OF +static const struct of_device_id s5k8b1_of_match[] = { + { .compatible = "samsung,s5k8b1" }, + { /* sentinel */ } +}; +MODULE_DEVICE_TABLE(of, s5k8b1_of_match); +#endif + +static struct i2c_driver s5k8b1_driver = { + .driver = { + .of_match_table = of_match_ptr(s5k8b1_of_match), + .name = S5K8B1_DRV_NAME, + .owner = THIS_MODULE, + }, + .probe = s5k8b1_probe, + .remove = s5k8b1_remove, + .id_table = s5k8b1_ids, +}; + +module_i2c_driver(s5k8b1_driver); + +MODULE_DESCRIPTION("S5K8B1 image sensor subdev driver"); +MODULE_AUTHOR("Sylwester Nawrocki <s.nawrocki@samsung.com>"); +MODULE_LICENSE("GPL v2"); |