1f5fbb83fSMauro Carvalho Chehab // SPDX-License-Identifier: GPL-2.0 2ad85094bSMauro Carvalho Chehab /* 3ad85094bSMauro Carvalho Chehab * Support for GalaxyCore GC0310 VGA camera sensor. 4ad85094bSMauro Carvalho Chehab * 5ad85094bSMauro Carvalho Chehab * Copyright (c) 2013 Intel Corporation. All Rights Reserved. 6ad85094bSMauro Carvalho Chehab * 7ad85094bSMauro Carvalho Chehab * This program is free software; you can redistribute it and/or 8ad85094bSMauro Carvalho Chehab * modify it under the terms of the GNU General Public License version 9ad85094bSMauro Carvalho Chehab * 2 as published by the Free Software Foundation. 10ad85094bSMauro Carvalho Chehab * 11ad85094bSMauro Carvalho Chehab * This program is distributed in the hope that it will be useful, 12ad85094bSMauro Carvalho Chehab * but WITHOUT ANY WARRANTY; without even the implied warranty of 13ad85094bSMauro Carvalho Chehab * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 14ad85094bSMauro Carvalho Chehab * GNU General Public License for more details. 15ad85094bSMauro Carvalho Chehab * 16ad85094bSMauro Carvalho Chehab */ 17ad85094bSMauro Carvalho Chehab 18ad85094bSMauro Carvalho Chehab #include <linux/module.h> 19ad85094bSMauro Carvalho Chehab #include <linux/types.h> 20ad85094bSMauro Carvalho Chehab #include <linux/kernel.h> 21ad85094bSMauro Carvalho Chehab #include <linux/mm.h> 22ad85094bSMauro Carvalho Chehab #include <linux/string.h> 23ad85094bSMauro Carvalho Chehab #include <linux/errno.h> 24ad85094bSMauro Carvalho Chehab #include <linux/init.h> 25ad85094bSMauro Carvalho Chehab #include <linux/kmod.h> 26ad85094bSMauro Carvalho Chehab #include <linux/device.h> 27ad85094bSMauro Carvalho Chehab #include <linux/delay.h> 28ad85094bSMauro Carvalho Chehab #include <linux/slab.h> 29ad85094bSMauro Carvalho Chehab #include <linux/i2c.h> 30ad85094bSMauro Carvalho Chehab #include <linux/moduleparam.h> 31ad85094bSMauro Carvalho Chehab #include <media/v4l2-device.h> 32ad85094bSMauro Carvalho Chehab #include <linux/io.h> 33ad85094bSMauro Carvalho Chehab #include "../include/linux/atomisp_gmin_platform.h" 34ad85094bSMauro Carvalho Chehab 35ad85094bSMauro Carvalho Chehab #include "gc0310.h" 36ad85094bSMauro Carvalho Chehab 37ad85094bSMauro Carvalho Chehab /* 38ad85094bSMauro Carvalho Chehab * gc0310_write_reg_array - Initializes a list of GC0310 registers 39ad85094bSMauro Carvalho Chehab * @client: i2c driver client structure 40ad85094bSMauro Carvalho Chehab * @reglist: list of registers to be written 41bfe06aeeSHans de Goede * @count: number of register, value pairs in the list 42ad85094bSMauro Carvalho Chehab */ 43ad85094bSMauro Carvalho Chehab static int gc0310_write_reg_array(struct i2c_client *client, 44bfe06aeeSHans de Goede const struct gc0310_reg *reglist, int count) 45ad85094bSMauro Carvalho Chehab { 46bfe06aeeSHans de Goede int i, err; 47ad85094bSMauro Carvalho Chehab 48bfe06aeeSHans de Goede for (i = 0; i < count; i++) { 4965e5ef2fSHans de Goede err = i2c_smbus_write_byte_data(client, reglist[i].reg, reglist[i].val); 5065e5ef2fSHans de Goede if (err) { 5165e5ef2fSHans de Goede dev_err(&client->dev, "write error: wrote 0x%x to offset 0x%x error %d", 5265e5ef2fSHans de Goede reglist[i].val, reglist[i].reg, err); 53ad85094bSMauro Carvalho Chehab return err; 54ad85094bSMauro Carvalho Chehab } 5565e5ef2fSHans de Goede } 56ad85094bSMauro Carvalho Chehab 57e1a4b3a7SHans de Goede return 0; 58ad85094bSMauro Carvalho Chehab } 59bdfe0bebSMauro Carvalho Chehab 60*ef5fb5d4SHans de Goede static int gc0310_exposure_set(struct gc0310_device *dev, u32 exp) 61*ef5fb5d4SHans de Goede { 62*ef5fb5d4SHans de Goede struct i2c_client *client = v4l2_get_subdevdata(&dev->sd); 63*ef5fb5d4SHans de Goede 64*ef5fb5d4SHans de Goede return i2c_smbus_write_word_swapped(client, GC0310_AEC_PK_EXPO_H, exp); 65*ef5fb5d4SHans de Goede } 66*ef5fb5d4SHans de Goede 67*ef5fb5d4SHans de Goede static int gc0310_gain_set(struct gc0310_device *dev, u32 gain) 68*ef5fb5d4SHans de Goede { 69*ef5fb5d4SHans de Goede struct i2c_client *client = v4l2_get_subdevdata(&dev->sd); 70*ef5fb5d4SHans de Goede u8 again, dgain; 71*ef5fb5d4SHans de Goede int ret; 72*ef5fb5d4SHans de Goede 73*ef5fb5d4SHans de Goede /* Taken from original driver, this never sets dgain lower then 32? */ 74*ef5fb5d4SHans de Goede 75*ef5fb5d4SHans de Goede /* Change 0 - 95 to 32 - 127 */ 76*ef5fb5d4SHans de Goede gain += 32; 77*ef5fb5d4SHans de Goede 78*ef5fb5d4SHans de Goede if (gain < 64) { 79*ef5fb5d4SHans de Goede again = 0x0; /* sqrt(2) */ 80*ef5fb5d4SHans de Goede dgain = gain; 81*ef5fb5d4SHans de Goede } else { 82*ef5fb5d4SHans de Goede again = 0x2; /* 2 * sqrt(2) */ 83*ef5fb5d4SHans de Goede dgain = gain / 2; 84*ef5fb5d4SHans de Goede } 85*ef5fb5d4SHans de Goede 86*ef5fb5d4SHans de Goede ret = i2c_smbus_write_byte_data(client, GC0310_AGC_ADJ, again); 87*ef5fb5d4SHans de Goede if (ret) 88*ef5fb5d4SHans de Goede return ret; 89*ef5fb5d4SHans de Goede 90*ef5fb5d4SHans de Goede return i2c_smbus_write_byte_data(client, GC0310_DGC_ADJ, dgain); 91*ef5fb5d4SHans de Goede } 92*ef5fb5d4SHans de Goede 93ad85094bSMauro Carvalho Chehab static int gc0310_s_ctrl(struct v4l2_ctrl *ctrl) 94ad85094bSMauro Carvalho Chehab { 95*ef5fb5d4SHans de Goede struct gc0310_device *dev = 96*ef5fb5d4SHans de Goede container_of(ctrl->handler, struct gc0310_device, ctrls.handler); 97*ef5fb5d4SHans de Goede int ret; 98*ef5fb5d4SHans de Goede 99*ef5fb5d4SHans de Goede if (!dev->power_on) 100*ef5fb5d4SHans de Goede return 0; 101ad85094bSMauro Carvalho Chehab 102ad85094bSMauro Carvalho Chehab switch (ctrl->id) { 103*ef5fb5d4SHans de Goede case V4L2_CID_EXPOSURE: 104*ef5fb5d4SHans de Goede ret = gc0310_exposure_set(dev, ctrl->val); 105*ef5fb5d4SHans de Goede break; 106*ef5fb5d4SHans de Goede case V4L2_CID_GAIN: 107*ef5fb5d4SHans de Goede ret = gc0310_gain_set(dev, ctrl->val); 108*ef5fb5d4SHans de Goede break; 109ad85094bSMauro Carvalho Chehab default: 110ad85094bSMauro Carvalho Chehab ret = -EINVAL; 111*ef5fb5d4SHans de Goede break; 112ad85094bSMauro Carvalho Chehab } 113*ef5fb5d4SHans de Goede 114ad85094bSMauro Carvalho Chehab return ret; 115ad85094bSMauro Carvalho Chehab } 116ad85094bSMauro Carvalho Chehab 117ad85094bSMauro Carvalho Chehab static const struct v4l2_ctrl_ops ctrl_ops = { 118ad85094bSMauro Carvalho Chehab .s_ctrl = gc0310_s_ctrl, 119ad85094bSMauro Carvalho Chehab }; 120ad85094bSMauro Carvalho Chehab 121ad85094bSMauro Carvalho Chehab static int gc0310_init(struct v4l2_subdev *sd) 122ad85094bSMauro Carvalho Chehab { 123ad85094bSMauro Carvalho Chehab int ret; 124ad85094bSMauro Carvalho Chehab struct i2c_client *client = v4l2_get_subdevdata(sd); 125ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 126ad85094bSMauro Carvalho Chehab 127ad85094bSMauro Carvalho Chehab mutex_lock(&dev->input_lock); 128ad85094bSMauro Carvalho Chehab 1294636a85cSMauro Carvalho Chehab /* set initial registers */ 130bfe06aeeSHans de Goede ret = gc0310_write_reg_array(client, gc0310_reset_register, 131bfe06aeeSHans de Goede ARRAY_SIZE(gc0310_reset_register)); 132*ef5fb5d4SHans de Goede if (ret) 133*ef5fb5d4SHans de Goede goto out_unlock; 134ad85094bSMauro Carvalho Chehab 135ad85094bSMauro Carvalho Chehab /* restore settings */ 136ad85094bSMauro Carvalho Chehab gc0310_res = gc0310_res_preview; 137ad85094bSMauro Carvalho Chehab N_RES = N_RES_PREVIEW; 138ad85094bSMauro Carvalho Chehab 139*ef5fb5d4SHans de Goede /* restore value of all ctrls */ 140*ef5fb5d4SHans de Goede ret = __v4l2_ctrl_handler_setup(&dev->ctrls.handler); 141ad85094bSMauro Carvalho Chehab 142*ef5fb5d4SHans de Goede out_unlock: 143*ef5fb5d4SHans de Goede mutex_unlock(&dev->input_lock); 144ad85094bSMauro Carvalho Chehab return ret; 145ad85094bSMauro Carvalho Chehab } 146ad85094bSMauro Carvalho Chehab 147ad85094bSMauro Carvalho Chehab static int power_ctrl(struct v4l2_subdev *sd, bool flag) 148ad85094bSMauro Carvalho Chehab { 149ad85094bSMauro Carvalho Chehab int ret = 0; 150ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 151bdfe0bebSMauro Carvalho Chehab 152ad85094bSMauro Carvalho Chehab if (!dev || !dev->platform_data) 153ad85094bSMauro Carvalho Chehab return -ENODEV; 154ad85094bSMauro Carvalho Chehab 155ad85094bSMauro Carvalho Chehab if (flag) { 156ad85094bSMauro Carvalho Chehab /* The upstream module driver (written to Crystal 157ad85094bSMauro Carvalho Chehab * Cove) had this logic to pulse the rails low first. 158ad85094bSMauro Carvalho Chehab * This appears to break things on the MRD7 with the 159ad85094bSMauro Carvalho Chehab * X-Powers PMIC... 160ad85094bSMauro Carvalho Chehab * 161ad85094bSMauro Carvalho Chehab * ret = dev->platform_data->v1p8_ctrl(sd, 0); 162ad85094bSMauro Carvalho Chehab * ret |= dev->platform_data->v2p8_ctrl(sd, 0); 163ad85094bSMauro Carvalho Chehab * mdelay(50); 164ad85094bSMauro Carvalho Chehab */ 165ad85094bSMauro Carvalho Chehab ret |= dev->platform_data->v1p8_ctrl(sd, 1); 166ad85094bSMauro Carvalho Chehab ret |= dev->platform_data->v2p8_ctrl(sd, 1); 167ad85094bSMauro Carvalho Chehab usleep_range(10000, 15000); 168ad85094bSMauro Carvalho Chehab } 169ad85094bSMauro Carvalho Chehab 170ad85094bSMauro Carvalho Chehab if (!flag || ret) { 171ad85094bSMauro Carvalho Chehab ret |= dev->platform_data->v1p8_ctrl(sd, 0); 172ad85094bSMauro Carvalho Chehab ret |= dev->platform_data->v2p8_ctrl(sd, 0); 173ad85094bSMauro Carvalho Chehab } 174ad85094bSMauro Carvalho Chehab return ret; 175ad85094bSMauro Carvalho Chehab } 176ad85094bSMauro Carvalho Chehab 177ad85094bSMauro Carvalho Chehab static int gpio_ctrl(struct v4l2_subdev *sd, bool flag) 178ad85094bSMauro Carvalho Chehab { 179ad85094bSMauro Carvalho Chehab int ret; 180ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 181ad85094bSMauro Carvalho Chehab 182ad85094bSMauro Carvalho Chehab if (!dev || !dev->platform_data) 183ad85094bSMauro Carvalho Chehab return -ENODEV; 184ad85094bSMauro Carvalho Chehab 185ad85094bSMauro Carvalho Chehab /* GPIO0 == "reset" (active low), GPIO1 == "power down" */ 186ad85094bSMauro Carvalho Chehab if (flag) { 187ad85094bSMauro Carvalho Chehab /* Pulse reset, then release power down */ 188ad85094bSMauro Carvalho Chehab ret = dev->platform_data->gpio0_ctrl(sd, 0); 189ad85094bSMauro Carvalho Chehab usleep_range(5000, 10000); 190ad85094bSMauro Carvalho Chehab ret |= dev->platform_data->gpio0_ctrl(sd, 1); 191ad85094bSMauro Carvalho Chehab usleep_range(10000, 15000); 192ad85094bSMauro Carvalho Chehab ret |= dev->platform_data->gpio1_ctrl(sd, 0); 193ad85094bSMauro Carvalho Chehab usleep_range(10000, 15000); 194ad85094bSMauro Carvalho Chehab } else { 195ad85094bSMauro Carvalho Chehab ret = dev->platform_data->gpio1_ctrl(sd, 1); 196ad85094bSMauro Carvalho Chehab ret |= dev->platform_data->gpio0_ctrl(sd, 0); 197ad85094bSMauro Carvalho Chehab } 198ad85094bSMauro Carvalho Chehab return ret; 199ad85094bSMauro Carvalho Chehab } 200ad85094bSMauro Carvalho Chehab 201ad85094bSMauro Carvalho Chehab static int power_up(struct v4l2_subdev *sd) 202ad85094bSMauro Carvalho Chehab { 203ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 204ad85094bSMauro Carvalho Chehab struct i2c_client *client = v4l2_get_subdevdata(sd); 205ad85094bSMauro Carvalho Chehab int ret; 206ad85094bSMauro Carvalho Chehab 207ad85094bSMauro Carvalho Chehab if (!dev->platform_data) { 208ad85094bSMauro Carvalho Chehab dev_err(&client->dev, 209ad85094bSMauro Carvalho Chehab "no camera_sensor_platform_data"); 210ad85094bSMauro Carvalho Chehab return -ENODEV; 211ad85094bSMauro Carvalho Chehab } 212ad85094bSMauro Carvalho Chehab 213c5fafbadSHans de Goede if (dev->power_on) 214c5fafbadSHans de Goede return 0; /* Already on */ 215c5fafbadSHans de Goede 216ad85094bSMauro Carvalho Chehab /* power control */ 217ad85094bSMauro Carvalho Chehab ret = power_ctrl(sd, 1); 218ad85094bSMauro Carvalho Chehab if (ret) 219ad85094bSMauro Carvalho Chehab goto fail_power; 220ad85094bSMauro Carvalho Chehab 221ad85094bSMauro Carvalho Chehab /* flis clock control */ 222ad85094bSMauro Carvalho Chehab ret = dev->platform_data->flisclk_ctrl(sd, 1); 223ad85094bSMauro Carvalho Chehab if (ret) 224ad85094bSMauro Carvalho Chehab goto fail_clk; 225ad85094bSMauro Carvalho Chehab 226ad85094bSMauro Carvalho Chehab /* gpio ctrl */ 227ad85094bSMauro Carvalho Chehab ret = gpio_ctrl(sd, 1); 228ad85094bSMauro Carvalho Chehab if (ret) { 229ad85094bSMauro Carvalho Chehab ret = gpio_ctrl(sd, 1); 230ad85094bSMauro Carvalho Chehab if (ret) 231ad85094bSMauro Carvalho Chehab goto fail_gpio; 232ad85094bSMauro Carvalho Chehab } 233ad85094bSMauro Carvalho Chehab 234ad85094bSMauro Carvalho Chehab msleep(100); 235ad85094bSMauro Carvalho Chehab 236c5fafbadSHans de Goede dev->power_on = true; 237ad85094bSMauro Carvalho Chehab return 0; 238ad85094bSMauro Carvalho Chehab 239ad85094bSMauro Carvalho Chehab fail_gpio: 240ad85094bSMauro Carvalho Chehab dev->platform_data->flisclk_ctrl(sd, 0); 241ad85094bSMauro Carvalho Chehab fail_clk: 242ad85094bSMauro Carvalho Chehab power_ctrl(sd, 0); 243ad85094bSMauro Carvalho Chehab fail_power: 244ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "sensor power-up failed\n"); 245ad85094bSMauro Carvalho Chehab 246ad85094bSMauro Carvalho Chehab return ret; 247ad85094bSMauro Carvalho Chehab } 248ad85094bSMauro Carvalho Chehab 249ad85094bSMauro Carvalho Chehab static int power_down(struct v4l2_subdev *sd) 250ad85094bSMauro Carvalho Chehab { 251ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 252ad85094bSMauro Carvalho Chehab struct i2c_client *client = v4l2_get_subdevdata(sd); 253ad85094bSMauro Carvalho Chehab int ret = 0; 254ad85094bSMauro Carvalho Chehab 255ad85094bSMauro Carvalho Chehab if (!dev->platform_data) { 256ad85094bSMauro Carvalho Chehab dev_err(&client->dev, 257ad85094bSMauro Carvalho Chehab "no camera_sensor_platform_data"); 258ad85094bSMauro Carvalho Chehab return -ENODEV; 259ad85094bSMauro Carvalho Chehab } 260ad85094bSMauro Carvalho Chehab 261c5fafbadSHans de Goede if (!dev->power_on) 262c5fafbadSHans de Goede return 0; /* Already off */ 263c5fafbadSHans de Goede 264ad85094bSMauro Carvalho Chehab /* gpio ctrl */ 265ad85094bSMauro Carvalho Chehab ret = gpio_ctrl(sd, 0); 266ad85094bSMauro Carvalho Chehab if (ret) { 267ad85094bSMauro Carvalho Chehab ret = gpio_ctrl(sd, 0); 268ad85094bSMauro Carvalho Chehab if (ret) 269ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "gpio failed 2\n"); 270ad85094bSMauro Carvalho Chehab } 271ad85094bSMauro Carvalho Chehab 272ad85094bSMauro Carvalho Chehab ret = dev->platform_data->flisclk_ctrl(sd, 0); 273ad85094bSMauro Carvalho Chehab if (ret) 274ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "flisclk failed\n"); 275ad85094bSMauro Carvalho Chehab 276ad85094bSMauro Carvalho Chehab /* power control */ 277ad85094bSMauro Carvalho Chehab ret = power_ctrl(sd, 0); 278ad85094bSMauro Carvalho Chehab if (ret) 279ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "vprog failed.\n"); 280ad85094bSMauro Carvalho Chehab 281c5fafbadSHans de Goede dev->power_on = false; 282ad85094bSMauro Carvalho Chehab return ret; 283ad85094bSMauro Carvalho Chehab } 284ad85094bSMauro Carvalho Chehab 285ad85094bSMauro Carvalho Chehab static int gc0310_s_power(struct v4l2_subdev *sd, int on) 286ad85094bSMauro Carvalho Chehab { 287ad85094bSMauro Carvalho Chehab int ret; 288bdfe0bebSMauro Carvalho Chehab 289ad85094bSMauro Carvalho Chehab if (on == 0) 290ad85094bSMauro Carvalho Chehab return power_down(sd); 2914658e1dbSLeonid Kushnir 292dfe59c78SLeonid Kushnir ret = power_up(sd); 293dfe59c78SLeonid Kushnir if (ret) 294ad85094bSMauro Carvalho Chehab return ret; 295dfe59c78SLeonid Kushnir 296dfe59c78SLeonid Kushnir return gc0310_init(sd); 297ad85094bSMauro Carvalho Chehab } 298ad85094bSMauro Carvalho Chehab 299ad85094bSMauro Carvalho Chehab /* TODO: remove it. */ 300ad85094bSMauro Carvalho Chehab static int startup(struct v4l2_subdev *sd) 301ad85094bSMauro Carvalho Chehab { 302ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 303ad85094bSMauro Carvalho Chehab struct i2c_client *client = v4l2_get_subdevdata(sd); 304ad85094bSMauro Carvalho Chehab int ret = 0; 305ad85094bSMauro Carvalho Chehab 306bfe06aeeSHans de Goede ret = gc0310_write_reg_array(client, dev->res->regs, dev->res->reg_count); 307ad85094bSMauro Carvalho Chehab if (ret) { 308ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "gc0310 write register err.\n"); 309ad85094bSMauro Carvalho Chehab return ret; 310ad85094bSMauro Carvalho Chehab } 311ad85094bSMauro Carvalho Chehab 312ad85094bSMauro Carvalho Chehab return ret; 313ad85094bSMauro Carvalho Chehab } 314ad85094bSMauro Carvalho Chehab 315ad85094bSMauro Carvalho Chehab static int gc0310_set_fmt(struct v4l2_subdev *sd, 3160d346d2aSTomi Valkeinen struct v4l2_subdev_state *sd_state, 317ad85094bSMauro Carvalho Chehab struct v4l2_subdev_format *format) 318ad85094bSMauro Carvalho Chehab { 319ad85094bSMauro Carvalho Chehab struct v4l2_mbus_framefmt *fmt = &format->format; 320ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 321ad85094bSMauro Carvalho Chehab struct i2c_client *client = v4l2_get_subdevdata(sd); 322ad85094bSMauro Carvalho Chehab struct camera_mipi_info *gc0310_info = NULL; 323e3b14bf8SMauro Carvalho Chehab struct gc0310_resolution *res; 324ad85094bSMauro Carvalho Chehab int ret = 0; 325bdfe0bebSMauro Carvalho Chehab 326ad85094bSMauro Carvalho Chehab if (format->pad) 327ad85094bSMauro Carvalho Chehab return -EINVAL; 328ad85094bSMauro Carvalho Chehab 329ad85094bSMauro Carvalho Chehab if (!fmt) 330ad85094bSMauro Carvalho Chehab return -EINVAL; 331ad85094bSMauro Carvalho Chehab 332ad85094bSMauro Carvalho Chehab gc0310_info = v4l2_get_subdev_hostdata(sd); 333ad85094bSMauro Carvalho Chehab if (!gc0310_info) 334ad85094bSMauro Carvalho Chehab return -EINVAL; 335ad85094bSMauro Carvalho Chehab 336ad85094bSMauro Carvalho Chehab mutex_lock(&dev->input_lock); 337ad85094bSMauro Carvalho Chehab 338e3b14bf8SMauro Carvalho Chehab res = v4l2_find_nearest_size(gc0310_res_preview, 339e3b14bf8SMauro Carvalho Chehab ARRAY_SIZE(gc0310_res_preview), width, 340e3b14bf8SMauro Carvalho Chehab height, fmt->width, fmt->height); 341e3b14bf8SMauro Carvalho Chehab if (!res) 342e3b14bf8SMauro Carvalho Chehab res = &gc0310_res_preview[N_RES - 1]; 343e3b14bf8SMauro Carvalho Chehab 344e3b14bf8SMauro Carvalho Chehab fmt->width = res->width; 345e3b14bf8SMauro Carvalho Chehab fmt->height = res->height; 346e3b14bf8SMauro Carvalho Chehab dev->res = res; 347e3b14bf8SMauro Carvalho Chehab 348ad85094bSMauro Carvalho Chehab fmt->code = MEDIA_BUS_FMT_SGRBG8_1X8; 349ad85094bSMauro Carvalho Chehab 350ad85094bSMauro Carvalho Chehab if (format->which == V4L2_SUBDEV_FORMAT_TRY) { 3510d346d2aSTomi Valkeinen sd_state->pads->try_fmt = *fmt; 352ad85094bSMauro Carvalho Chehab mutex_unlock(&dev->input_lock); 353ad85094bSMauro Carvalho Chehab return 0; 354ad85094bSMauro Carvalho Chehab } 355ad85094bSMauro Carvalho Chehab 356c5fafbadSHans de Goede /* s_power has not been called yet for std v4l2 clients (camorama) */ 357c5fafbadSHans de Goede power_up(sd); 358c5fafbadSHans de Goede 3592dfc978aSDeepak R Varma dev_dbg(&client->dev, "%s: before gc0310_write_reg_array %s\n", 360e3b14bf8SMauro Carvalho Chehab __func__, dev->res->desc); 361ad85094bSMauro Carvalho Chehab ret = startup(sd); 362ad85094bSMauro Carvalho Chehab if (ret) { 363ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "gc0310 startup err\n"); 364ad85094bSMauro Carvalho Chehab goto err; 365ad85094bSMauro Carvalho Chehab } 366ad85094bSMauro Carvalho Chehab 367ad85094bSMauro Carvalho Chehab err: 368ad85094bSMauro Carvalho Chehab mutex_unlock(&dev->input_lock); 369ad85094bSMauro Carvalho Chehab return ret; 370ad85094bSMauro Carvalho Chehab } 371ad85094bSMauro Carvalho Chehab 372ad85094bSMauro Carvalho Chehab static int gc0310_get_fmt(struct v4l2_subdev *sd, 3730d346d2aSTomi Valkeinen struct v4l2_subdev_state *sd_state, 374ad85094bSMauro Carvalho Chehab struct v4l2_subdev_format *format) 375ad85094bSMauro Carvalho Chehab { 376ad85094bSMauro Carvalho Chehab struct v4l2_mbus_framefmt *fmt = &format->format; 377ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 378ad85094bSMauro Carvalho Chehab 379ad85094bSMauro Carvalho Chehab if (format->pad) 380ad85094bSMauro Carvalho Chehab return -EINVAL; 381ad85094bSMauro Carvalho Chehab 382ad85094bSMauro Carvalho Chehab if (!fmt) 383ad85094bSMauro Carvalho Chehab return -EINVAL; 384ad85094bSMauro Carvalho Chehab 385e3b14bf8SMauro Carvalho Chehab fmt->width = dev->res->width; 386e3b14bf8SMauro Carvalho Chehab fmt->height = dev->res->height; 387ad85094bSMauro Carvalho Chehab fmt->code = MEDIA_BUS_FMT_SGRBG8_1X8; 388ad85094bSMauro Carvalho Chehab 389ad85094bSMauro Carvalho Chehab return 0; 390ad85094bSMauro Carvalho Chehab } 391ad85094bSMauro Carvalho Chehab 392ad85094bSMauro Carvalho Chehab static int gc0310_detect(struct i2c_client *client) 393ad85094bSMauro Carvalho Chehab { 394ad85094bSMauro Carvalho Chehab struct i2c_adapter *adapter = client->adapter; 395ad85094bSMauro Carvalho Chehab int ret; 396ad85094bSMauro Carvalho Chehab 397ad85094bSMauro Carvalho Chehab if (!i2c_check_functionality(adapter, I2C_FUNC_I2C)) 398ad85094bSMauro Carvalho Chehab return -ENODEV; 399ad85094bSMauro Carvalho Chehab 40065e5ef2fSHans de Goede ret = i2c_smbus_read_word_swapped(client, GC0310_SC_CMMN_CHIP_ID_H); 40165e5ef2fSHans de Goede if (ret < 0) { 40265e5ef2fSHans de Goede dev_err(&client->dev, "read sensor_id failed: %d\n", ret); 403ad85094bSMauro Carvalho Chehab return -ENODEV; 404ad85094bSMauro Carvalho Chehab } 405ad85094bSMauro Carvalho Chehab 40665e5ef2fSHans de Goede dev_dbg(&client->dev, "sensor ID = 0x%x\n", ret); 40765e5ef2fSHans de Goede 40865e5ef2fSHans de Goede if (ret != GC0310_ID) { 40965e5ef2fSHans de Goede dev_err(&client->dev, "sensor ID error, read id = 0x%x, target id = 0x%x\n", 41065e5ef2fSHans de Goede ret, GC0310_ID); 411ad85094bSMauro Carvalho Chehab return -ENODEV; 412ad85094bSMauro Carvalho Chehab } 413ad85094bSMauro Carvalho Chehab 414ad85094bSMauro Carvalho Chehab dev_dbg(&client->dev, "detect gc0310 success\n"); 415ad85094bSMauro Carvalho Chehab 416ad85094bSMauro Carvalho Chehab return 0; 417ad85094bSMauro Carvalho Chehab } 418ad85094bSMauro Carvalho Chehab 419ad85094bSMauro Carvalho Chehab static int gc0310_s_stream(struct v4l2_subdev *sd, int enable) 420ad85094bSMauro Carvalho Chehab { 421ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 422ad85094bSMauro Carvalho Chehab struct i2c_client *client = v4l2_get_subdevdata(sd); 423ad85094bSMauro Carvalho Chehab int ret; 424ad85094bSMauro Carvalho Chehab 4252dfc978aSDeepak R Varma dev_dbg(&client->dev, "%s S enable=%d\n", __func__, enable); 426ad85094bSMauro Carvalho Chehab mutex_lock(&dev->input_lock); 427ad85094bSMauro Carvalho Chehab 428ad85094bSMauro Carvalho Chehab if (enable) { 429ad85094bSMauro Carvalho Chehab /* enable per frame MIPI and sensor ctrl reset */ 43065e5ef2fSHans de Goede ret = i2c_smbus_write_byte_data(client, 0xFE, 0x30); 431ad85094bSMauro Carvalho Chehab if (ret) { 432ad85094bSMauro Carvalho Chehab mutex_unlock(&dev->input_lock); 433ad85094bSMauro Carvalho Chehab return ret; 434ad85094bSMauro Carvalho Chehab } 435ad85094bSMauro Carvalho Chehab } 436ad85094bSMauro Carvalho Chehab 43765e5ef2fSHans de Goede ret = i2c_smbus_write_byte_data(client, GC0310_RESET_RELATED, GC0310_REGISTER_PAGE_3); 438ad85094bSMauro Carvalho Chehab if (ret) { 439ad85094bSMauro Carvalho Chehab mutex_unlock(&dev->input_lock); 440ad85094bSMauro Carvalho Chehab return ret; 441ad85094bSMauro Carvalho Chehab } 442ad85094bSMauro Carvalho Chehab 44365e5ef2fSHans de Goede ret = i2c_smbus_write_byte_data(client, GC0310_SW_STREAM, 44465e5ef2fSHans de Goede enable ? GC0310_START_STREAMING : GC0310_STOP_STREAMING); 445ad85094bSMauro Carvalho Chehab if (ret) { 446ad85094bSMauro Carvalho Chehab mutex_unlock(&dev->input_lock); 447ad85094bSMauro Carvalho Chehab return ret; 448ad85094bSMauro Carvalho Chehab } 449ad85094bSMauro Carvalho Chehab 45065e5ef2fSHans de Goede ret = i2c_smbus_write_byte_data(client, GC0310_RESET_RELATED, GC0310_REGISTER_PAGE_0); 451ad85094bSMauro Carvalho Chehab if (ret) { 452ad85094bSMauro Carvalho Chehab mutex_unlock(&dev->input_lock); 453ad85094bSMauro Carvalho Chehab return ret; 454ad85094bSMauro Carvalho Chehab } 455ad85094bSMauro Carvalho Chehab 456ad85094bSMauro Carvalho Chehab mutex_unlock(&dev->input_lock); 457ad85094bSMauro Carvalho Chehab return ret; 458ad85094bSMauro Carvalho Chehab } 459ad85094bSMauro Carvalho Chehab 460ad85094bSMauro Carvalho Chehab static int gc0310_s_config(struct v4l2_subdev *sd, 461ad85094bSMauro Carvalho Chehab int irq, void *platform_data) 462ad85094bSMauro Carvalho Chehab { 463ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 464ad85094bSMauro Carvalho Chehab struct i2c_client *client = v4l2_get_subdevdata(sd); 465ad85094bSMauro Carvalho Chehab int ret = 0; 466ad85094bSMauro Carvalho Chehab 467ad85094bSMauro Carvalho Chehab if (!platform_data) 468ad85094bSMauro Carvalho Chehab return -ENODEV; 469ad85094bSMauro Carvalho Chehab 470ad85094bSMauro Carvalho Chehab dev->platform_data = 471ad85094bSMauro Carvalho Chehab (struct camera_sensor_platform_data *)platform_data; 472ad85094bSMauro Carvalho Chehab 473ad85094bSMauro Carvalho Chehab mutex_lock(&dev->input_lock); 474ad85094bSMauro Carvalho Chehab /* power off the module, then power on it in future 475ad85094bSMauro Carvalho Chehab * as first power on by board may not fulfill the 476ad85094bSMauro Carvalho Chehab * power on sequqence needed by the module 477ad85094bSMauro Carvalho Chehab */ 478c5fafbadSHans de Goede dev->power_on = true; /* force power_down() to run */ 479ad85094bSMauro Carvalho Chehab ret = power_down(sd); 480ad85094bSMauro Carvalho Chehab if (ret) { 481ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "gc0310 power-off err.\n"); 482ad85094bSMauro Carvalho Chehab goto fail_power_off; 483ad85094bSMauro Carvalho Chehab } 484ad85094bSMauro Carvalho Chehab 485ad85094bSMauro Carvalho Chehab ret = power_up(sd); 486ad85094bSMauro Carvalho Chehab if (ret) { 487ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "gc0310 power-up err.\n"); 488ad85094bSMauro Carvalho Chehab goto fail_power_on; 489ad85094bSMauro Carvalho Chehab } 490ad85094bSMauro Carvalho Chehab 491ad85094bSMauro Carvalho Chehab ret = dev->platform_data->csi_cfg(sd, 1); 492ad85094bSMauro Carvalho Chehab if (ret) 493ad85094bSMauro Carvalho Chehab goto fail_csi_cfg; 494ad85094bSMauro Carvalho Chehab 495ad85094bSMauro Carvalho Chehab /* config & detect sensor */ 496ad85094bSMauro Carvalho Chehab ret = gc0310_detect(client); 497ad85094bSMauro Carvalho Chehab if (ret) { 498ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "gc0310_detect err s_config.\n"); 499ad85094bSMauro Carvalho Chehab goto fail_csi_cfg; 500ad85094bSMauro Carvalho Chehab } 501ad85094bSMauro Carvalho Chehab 502ad85094bSMauro Carvalho Chehab /* turn off sensor, after probed */ 503ad85094bSMauro Carvalho Chehab ret = power_down(sd); 504ad85094bSMauro Carvalho Chehab if (ret) { 505ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "gc0310 power-off err.\n"); 506ad85094bSMauro Carvalho Chehab goto fail_csi_cfg; 507ad85094bSMauro Carvalho Chehab } 508ad85094bSMauro Carvalho Chehab mutex_unlock(&dev->input_lock); 509ad85094bSMauro Carvalho Chehab 510ad85094bSMauro Carvalho Chehab return 0; 511ad85094bSMauro Carvalho Chehab 512ad85094bSMauro Carvalho Chehab fail_csi_cfg: 513ad85094bSMauro Carvalho Chehab dev->platform_data->csi_cfg(sd, 0); 514ad85094bSMauro Carvalho Chehab fail_power_on: 515ad85094bSMauro Carvalho Chehab power_down(sd); 516ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "sensor power-gating failed\n"); 517ad85094bSMauro Carvalho Chehab fail_power_off: 518ad85094bSMauro Carvalho Chehab mutex_unlock(&dev->input_lock); 519ad85094bSMauro Carvalho Chehab return ret; 520ad85094bSMauro Carvalho Chehab } 521ad85094bSMauro Carvalho Chehab 522ad85094bSMauro Carvalho Chehab static int gc0310_g_frame_interval(struct v4l2_subdev *sd, 523ad85094bSMauro Carvalho Chehab struct v4l2_subdev_frame_interval *interval) 524ad85094bSMauro Carvalho Chehab { 525ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 526ad85094bSMauro Carvalho Chehab 527ad85094bSMauro Carvalho Chehab interval->interval.numerator = 1; 528e3b14bf8SMauro Carvalho Chehab interval->interval.denominator = dev->res->fps; 529ad85094bSMauro Carvalho Chehab 530ad85094bSMauro Carvalho Chehab return 0; 531ad85094bSMauro Carvalho Chehab } 532ad85094bSMauro Carvalho Chehab 533ad85094bSMauro Carvalho Chehab static int gc0310_enum_mbus_code(struct v4l2_subdev *sd, 5340d346d2aSTomi Valkeinen struct v4l2_subdev_state *sd_state, 535ad85094bSMauro Carvalho Chehab struct v4l2_subdev_mbus_code_enum *code) 536ad85094bSMauro Carvalho Chehab { 537ad85094bSMauro Carvalho Chehab if (code->index >= MAX_FMTS) 538ad85094bSMauro Carvalho Chehab return -EINVAL; 539ad85094bSMauro Carvalho Chehab 540ad85094bSMauro Carvalho Chehab code->code = MEDIA_BUS_FMT_SGRBG8_1X8; 541ad85094bSMauro Carvalho Chehab return 0; 542ad85094bSMauro Carvalho Chehab } 543ad85094bSMauro Carvalho Chehab 544ad85094bSMauro Carvalho Chehab static int gc0310_enum_frame_size(struct v4l2_subdev *sd, 5450d346d2aSTomi Valkeinen struct v4l2_subdev_state *sd_state, 546ad85094bSMauro Carvalho Chehab struct v4l2_subdev_frame_size_enum *fse) 547ad85094bSMauro Carvalho Chehab { 548ad85094bSMauro Carvalho Chehab int index = fse->index; 549ad85094bSMauro Carvalho Chehab 550ad85094bSMauro Carvalho Chehab if (index >= N_RES) 551ad85094bSMauro Carvalho Chehab return -EINVAL; 552ad85094bSMauro Carvalho Chehab 553ad85094bSMauro Carvalho Chehab fse->min_width = gc0310_res[index].width; 554ad85094bSMauro Carvalho Chehab fse->min_height = gc0310_res[index].height; 555ad85094bSMauro Carvalho Chehab fse->max_width = gc0310_res[index].width; 556ad85094bSMauro Carvalho Chehab fse->max_height = gc0310_res[index].height; 557ad85094bSMauro Carvalho Chehab 558ad85094bSMauro Carvalho Chehab return 0; 559ad85094bSMauro Carvalho Chehab } 560ad85094bSMauro Carvalho Chehab 561ad85094bSMauro Carvalho Chehab static int gc0310_g_skip_frames(struct v4l2_subdev *sd, u32 *frames) 562ad85094bSMauro Carvalho Chehab { 563ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 564ad85094bSMauro Carvalho Chehab 565ad85094bSMauro Carvalho Chehab mutex_lock(&dev->input_lock); 566e3b14bf8SMauro Carvalho Chehab *frames = dev->res->skip_frames; 567ad85094bSMauro Carvalho Chehab mutex_unlock(&dev->input_lock); 568ad85094bSMauro Carvalho Chehab 569ad85094bSMauro Carvalho Chehab return 0; 570ad85094bSMauro Carvalho Chehab } 571ad85094bSMauro Carvalho Chehab 572ad85094bSMauro Carvalho Chehab static const struct v4l2_subdev_sensor_ops gc0310_sensor_ops = { 573ad85094bSMauro Carvalho Chehab .g_skip_frames = gc0310_g_skip_frames, 574ad85094bSMauro Carvalho Chehab }; 575ad85094bSMauro Carvalho Chehab 576ad85094bSMauro Carvalho Chehab static const struct v4l2_subdev_video_ops gc0310_video_ops = { 577ad85094bSMauro Carvalho Chehab .s_stream = gc0310_s_stream, 578ad85094bSMauro Carvalho Chehab .g_frame_interval = gc0310_g_frame_interval, 579ad85094bSMauro Carvalho Chehab }; 580ad85094bSMauro Carvalho Chehab 581ad85094bSMauro Carvalho Chehab static const struct v4l2_subdev_core_ops gc0310_core_ops = { 582ad85094bSMauro Carvalho Chehab .s_power = gc0310_s_power, 583ad85094bSMauro Carvalho Chehab }; 584ad85094bSMauro Carvalho Chehab 585ad85094bSMauro Carvalho Chehab static const struct v4l2_subdev_pad_ops gc0310_pad_ops = { 586ad85094bSMauro Carvalho Chehab .enum_mbus_code = gc0310_enum_mbus_code, 587ad85094bSMauro Carvalho Chehab .enum_frame_size = gc0310_enum_frame_size, 588ad85094bSMauro Carvalho Chehab .get_fmt = gc0310_get_fmt, 589ad85094bSMauro Carvalho Chehab .set_fmt = gc0310_set_fmt, 590ad85094bSMauro Carvalho Chehab }; 591ad85094bSMauro Carvalho Chehab 592ad85094bSMauro Carvalho Chehab static const struct v4l2_subdev_ops gc0310_ops = { 593ad85094bSMauro Carvalho Chehab .core = &gc0310_core_ops, 594ad85094bSMauro Carvalho Chehab .video = &gc0310_video_ops, 595ad85094bSMauro Carvalho Chehab .pad = &gc0310_pad_ops, 596ad85094bSMauro Carvalho Chehab .sensor = &gc0310_sensor_ops, 597ad85094bSMauro Carvalho Chehab }; 598ad85094bSMauro Carvalho Chehab 599*ef5fb5d4SHans de Goede static int gc0310_init_controls(struct gc0310_device *dev) 600*ef5fb5d4SHans de Goede { 601*ef5fb5d4SHans de Goede struct v4l2_ctrl_handler *hdl = &dev->ctrls.handler; 602*ef5fb5d4SHans de Goede 603*ef5fb5d4SHans de Goede v4l2_ctrl_handler_init(hdl, 2); 604*ef5fb5d4SHans de Goede 605*ef5fb5d4SHans de Goede /* Use the same lock for controls as for everything else */ 606*ef5fb5d4SHans de Goede hdl->lock = &dev->input_lock; 607*ef5fb5d4SHans de Goede dev->sd.ctrl_handler = hdl; 608*ef5fb5d4SHans de Goede 609*ef5fb5d4SHans de Goede dev->ctrls.exposure = 610*ef5fb5d4SHans de Goede v4l2_ctrl_new_std(hdl, &ctrl_ops, V4L2_CID_EXPOSURE, 0, 4095, 1, 1023); 611*ef5fb5d4SHans de Goede 612*ef5fb5d4SHans de Goede /* 32 steps at base gain 1 + 64 half steps at base gain 2 */ 613*ef5fb5d4SHans de Goede dev->ctrls.gain = 614*ef5fb5d4SHans de Goede v4l2_ctrl_new_std(hdl, &ctrl_ops, V4L2_CID_GAIN, 0, 95, 1, 31); 615*ef5fb5d4SHans de Goede 616*ef5fb5d4SHans de Goede return hdl->error; 617*ef5fb5d4SHans de Goede } 618*ef5fb5d4SHans de Goede 619ed5c2f5fSUwe Kleine-König static void gc0310_remove(struct i2c_client *client) 620ad85094bSMauro Carvalho Chehab { 621ad85094bSMauro Carvalho Chehab struct v4l2_subdev *sd = i2c_get_clientdata(client); 622ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 623bdfe0bebSMauro Carvalho Chehab 624ad85094bSMauro Carvalho Chehab dev_dbg(&client->dev, "gc0310_remove...\n"); 625ad85094bSMauro Carvalho Chehab 626ad85094bSMauro Carvalho Chehab dev->platform_data->csi_cfg(sd, 0); 627ad85094bSMauro Carvalho Chehab 628ad85094bSMauro Carvalho Chehab v4l2_device_unregister_subdev(sd); 629ad85094bSMauro Carvalho Chehab media_entity_cleanup(&dev->sd.entity); 630*ef5fb5d4SHans de Goede v4l2_ctrl_handler_free(&dev->ctrls.handler); 631ad85094bSMauro Carvalho Chehab kfree(dev); 632ad85094bSMauro Carvalho Chehab } 633ad85094bSMauro Carvalho Chehab 634ad85094bSMauro Carvalho Chehab static int gc0310_probe(struct i2c_client *client) 635ad85094bSMauro Carvalho Chehab { 636ad85094bSMauro Carvalho Chehab struct gc0310_device *dev; 637ad85094bSMauro Carvalho Chehab int ret; 638ad85094bSMauro Carvalho Chehab void *pdata; 639c03496b3SMauro Carvalho Chehab 640ad85094bSMauro Carvalho Chehab dev = kzalloc(sizeof(*dev), GFP_KERNEL); 641ad85094bSMauro Carvalho Chehab if (!dev) 642ad85094bSMauro Carvalho Chehab return -ENOMEM; 643ad85094bSMauro Carvalho Chehab 644ad85094bSMauro Carvalho Chehab mutex_init(&dev->input_lock); 645ad85094bSMauro Carvalho Chehab 646e3b14bf8SMauro Carvalho Chehab dev->res = &gc0310_res_preview[0]; 647bdfe0bebSMauro Carvalho Chehab v4l2_i2c_subdev_init(&dev->sd, client, &gc0310_ops); 648ad85094bSMauro Carvalho Chehab 649ad85094bSMauro Carvalho Chehab pdata = gmin_camera_platform_data(&dev->sd, 650ad85094bSMauro Carvalho Chehab ATOMISP_INPUT_FORMAT_RAW_8, 651ad85094bSMauro Carvalho Chehab atomisp_bayer_order_grbg); 652ad85094bSMauro Carvalho Chehab if (!pdata) { 653ad85094bSMauro Carvalho Chehab ret = -EINVAL; 654ad85094bSMauro Carvalho Chehab goto out_free; 655ad85094bSMauro Carvalho Chehab } 656ad85094bSMauro Carvalho Chehab 657ad85094bSMauro Carvalho Chehab ret = gc0310_s_config(&dev->sd, client->irq, pdata); 658ad85094bSMauro Carvalho Chehab if (ret) 659ad85094bSMauro Carvalho Chehab goto out_free; 660ad85094bSMauro Carvalho Chehab 661ad85094bSMauro Carvalho Chehab ret = atomisp_register_i2c_module(&dev->sd, pdata, RAW_CAMERA); 662ad85094bSMauro Carvalho Chehab if (ret) 663ad85094bSMauro Carvalho Chehab goto out_free; 664ad85094bSMauro Carvalho Chehab 665ad85094bSMauro Carvalho Chehab dev->sd.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE; 666ad85094bSMauro Carvalho Chehab dev->pad.flags = MEDIA_PAD_FL_SOURCE; 667ad85094bSMauro Carvalho Chehab dev->format.code = MEDIA_BUS_FMT_SGRBG8_1X8; 668ad85094bSMauro Carvalho Chehab dev->sd.entity.function = MEDIA_ENT_F_CAM_SENSOR; 669*ef5fb5d4SHans de Goede 670*ef5fb5d4SHans de Goede ret = gc0310_init_controls(dev); 671ad85094bSMauro Carvalho Chehab if (ret) { 672ad85094bSMauro Carvalho Chehab gc0310_remove(client); 673ad85094bSMauro Carvalho Chehab return ret; 674ad85094bSMauro Carvalho Chehab } 675ad85094bSMauro Carvalho Chehab 676ad85094bSMauro Carvalho Chehab ret = media_entity_pads_init(&dev->sd.entity, 1, &dev->pad); 677ad85094bSMauro Carvalho Chehab if (ret) 678ad85094bSMauro Carvalho Chehab gc0310_remove(client); 679ad85094bSMauro Carvalho Chehab 680ad85094bSMauro Carvalho Chehab return ret; 681ad85094bSMauro Carvalho Chehab out_free: 682ad85094bSMauro Carvalho Chehab v4l2_device_unregister_subdev(&dev->sd); 683ad85094bSMauro Carvalho Chehab kfree(dev); 684ad85094bSMauro Carvalho Chehab return ret; 685ad85094bSMauro Carvalho Chehab } 686ad85094bSMauro Carvalho Chehab 687ad85094bSMauro Carvalho Chehab static const struct acpi_device_id gc0310_acpi_match[] = { 688ad85094bSMauro Carvalho Chehab {"XXGC0310"}, 689ad85094bSMauro Carvalho Chehab {"INT0310"}, 690ad85094bSMauro Carvalho Chehab {}, 691ad85094bSMauro Carvalho Chehab }; 692ad85094bSMauro Carvalho Chehab MODULE_DEVICE_TABLE(acpi, gc0310_acpi_match); 693ad85094bSMauro Carvalho Chehab 694ad85094bSMauro Carvalho Chehab static struct i2c_driver gc0310_driver = { 695ad85094bSMauro Carvalho Chehab .driver = { 696ad85094bSMauro Carvalho Chehab .name = "gc0310", 697ad85094bSMauro Carvalho Chehab .acpi_match_table = gc0310_acpi_match, 698ad85094bSMauro Carvalho Chehab }, 699ad85094bSMauro Carvalho Chehab .probe_new = gc0310_probe, 700ad85094bSMauro Carvalho Chehab .remove = gc0310_remove, 701ad85094bSMauro Carvalho Chehab }; 702ad85094bSMauro Carvalho Chehab module_i2c_driver(gc0310_driver); 703ad85094bSMauro Carvalho Chehab 704ad85094bSMauro Carvalho Chehab MODULE_AUTHOR("Lai, Angie <angie.lai@intel.com>"); 705ad85094bSMauro Carvalho Chehab MODULE_DESCRIPTION("A low-level driver for GalaxyCore GC0310 sensors"); 706ad85094bSMauro Carvalho Chehab MODULE_LICENSE("GPL"); 707