drivers/media/i2c/s5k6a3.c

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  * Samsung S5K6A3 image sensor driver
   4  *
   5  * Copyright (C) 2013 Samsung Electronics Co., Ltd.
   6  * Author: Sylwester Nawrocki <s.nawrocki@samsung.com>
   7  */
   8
   9 #include <linux/clk.h>
  10 #include <linux/delay.h>
  11 #include <linux/device.h>
  12 #include <linux/errno.h>
  13 #include <linux/gpio.h>
  14 #include <linux/i2c.h>
  15 #include <linux/kernel.h>
  16 #include <linux/module.h>
  17 #include <linux/of_gpio.h>
  18 #include <linux/pm_runtime.h>
  19 #include <linux/regulator/consumer.h>
  20 #include <linux/slab.h>
  21 #include <linux/videodev2.h>
  22 #include <media/v4l2-async.h>
  23 #include <media/v4l2-subdev.h>
  24
  25 #define S5K6A3_SENSOR_MAX_WIDTH         1412
  26 #define S5K6A3_SENSOR_MAX_HEIGHT        1412
  27 #define S5K6A3_SENSOR_MIN_WIDTH         32
  28 #define S5K6A3_SENSOR_MIN_HEIGHT        32
  29
  30 #define S5K6A3_DEFAULT_WIDTH            1296
  31 #define S5K6A3_DEFAULT_HEIGHT           732
  32
  33 #define S5K6A3_DRV_NAME                 "S5K6A3"
  34 #define S5K6A3_CLK_NAME                 "extclk"
  35 #define S5K6A3_DEFAULT_CLK_FREQ         24000000U
  36
  37 enum {
  38         S5K6A3_SUPP_VDDA,
  39         S5K6A3_SUPP_VDDIO,
  40         S5K6A3_SUPP_AFVDD,
  41         S5K6A3_NUM_SUPPLIES,
  42 };
  43
  44 /**
  45  * struct s5k6a3 - fimc-is sensor data structure
  46  * @dev: pointer to this I2C client device structure
  47  * @subdev: the image sensor's v4l2 subdev
  48  * @pad: subdev media source pad
  49  * @supplies: image sensor's voltage regulator supplies
  50  * @gpio_reset: GPIO connected to the sensor's reset pin
  51  * @lock: mutex protecting the structure's members below
  52  * @format: media bus format at the sensor's source pad
  53  * @clock: pointer to &struct clk.
  54  * @clock_frequency: clock frequency
  55  * @power_count: stores state if device is powered
  56  */
  57 struct s5k6a3 {
  58         struct device *dev;
  59         struct v4l2_subdev subdev;
  60         struct media_pad pad;
  61         struct regulator_bulk_data supplies[S5K6A3_NUM_SUPPLIES];
  62         int gpio_reset;
  63         struct mutex lock;
  64         struct v4l2_mbus_framefmt format;
  65         struct clk *clock;
  66         u32 clock_frequency;
  67         int power_count;
  68 };
  69
  70 static const char * const s5k6a3_supply_names[] = {
  71         [S5K6A3_SUPP_VDDA]      = "svdda",
  72         [S5K6A3_SUPP_VDDIO]     = "svddio",
  73         [S5K6A3_SUPP_AFVDD]     = "afvdd",
  74 };
  75
  76 static inline struct s5k6a3 *sd_to_s5k6a3(struct v4l2_subdev *sd)
  77 {
  78         return container_of(sd, struct s5k6a3, subdev);
  79 }
  80
  81 static const struct v4l2_mbus_framefmt s5k6a3_formats[] = {
  82         {
  83                 .code = MEDIA_BUS_FMT_SGRBG10_1X10,
  84                 .colorspace = V4L2_COLORSPACE_SRGB,
  85                 .field = V4L2_FIELD_NONE,
  86         }
  87 };
  88
  89 static const struct v4l2_mbus_framefmt *find_sensor_format(
  90         struct v4l2_mbus_framefmt *mf)
  91 {
  92         int i;
  93
  94         for (i = 0; i < ARRAY_SIZE(s5k6a3_formats); i++)
  95                 if (mf->code == s5k6a3_formats[i].code)
  96                         return &s5k6a3_formats[i];
  97
  98         return &s5k6a3_formats[0];
  99 }
 100
 101 static int s5k6a3_enum_mbus_code(struct v4l2_subdev *sd,
 102                                   struct v4l2_subdev_state *sd_state,
 103                                   struct v4l2_subdev_mbus_code_enum *code)
 104 {
 105         if (code->index >= ARRAY_SIZE(s5k6a3_formats))
 106                 return -EINVAL;
 107
 108         code->code = s5k6a3_formats[code->index].code;
 109         return 0;
 110 }
 111
 112 static void s5k6a3_try_format(struct v4l2_mbus_framefmt *mf)
 113 {
 114         const struct v4l2_mbus_framefmt *fmt;
 115
 116         fmt = find_sensor_format(mf);
 117         mf->code = fmt->code;
 118         mf->field = V4L2_FIELD_NONE;
 119         v4l_bound_align_image(&mf->width, S5K6A3_SENSOR_MIN_WIDTH,
 120                               S5K6A3_SENSOR_MAX_WIDTH, 0,
 121                               &mf->height, S5K6A3_SENSOR_MIN_HEIGHT,
 122                               S5K6A3_SENSOR_MAX_HEIGHT, 0, 0);
 123 }
 124
 125 static struct v4l2_mbus_framefmt *__s5k6a3_get_format(
 126                 struct s5k6a3 *sensor, struct v4l2_subdev_state *sd_state,
 127                 u32 pad, enum v4l2_subdev_format_whence which)
 128 {
 129         if (which == V4L2_SUBDEV_FORMAT_TRY)
 130                 return sd_state ? v4l2_subdev_get_try_format(&sensor->subdev,
 131                                                              sd_state, pad) : NULL;
 132
 133         return &sensor->format;
 134 }
 135
 136 static int s5k6a3_set_fmt(struct v4l2_subdev *sd,
 137                                   struct v4l2_subdev_state *sd_state,
 138                                   struct v4l2_subdev_format *fmt)
 139 {
 140         struct s5k6a3 *sensor = sd_to_s5k6a3(sd);
 141         struct v4l2_mbus_framefmt *mf;
 142
 143         s5k6a3_try_format(&fmt->format);
 144
 145         mf = __s5k6a3_get_format(sensor, sd_state, fmt->pad, fmt->which);
 146         if (mf) {
 147                 mutex_lock(&sensor->lock);
 148                 *mf = fmt->format;
 149                 mutex_unlock(&sensor->lock);
 150         }
 151         return 0;
 152 }
 153
 154 static int s5k6a3_get_fmt(struct v4l2_subdev *sd,
 155                           struct v4l2_subdev_state *sd_state,
 156                           struct v4l2_subdev_format *fmt)
 157 {
 158         struct s5k6a3 *sensor = sd_to_s5k6a3(sd);
 159         struct v4l2_mbus_framefmt *mf;
 160
 161         mf = __s5k6a3_get_format(sensor, sd_state, fmt->pad, fmt->which);
 162
 163         mutex_lock(&sensor->lock);
 164         fmt->format = *mf;
 165         mutex_unlock(&sensor->lock);
 166         return 0;
 167 }
 168
 169 static const struct v4l2_subdev_pad_ops s5k6a3_pad_ops = {
 170         .enum_mbus_code = s5k6a3_enum_mbus_code,
 171         .get_fmt        = s5k6a3_get_fmt,
 172         .set_fmt        = s5k6a3_set_fmt,
 173 };
 174
 175 static int s5k6a3_open(struct v4l2_subdev *sd, struct v4l2_subdev_fh *fh)
 176 {
 177         struct v4l2_mbus_framefmt *format = v4l2_subdev_get_try_format(sd,
 178                                                                        fh->state,
 179                                                                        0);
 180
 181         *format         = s5k6a3_formats[0];
 182         format->width   = S5K6A3_DEFAULT_WIDTH;
 183         format->height  = S5K6A3_DEFAULT_HEIGHT;
 184
 185         return 0;
 186 }
 187
 188 static const struct v4l2_subdev_internal_ops s5k6a3_sd_internal_ops = {
 189         .open = s5k6a3_open,
 190 };
 191
 192 static int __s5k6a3_power_on(struct s5k6a3 *sensor)
 193 {
 194         int i = S5K6A3_SUPP_VDDA;
 195         int ret;
 196
 197         ret = clk_set_rate(sensor->clock, sensor->clock_frequency);
 198         if (ret < 0)
 199                 return ret;
 200
 201         ret = pm_runtime_get(sensor->dev);
 202         if (ret < 0)
 203                 goto error_rpm_put;
 204
 205         ret = regulator_enable(sensor->supplies[i].consumer);
 206         if (ret < 0)
 207                 goto error_rpm_put;
 208
 209         ret = clk_prepare_enable(sensor->clock);
 210         if (ret < 0)
 211                 goto error_reg_dis;
 212
 213         for (i++; i < S5K6A3_NUM_SUPPLIES; i++) {
 214                 ret = regulator_enable(sensor->supplies[i].consumer);
 215                 if (ret < 0)
 216                         goto error_reg_dis;
 217         }
 218
 219         gpio_set_value(sensor->gpio_reset, 1);
 220         usleep_range(600, 800);
 221         gpio_set_value(sensor->gpio_reset, 0);
 222         usleep_range(600, 800);
 223         gpio_set_value(sensor->gpio_reset, 1);
 224
 225         /* Delay needed for the sensor initialization */
 226         msleep(20);
 227         return 0;
 228
 229 error_reg_dis:
 230         for (--i; i >= 0; --i)
 231                 regulator_disable(sensor->supplies[i].consumer);
 232 error_rpm_put:
 233         pm_runtime_put(sensor->dev);
 234         return ret;
 235 }
 236
 237 static int __s5k6a3_power_off(struct s5k6a3 *sensor)
 238 {
 239         int i;
 240
 241         gpio_set_value(sensor->gpio_reset, 0);
 242
 243         for (i = S5K6A3_NUM_SUPPLIES - 1; i >= 0; i--)
 244                 regulator_disable(sensor->supplies[i].consumer);
 245
 246         clk_disable_unprepare(sensor->clock);
 247         pm_runtime_put(sensor->dev);
 248         return 0;
 249 }
 250
 251 static int s5k6a3_s_power(struct v4l2_subdev *sd, int on)
 252 {
 253         struct s5k6a3 *sensor = sd_to_s5k6a3(sd);
 254         int ret = 0;
 255
 256         mutex_lock(&sensor->lock);
 257
 258         if (sensor->power_count == !on) {
 259                 if (on)
 260                         ret = __s5k6a3_power_on(sensor);
 261                 else
 262                         ret = __s5k6a3_power_off(sensor);
 263
 264                 if (ret == 0)
 265                         sensor->power_count += on ? 1 : -1;
 266         }
 267
 268         mutex_unlock(&sensor->lock);
 269         return ret;
 270 }
 271
 272 static const struct v4l2_subdev_core_ops s5k6a3_core_ops = {
 273         .s_power = s5k6a3_s_power,
 274 };
 275
 276 static const struct v4l2_subdev_ops s5k6a3_subdev_ops = {
 277         .core = &s5k6a3_core_ops,
 278         .pad = &s5k6a3_pad_ops,
 279 };
 280
 281 static int s5k6a3_probe(struct i2c_client *client)
 282 {
 283         struct device *dev = &client->dev;
 284         struct s5k6a3 *sensor;
 285         struct v4l2_subdev *sd;
 286         int gpio, i, ret;
 287
 288         sensor = devm_kzalloc(dev, sizeof(*sensor), GFP_KERNEL);
 289         if (!sensor)
 290                 return -ENOMEM;
 291
 292         mutex_init(&sensor->lock);
 293         sensor->gpio_reset = -EINVAL;
 294         sensor->clock = ERR_PTR(-EINVAL);
 295         sensor->dev = dev;
 296
 297         sensor->clock = devm_clk_get(sensor->dev, S5K6A3_CLK_NAME);
 298         if (IS_ERR(sensor->clock))
 299                 return PTR_ERR(sensor->clock);
 300
 301         gpio = of_get_gpio_flags(dev->of_node, 0, NULL);
 302         if (!gpio_is_valid(gpio))
 303                 return gpio;
 304
 305         ret = devm_gpio_request_one(dev, gpio, GPIOF_OUT_INIT_LOW,
 306                                                 S5K6A3_DRV_NAME);
 307         if (ret < 0)
 308                 return ret;
 309
 310         sensor->gpio_reset = gpio;
 311
 312         if (of_property_read_u32(dev->of_node, "clock-frequency",
 313                                  &sensor->clock_frequency)) {
 314                 sensor->clock_frequency = S5K6A3_DEFAULT_CLK_FREQ;
 315                 dev_info(dev, "using default %u Hz clock frequency\n",
 316                                         sensor->clock_frequency);
 317         }
 318
 319         for (i = 0; i < S5K6A3_NUM_SUPPLIES; i++)
 320                 sensor->supplies[i].supply = s5k6a3_supply_names[i];
 321
 322         ret = devm_regulator_bulk_get(&client->dev, S5K6A3_NUM_SUPPLIES,
 323                                       sensor->supplies);
 324         if (ret < 0)
 325                 return ret;
 326
 327         sd = &sensor->subdev;
 328         v4l2_i2c_subdev_init(sd, client, &s5k6a3_subdev_ops);
 329         sensor->subdev.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;
 330         sd->internal_ops = &s5k6a3_sd_internal_ops;
 331
 332         sensor->format.code = s5k6a3_formats[0].code;
 333         sensor->format.width = S5K6A3_DEFAULT_WIDTH;
 334         sensor->format.height = S5K6A3_DEFAULT_HEIGHT;
 335
 336         sd->entity.function = MEDIA_ENT_F_CAM_SENSOR;
 337         sensor->pad.flags = MEDIA_PAD_FL_SOURCE;
 338         ret = media_entity_pads_init(&sd->entity, 1, &sensor->pad);
 339         if (ret < 0)
 340                 return ret;
 341
 342         pm_runtime_no_callbacks(dev);
 343         pm_runtime_enable(dev);
 344
 345         ret = v4l2_async_register_subdev(sd);
 346
 347         if (ret < 0) {
 348                 pm_runtime_disable(&client->dev);
 349                 media_entity_cleanup(&sd->entity);
 350         }
 351
 352         return ret;
 353 }
 354
 355 static int s5k6a3_remove(struct i2c_client *client)
 356 {
 357         struct v4l2_subdev *sd = i2c_get_clientdata(client);
 358
 359         pm_runtime_disable(&client->dev);
 360         v4l2_async_unregister_subdev(sd);
 361         media_entity_cleanup(&sd->entity);
 362         return 0;
 363 }
 364
 365 static const struct i2c_device_id s5k6a3_ids[] = {
 366         { }
 367 };
 368 MODULE_DEVICE_TABLE(i2c, s5k6a3_ids);
 369
 370 #ifdef CONFIG_OF
 371 static const struct of_device_id s5k6a3_of_match[] = {
 372         { .compatible = "samsung,s5k6a3" },
 373         { /* sentinel */ }
 374 };
 375 MODULE_DEVICE_TABLE(of, s5k6a3_of_match);
 376 #endif
 377
 378 static struct i2c_driver s5k6a3_driver = {
 379         .driver = {
 380                 .of_match_table = of_match_ptr(s5k6a3_of_match),
 381                 .name           = S5K6A3_DRV_NAME,
 382         },
 383         .probe_new      = s5k6a3_probe,
 384         .remove         = s5k6a3_remove,
 385         .id_table       = s5k6a3_ids,
 386 };
 387
 388 module_i2c_driver(s5k6a3_driver);
 389
 390 MODULE_DESCRIPTION("S5K6A3 image sensor subdev driver");
 391 MODULE_AUTHOR("Sylwester Nawrocki <s.nawrocki@samsung.com>");
 392 MODULE_LICENSE("GPL v2");