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> 31*2726c899SHans de Goede #include <linux/pm_runtime.h> 32ad85094bSMauro Carvalho Chehab #include <media/v4l2-device.h> 33ad85094bSMauro Carvalho Chehab #include <linux/io.h> 34ad85094bSMauro Carvalho Chehab #include "../include/linux/atomisp_gmin_platform.h" 35ad85094bSMauro Carvalho Chehab 36ad85094bSMauro Carvalho Chehab #include "gc0310.h" 37ad85094bSMauro Carvalho Chehab 38ad85094bSMauro Carvalho Chehab /* 39ad85094bSMauro Carvalho Chehab * gc0310_write_reg_array - Initializes a list of GC0310 registers 40ad85094bSMauro Carvalho Chehab * @client: i2c driver client structure 41ad85094bSMauro Carvalho Chehab * @reglist: list of registers to be written 42bfe06aeeSHans de Goede * @count: number of register, value pairs in the list 43ad85094bSMauro Carvalho Chehab */ 44ad85094bSMauro Carvalho Chehab static int gc0310_write_reg_array(struct i2c_client *client, 45bfe06aeeSHans de Goede const struct gc0310_reg *reglist, int count) 46ad85094bSMauro Carvalho Chehab { 47bfe06aeeSHans de Goede int i, err; 48ad85094bSMauro Carvalho Chehab 49bfe06aeeSHans de Goede for (i = 0; i < count; i++) { 5065e5ef2fSHans de Goede err = i2c_smbus_write_byte_data(client, reglist[i].reg, reglist[i].val); 5165e5ef2fSHans de Goede if (err) { 5265e5ef2fSHans de Goede dev_err(&client->dev, "write error: wrote 0x%x to offset 0x%x error %d", 5365e5ef2fSHans de Goede reglist[i].val, reglist[i].reg, err); 54ad85094bSMauro Carvalho Chehab return err; 55ad85094bSMauro Carvalho Chehab } 5665e5ef2fSHans de Goede } 57ad85094bSMauro Carvalho Chehab 58e1a4b3a7SHans de Goede return 0; 59ad85094bSMauro Carvalho Chehab } 60bdfe0bebSMauro Carvalho Chehab 61ef5fb5d4SHans de Goede static int gc0310_exposure_set(struct gc0310_device *dev, u32 exp) 62ef5fb5d4SHans de Goede { 63ef5fb5d4SHans de Goede struct i2c_client *client = v4l2_get_subdevdata(&dev->sd); 64ef5fb5d4SHans de Goede 65ef5fb5d4SHans de Goede return i2c_smbus_write_word_swapped(client, GC0310_AEC_PK_EXPO_H, exp); 66ef5fb5d4SHans de Goede } 67ef5fb5d4SHans de Goede 68ef5fb5d4SHans de Goede static int gc0310_gain_set(struct gc0310_device *dev, u32 gain) 69ef5fb5d4SHans de Goede { 70ef5fb5d4SHans de Goede struct i2c_client *client = v4l2_get_subdevdata(&dev->sd); 71ef5fb5d4SHans de Goede u8 again, dgain; 72ef5fb5d4SHans de Goede int ret; 73ef5fb5d4SHans de Goede 74ef5fb5d4SHans de Goede /* Taken from original driver, this never sets dgain lower then 32? */ 75ef5fb5d4SHans de Goede 76ef5fb5d4SHans de Goede /* Change 0 - 95 to 32 - 127 */ 77ef5fb5d4SHans de Goede gain += 32; 78ef5fb5d4SHans de Goede 79ef5fb5d4SHans de Goede if (gain < 64) { 80ef5fb5d4SHans de Goede again = 0x0; /* sqrt(2) */ 81ef5fb5d4SHans de Goede dgain = gain; 82ef5fb5d4SHans de Goede } else { 83ef5fb5d4SHans de Goede again = 0x2; /* 2 * sqrt(2) */ 84ef5fb5d4SHans de Goede dgain = gain / 2; 85ef5fb5d4SHans de Goede } 86ef5fb5d4SHans de Goede 87ef5fb5d4SHans de Goede ret = i2c_smbus_write_byte_data(client, GC0310_AGC_ADJ, again); 88ef5fb5d4SHans de Goede if (ret) 89ef5fb5d4SHans de Goede return ret; 90ef5fb5d4SHans de Goede 91ef5fb5d4SHans de Goede return i2c_smbus_write_byte_data(client, GC0310_DGC_ADJ, dgain); 92ef5fb5d4SHans de Goede } 93ef5fb5d4SHans de Goede 94ad85094bSMauro Carvalho Chehab static int gc0310_s_ctrl(struct v4l2_ctrl *ctrl) 95ad85094bSMauro Carvalho Chehab { 96ef5fb5d4SHans de Goede struct gc0310_device *dev = 97ef5fb5d4SHans de Goede container_of(ctrl->handler, struct gc0310_device, ctrls.handler); 98ef5fb5d4SHans de Goede int ret; 99ef5fb5d4SHans de Goede 100*2726c899SHans de Goede /* Only apply changes to the controls if the device is powered up */ 101*2726c899SHans de Goede if (!pm_runtime_get_if_in_use(dev->sd.dev)) 102ef5fb5d4SHans de Goede return 0; 103ad85094bSMauro Carvalho Chehab 104ad85094bSMauro Carvalho Chehab switch (ctrl->id) { 105ef5fb5d4SHans de Goede case V4L2_CID_EXPOSURE: 106ef5fb5d4SHans de Goede ret = gc0310_exposure_set(dev, ctrl->val); 107ef5fb5d4SHans de Goede break; 108ef5fb5d4SHans de Goede case V4L2_CID_GAIN: 109ef5fb5d4SHans de Goede ret = gc0310_gain_set(dev, ctrl->val); 110ef5fb5d4SHans de Goede break; 111ad85094bSMauro Carvalho Chehab default: 112ad85094bSMauro Carvalho Chehab ret = -EINVAL; 113ef5fb5d4SHans de Goede break; 114ad85094bSMauro Carvalho Chehab } 115ef5fb5d4SHans de Goede 116*2726c899SHans de Goede pm_runtime_put(dev->sd.dev); 117ad85094bSMauro Carvalho Chehab return ret; 118ad85094bSMauro Carvalho Chehab } 119ad85094bSMauro Carvalho Chehab 120ad85094bSMauro Carvalho Chehab static const struct v4l2_ctrl_ops ctrl_ops = { 121ad85094bSMauro Carvalho Chehab .s_ctrl = gc0310_s_ctrl, 122ad85094bSMauro Carvalho Chehab }; 123ad85094bSMauro Carvalho Chehab 124ad85094bSMauro Carvalho Chehab static int power_ctrl(struct v4l2_subdev *sd, bool flag) 125ad85094bSMauro Carvalho Chehab { 126ad85094bSMauro Carvalho Chehab int ret = 0; 127ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 128bdfe0bebSMauro Carvalho Chehab 129ad85094bSMauro Carvalho Chehab if (!dev || !dev->platform_data) 130ad85094bSMauro Carvalho Chehab return -ENODEV; 131ad85094bSMauro Carvalho Chehab 132ad85094bSMauro Carvalho Chehab if (flag) { 133ad85094bSMauro Carvalho Chehab /* The upstream module driver (written to Crystal 134ad85094bSMauro Carvalho Chehab * Cove) had this logic to pulse the rails low first. 135ad85094bSMauro Carvalho Chehab * This appears to break things on the MRD7 with the 136ad85094bSMauro Carvalho Chehab * X-Powers PMIC... 137ad85094bSMauro Carvalho Chehab * 138ad85094bSMauro Carvalho Chehab * ret = dev->platform_data->v1p8_ctrl(sd, 0); 139ad85094bSMauro Carvalho Chehab * ret |= dev->platform_data->v2p8_ctrl(sd, 0); 140ad85094bSMauro Carvalho Chehab * mdelay(50); 141ad85094bSMauro Carvalho Chehab */ 142ad85094bSMauro Carvalho Chehab ret |= dev->platform_data->v1p8_ctrl(sd, 1); 143ad85094bSMauro Carvalho Chehab ret |= dev->platform_data->v2p8_ctrl(sd, 1); 144ad85094bSMauro Carvalho Chehab usleep_range(10000, 15000); 145ad85094bSMauro Carvalho Chehab } 146ad85094bSMauro Carvalho Chehab 147ad85094bSMauro Carvalho Chehab if (!flag || ret) { 148ad85094bSMauro Carvalho Chehab ret |= dev->platform_data->v1p8_ctrl(sd, 0); 149ad85094bSMauro Carvalho Chehab ret |= dev->platform_data->v2p8_ctrl(sd, 0); 150ad85094bSMauro Carvalho Chehab } 151ad85094bSMauro Carvalho Chehab return ret; 152ad85094bSMauro Carvalho Chehab } 153ad85094bSMauro Carvalho Chehab 154ad85094bSMauro Carvalho Chehab static int gpio_ctrl(struct v4l2_subdev *sd, bool flag) 155ad85094bSMauro Carvalho Chehab { 156ad85094bSMauro Carvalho Chehab int ret; 157ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 158ad85094bSMauro Carvalho Chehab 159ad85094bSMauro Carvalho Chehab if (!dev || !dev->platform_data) 160ad85094bSMauro Carvalho Chehab return -ENODEV; 161ad85094bSMauro Carvalho Chehab 162ad85094bSMauro Carvalho Chehab /* GPIO0 == "reset" (active low), GPIO1 == "power down" */ 163ad85094bSMauro Carvalho Chehab if (flag) { 164ad85094bSMauro Carvalho Chehab /* Pulse reset, then release power down */ 165ad85094bSMauro Carvalho Chehab ret = dev->platform_data->gpio0_ctrl(sd, 0); 166ad85094bSMauro Carvalho Chehab usleep_range(5000, 10000); 167ad85094bSMauro Carvalho Chehab ret |= dev->platform_data->gpio0_ctrl(sd, 1); 168ad85094bSMauro Carvalho Chehab usleep_range(10000, 15000); 169ad85094bSMauro Carvalho Chehab ret |= dev->platform_data->gpio1_ctrl(sd, 0); 170ad85094bSMauro Carvalho Chehab usleep_range(10000, 15000); 171ad85094bSMauro Carvalho Chehab } else { 172ad85094bSMauro Carvalho Chehab ret = dev->platform_data->gpio1_ctrl(sd, 1); 173ad85094bSMauro Carvalho Chehab ret |= dev->platform_data->gpio0_ctrl(sd, 0); 174ad85094bSMauro Carvalho Chehab } 175ad85094bSMauro Carvalho Chehab return ret; 176ad85094bSMauro Carvalho Chehab } 177ad85094bSMauro Carvalho Chehab 178ad85094bSMauro Carvalho Chehab static int power_up(struct v4l2_subdev *sd) 179ad85094bSMauro Carvalho Chehab { 180ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 181ad85094bSMauro Carvalho Chehab struct i2c_client *client = v4l2_get_subdevdata(sd); 182ad85094bSMauro Carvalho Chehab int ret; 183ad85094bSMauro Carvalho Chehab 184ad85094bSMauro Carvalho Chehab if (!dev->platform_data) { 185ad85094bSMauro Carvalho Chehab dev_err(&client->dev, 186ad85094bSMauro Carvalho Chehab "no camera_sensor_platform_data"); 187ad85094bSMauro Carvalho Chehab return -ENODEV; 188ad85094bSMauro Carvalho Chehab } 189ad85094bSMauro Carvalho Chehab 190ad85094bSMauro Carvalho Chehab /* power control */ 191ad85094bSMauro Carvalho Chehab ret = power_ctrl(sd, 1); 192ad85094bSMauro Carvalho Chehab if (ret) 193ad85094bSMauro Carvalho Chehab goto fail_power; 194ad85094bSMauro Carvalho Chehab 195ad85094bSMauro Carvalho Chehab /* flis clock control */ 196ad85094bSMauro Carvalho Chehab ret = dev->platform_data->flisclk_ctrl(sd, 1); 197ad85094bSMauro Carvalho Chehab if (ret) 198ad85094bSMauro Carvalho Chehab goto fail_clk; 199ad85094bSMauro Carvalho Chehab 200ad85094bSMauro Carvalho Chehab /* gpio ctrl */ 201ad85094bSMauro Carvalho Chehab ret = gpio_ctrl(sd, 1); 202ad85094bSMauro Carvalho Chehab if (ret) { 203ad85094bSMauro Carvalho Chehab ret = gpio_ctrl(sd, 1); 204ad85094bSMauro Carvalho Chehab if (ret) 205ad85094bSMauro Carvalho Chehab goto fail_gpio; 206ad85094bSMauro Carvalho Chehab } 207ad85094bSMauro Carvalho Chehab 208ad85094bSMauro Carvalho Chehab msleep(100); 209ad85094bSMauro Carvalho Chehab 210ad85094bSMauro Carvalho Chehab return 0; 211ad85094bSMauro Carvalho Chehab 212ad85094bSMauro Carvalho Chehab fail_gpio: 213ad85094bSMauro Carvalho Chehab dev->platform_data->flisclk_ctrl(sd, 0); 214ad85094bSMauro Carvalho Chehab fail_clk: 215ad85094bSMauro Carvalho Chehab power_ctrl(sd, 0); 216ad85094bSMauro Carvalho Chehab fail_power: 217ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "sensor power-up failed\n"); 218ad85094bSMauro Carvalho Chehab 219ad85094bSMauro Carvalho Chehab return ret; 220ad85094bSMauro Carvalho Chehab } 221ad85094bSMauro Carvalho Chehab 222ad85094bSMauro Carvalho Chehab static int power_down(struct v4l2_subdev *sd) 223ad85094bSMauro Carvalho Chehab { 224ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 225ad85094bSMauro Carvalho Chehab struct i2c_client *client = v4l2_get_subdevdata(sd); 226ad85094bSMauro Carvalho Chehab int ret = 0; 227ad85094bSMauro Carvalho Chehab 228ad85094bSMauro Carvalho Chehab if (!dev->platform_data) { 229ad85094bSMauro Carvalho Chehab dev_err(&client->dev, 230ad85094bSMauro Carvalho Chehab "no camera_sensor_platform_data"); 231ad85094bSMauro Carvalho Chehab return -ENODEV; 232ad85094bSMauro Carvalho Chehab } 233ad85094bSMauro Carvalho Chehab 234ad85094bSMauro Carvalho Chehab /* gpio ctrl */ 235ad85094bSMauro Carvalho Chehab ret = gpio_ctrl(sd, 0); 236ad85094bSMauro Carvalho Chehab if (ret) { 237ad85094bSMauro Carvalho Chehab ret = gpio_ctrl(sd, 0); 238ad85094bSMauro Carvalho Chehab if (ret) 239ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "gpio failed 2\n"); 240ad85094bSMauro Carvalho Chehab } 241ad85094bSMauro Carvalho Chehab 242ad85094bSMauro Carvalho Chehab ret = dev->platform_data->flisclk_ctrl(sd, 0); 243ad85094bSMauro Carvalho Chehab if (ret) 244ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "flisclk failed\n"); 245ad85094bSMauro Carvalho Chehab 246ad85094bSMauro Carvalho Chehab /* power control */ 247ad85094bSMauro Carvalho Chehab ret = power_ctrl(sd, 0); 248ad85094bSMauro Carvalho Chehab if (ret) 249ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "vprog failed.\n"); 250ad85094bSMauro Carvalho Chehab 251ad85094bSMauro Carvalho Chehab return ret; 252ad85094bSMauro Carvalho Chehab } 253ad85094bSMauro Carvalho Chehab 2549783b96aSHans de Goede static struct v4l2_mbus_framefmt * 2559783b96aSHans de Goede gc0310_get_pad_format(struct gc0310_device *dev, 2569783b96aSHans de Goede struct v4l2_subdev_state *state, 2579783b96aSHans de Goede unsigned int pad, enum v4l2_subdev_format_whence which) 258ad85094bSMauro Carvalho Chehab { 2599783b96aSHans de Goede if (which == V4L2_SUBDEV_FORMAT_TRY) 2609783b96aSHans de Goede return v4l2_subdev_get_try_format(&dev->sd, state, pad); 261ad85094bSMauro Carvalho Chehab 2629783b96aSHans de Goede return &dev->mode.fmt; 263ad85094bSMauro Carvalho Chehab } 264ad85094bSMauro Carvalho Chehab 2659783b96aSHans de Goede /* The GC0310 currently only supports 1 fixed fmt */ 2669783b96aSHans de Goede static void gc0310_fill_format(struct v4l2_mbus_framefmt *fmt) 2679783b96aSHans de Goede { 2689783b96aSHans de Goede memset(fmt, 0, sizeof(*fmt)); 2699783b96aSHans de Goede fmt->width = GC0310_NATIVE_WIDTH; 2709783b96aSHans de Goede fmt->height = GC0310_NATIVE_HEIGHT; 2719783b96aSHans de Goede fmt->field = V4L2_FIELD_NONE; 2729783b96aSHans de Goede fmt->code = MEDIA_BUS_FMT_SGRBG8_1X8; 273ad85094bSMauro Carvalho Chehab } 274ad85094bSMauro Carvalho Chehab 275ad85094bSMauro Carvalho Chehab static int gc0310_set_fmt(struct v4l2_subdev *sd, 2760d346d2aSTomi Valkeinen struct v4l2_subdev_state *sd_state, 277ad85094bSMauro Carvalho Chehab struct v4l2_subdev_format *format) 278ad85094bSMauro Carvalho Chehab { 2799783b96aSHans de Goede struct gc0310_device *dev = to_gc0310_sensor(sd); 2809783b96aSHans de Goede struct v4l2_mbus_framefmt *fmt; 281bdfe0bebSMauro Carvalho Chehab 2829783b96aSHans de Goede fmt = gc0310_get_pad_format(dev, sd_state, format->pad, format->which); 2839783b96aSHans de Goede gc0310_fill_format(fmt); 284ad85094bSMauro Carvalho Chehab 2859783b96aSHans de Goede format->format = *fmt; 2869783b96aSHans de Goede return 0; 287ad85094bSMauro Carvalho Chehab } 288ad85094bSMauro Carvalho Chehab 289ad85094bSMauro Carvalho Chehab static int gc0310_get_fmt(struct v4l2_subdev *sd, 2900d346d2aSTomi Valkeinen struct v4l2_subdev_state *sd_state, 291ad85094bSMauro Carvalho Chehab struct v4l2_subdev_format *format) 292ad85094bSMauro Carvalho Chehab { 293ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 2949783b96aSHans de Goede struct v4l2_mbus_framefmt *fmt; 295ad85094bSMauro Carvalho Chehab 2969783b96aSHans de Goede fmt = gc0310_get_pad_format(dev, sd_state, format->pad, format->which); 2979783b96aSHans de Goede format->format = *fmt; 298ad85094bSMauro Carvalho Chehab return 0; 299ad85094bSMauro Carvalho Chehab } 300ad85094bSMauro Carvalho Chehab 301ad85094bSMauro Carvalho Chehab static int gc0310_detect(struct i2c_client *client) 302ad85094bSMauro Carvalho Chehab { 303ad85094bSMauro Carvalho Chehab struct i2c_adapter *adapter = client->adapter; 304ad85094bSMauro Carvalho Chehab int ret; 305ad85094bSMauro Carvalho Chehab 306ad85094bSMauro Carvalho Chehab if (!i2c_check_functionality(adapter, I2C_FUNC_I2C)) 307ad85094bSMauro Carvalho Chehab return -ENODEV; 308ad85094bSMauro Carvalho Chehab 30965e5ef2fSHans de Goede ret = i2c_smbus_read_word_swapped(client, GC0310_SC_CMMN_CHIP_ID_H); 31065e5ef2fSHans de Goede if (ret < 0) { 31165e5ef2fSHans de Goede dev_err(&client->dev, "read sensor_id failed: %d\n", ret); 312ad85094bSMauro Carvalho Chehab return -ENODEV; 313ad85094bSMauro Carvalho Chehab } 314ad85094bSMauro Carvalho Chehab 31565e5ef2fSHans de Goede dev_dbg(&client->dev, "sensor ID = 0x%x\n", ret); 31665e5ef2fSHans de Goede 31765e5ef2fSHans de Goede if (ret != GC0310_ID) { 31865e5ef2fSHans de Goede dev_err(&client->dev, "sensor ID error, read id = 0x%x, target id = 0x%x\n", 31965e5ef2fSHans de Goede ret, GC0310_ID); 320ad85094bSMauro Carvalho Chehab return -ENODEV; 321ad85094bSMauro Carvalho Chehab } 322ad85094bSMauro Carvalho Chehab 323ad85094bSMauro Carvalho Chehab dev_dbg(&client->dev, "detect gc0310 success\n"); 324ad85094bSMauro Carvalho Chehab 325ad85094bSMauro Carvalho Chehab return 0; 326ad85094bSMauro Carvalho Chehab } 327ad85094bSMauro Carvalho Chehab 328ad85094bSMauro Carvalho Chehab static int gc0310_s_stream(struct v4l2_subdev *sd, int enable) 329ad85094bSMauro Carvalho Chehab { 330ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 331ad85094bSMauro Carvalho Chehab struct i2c_client *client = v4l2_get_subdevdata(sd); 332*2726c899SHans de Goede int ret = 0; 333ad85094bSMauro Carvalho Chehab 3342dfc978aSDeepak R Varma dev_dbg(&client->dev, "%s S enable=%d\n", __func__, enable); 335ad85094bSMauro Carvalho Chehab mutex_lock(&dev->input_lock); 336ad85094bSMauro Carvalho Chehab 337*2726c899SHans de Goede if (dev->is_streaming == enable) { 338*2726c899SHans de Goede dev_warn(&client->dev, "stream already %s\n", enable ? "started" : "stopped"); 339b6763b22SHans de Goede goto error_unlock; 340*2726c899SHans de Goede } 341*2726c899SHans de Goede 342*2726c899SHans de Goede if (enable) { 343*2726c899SHans de Goede ret = pm_runtime_get_sync(&client->dev); 344*2726c899SHans de Goede if (ret < 0) 345*2726c899SHans de Goede goto error_power_down; 346b6763b22SHans de Goede 347b6763b22SHans de Goede ret = gc0310_write_reg_array(client, gc0310_reset_register, 348b6763b22SHans de Goede ARRAY_SIZE(gc0310_reset_register)); 349b6763b22SHans de Goede if (ret) 350b6763b22SHans de Goede goto error_power_down; 351b6763b22SHans de Goede 352b6763b22SHans de Goede ret = gc0310_write_reg_array(client, gc0310_VGA_30fps, 353b6763b22SHans de Goede ARRAY_SIZE(gc0310_VGA_30fps)); 354b6763b22SHans de Goede if (ret) 355b6763b22SHans de Goede goto error_power_down; 356b6763b22SHans de Goede 357b6763b22SHans de Goede /* restore value of all ctrls */ 358b6763b22SHans de Goede ret = __v4l2_ctrl_handler_setup(&dev->ctrls.handler); 359b6763b22SHans de Goede if (ret) 360b6763b22SHans de Goede goto error_power_down; 361b6763b22SHans de Goede 362ad85094bSMauro Carvalho Chehab /* enable per frame MIPI and sensor ctrl reset */ 36365e5ef2fSHans de Goede ret = i2c_smbus_write_byte_data(client, 0xFE, 0x30); 3642b2297b1SHans de Goede if (ret) 365b6763b22SHans de Goede goto error_power_down; 366ad85094bSMauro Carvalho Chehab } 367ad85094bSMauro Carvalho Chehab 36865e5ef2fSHans de Goede ret = i2c_smbus_write_byte_data(client, GC0310_RESET_RELATED, GC0310_REGISTER_PAGE_3); 3692b2297b1SHans de Goede if (ret) 370b6763b22SHans de Goede goto error_power_down; 371ad85094bSMauro Carvalho Chehab 37265e5ef2fSHans de Goede ret = i2c_smbus_write_byte_data(client, GC0310_SW_STREAM, 37365e5ef2fSHans de Goede enable ? GC0310_START_STREAMING : GC0310_STOP_STREAMING); 3742b2297b1SHans de Goede if (ret) 375b6763b22SHans de Goede goto error_power_down; 376ad85094bSMauro Carvalho Chehab 37765e5ef2fSHans de Goede ret = i2c_smbus_write_byte_data(client, GC0310_RESET_RELATED, GC0310_REGISTER_PAGE_0); 3782b2297b1SHans de Goede if (ret) 379b6763b22SHans de Goede goto error_power_down; 380b6763b22SHans de Goede 381b6763b22SHans de Goede if (!enable) 382*2726c899SHans de Goede pm_runtime_put(&client->dev); 383ad85094bSMauro Carvalho Chehab 384*2726c899SHans de Goede dev->is_streaming = enable; 385ad85094bSMauro Carvalho Chehab mutex_unlock(&dev->input_lock); 3862b2297b1SHans de Goede return 0; 3872b2297b1SHans de Goede 388b6763b22SHans de Goede error_power_down: 389*2726c899SHans de Goede pm_runtime_put(&client->dev); 390*2726c899SHans de Goede dev->is_streaming = false; 3912b2297b1SHans de Goede error_unlock: 3922b2297b1SHans de Goede mutex_unlock(&dev->input_lock); 393ad85094bSMauro Carvalho Chehab return ret; 394ad85094bSMauro Carvalho Chehab } 395ad85094bSMauro Carvalho Chehab 396ad85094bSMauro Carvalho Chehab static int gc0310_s_config(struct v4l2_subdev *sd, 397ad85094bSMauro Carvalho Chehab int irq, void *platform_data) 398ad85094bSMauro Carvalho Chehab { 399ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 400ad85094bSMauro Carvalho Chehab struct i2c_client *client = v4l2_get_subdevdata(sd); 401ad85094bSMauro Carvalho Chehab int ret = 0; 402ad85094bSMauro Carvalho Chehab 403ad85094bSMauro Carvalho Chehab if (!platform_data) 404ad85094bSMauro Carvalho Chehab return -ENODEV; 405ad85094bSMauro Carvalho Chehab 406ad85094bSMauro Carvalho Chehab dev->platform_data = 407ad85094bSMauro Carvalho Chehab (struct camera_sensor_platform_data *)platform_data; 408ad85094bSMauro Carvalho Chehab 409ad85094bSMauro Carvalho Chehab mutex_lock(&dev->input_lock); 410ad85094bSMauro Carvalho Chehab 411*2726c899SHans de Goede ret = pm_runtime_get_sync(&client->dev); 412*2726c899SHans de Goede if (ret < 0) { 413ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "gc0310 power-up err.\n"); 414ad85094bSMauro Carvalho Chehab goto fail_power_on; 415ad85094bSMauro Carvalho Chehab } 416ad85094bSMauro Carvalho Chehab 417ad85094bSMauro Carvalho Chehab ret = dev->platform_data->csi_cfg(sd, 1); 418ad85094bSMauro Carvalho Chehab if (ret) 419ad85094bSMauro Carvalho Chehab goto fail_csi_cfg; 420ad85094bSMauro Carvalho Chehab 421ad85094bSMauro Carvalho Chehab /* config & detect sensor */ 422ad85094bSMauro Carvalho Chehab ret = gc0310_detect(client); 423ad85094bSMauro Carvalho Chehab if (ret) { 424ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "gc0310_detect err s_config.\n"); 425ad85094bSMauro Carvalho Chehab goto fail_csi_cfg; 426ad85094bSMauro Carvalho Chehab } 427ad85094bSMauro Carvalho Chehab 428ad85094bSMauro Carvalho Chehab /* turn off sensor, after probed */ 429*2726c899SHans de Goede pm_runtime_put(&client->dev); 430ad85094bSMauro Carvalho Chehab mutex_unlock(&dev->input_lock); 431ad85094bSMauro Carvalho Chehab 432ad85094bSMauro Carvalho Chehab return 0; 433ad85094bSMauro Carvalho Chehab 434ad85094bSMauro Carvalho Chehab fail_csi_cfg: 435ad85094bSMauro Carvalho Chehab dev->platform_data->csi_cfg(sd, 0); 436ad85094bSMauro Carvalho Chehab fail_power_on: 437*2726c899SHans de Goede pm_runtime_put(&client->dev); 438ad85094bSMauro Carvalho Chehab mutex_unlock(&dev->input_lock); 439ad85094bSMauro Carvalho Chehab return ret; 440ad85094bSMauro Carvalho Chehab } 441ad85094bSMauro Carvalho Chehab 442ad85094bSMauro Carvalho Chehab static int gc0310_g_frame_interval(struct v4l2_subdev *sd, 443ad85094bSMauro Carvalho Chehab struct v4l2_subdev_frame_interval *interval) 444ad85094bSMauro Carvalho Chehab { 445ad85094bSMauro Carvalho Chehab interval->interval.numerator = 1; 4469783b96aSHans de Goede interval->interval.denominator = GC0310_FPS; 447ad85094bSMauro Carvalho Chehab 448ad85094bSMauro Carvalho Chehab return 0; 449ad85094bSMauro Carvalho Chehab } 450ad85094bSMauro Carvalho Chehab 451ad85094bSMauro Carvalho Chehab static int gc0310_enum_mbus_code(struct v4l2_subdev *sd, 4520d346d2aSTomi Valkeinen struct v4l2_subdev_state *sd_state, 453ad85094bSMauro Carvalho Chehab struct v4l2_subdev_mbus_code_enum *code) 454ad85094bSMauro Carvalho Chehab { 4559783b96aSHans de Goede /* We support only a single format */ 4569783b96aSHans de Goede if (code->index) 457ad85094bSMauro Carvalho Chehab return -EINVAL; 458ad85094bSMauro Carvalho Chehab 459ad85094bSMauro Carvalho Chehab code->code = MEDIA_BUS_FMT_SGRBG8_1X8; 460ad85094bSMauro Carvalho Chehab return 0; 461ad85094bSMauro Carvalho Chehab } 462ad85094bSMauro Carvalho Chehab 463ad85094bSMauro Carvalho Chehab static int gc0310_enum_frame_size(struct v4l2_subdev *sd, 4640d346d2aSTomi Valkeinen struct v4l2_subdev_state *sd_state, 465ad85094bSMauro Carvalho Chehab struct v4l2_subdev_frame_size_enum *fse) 466ad85094bSMauro Carvalho Chehab { 4679783b96aSHans de Goede /* We support only a single resolution */ 4689783b96aSHans de Goede if (fse->index) 469ad85094bSMauro Carvalho Chehab return -EINVAL; 470ad85094bSMauro Carvalho Chehab 4719783b96aSHans de Goede fse->min_width = GC0310_NATIVE_WIDTH; 4729783b96aSHans de Goede fse->max_width = GC0310_NATIVE_WIDTH; 4739783b96aSHans de Goede fse->min_height = GC0310_NATIVE_HEIGHT; 4749783b96aSHans de Goede fse->max_height = GC0310_NATIVE_HEIGHT; 475ad85094bSMauro Carvalho Chehab 476ad85094bSMauro Carvalho Chehab return 0; 477ad85094bSMauro Carvalho Chehab } 478ad85094bSMauro Carvalho Chehab 479ad85094bSMauro Carvalho Chehab static int gc0310_g_skip_frames(struct v4l2_subdev *sd, u32 *frames) 480ad85094bSMauro Carvalho Chehab { 4819783b96aSHans de Goede *frames = GC0310_SKIP_FRAMES; 482ad85094bSMauro Carvalho Chehab return 0; 483ad85094bSMauro Carvalho Chehab } 484ad85094bSMauro Carvalho Chehab 485ad85094bSMauro Carvalho Chehab static const struct v4l2_subdev_sensor_ops gc0310_sensor_ops = { 486ad85094bSMauro Carvalho Chehab .g_skip_frames = gc0310_g_skip_frames, 487ad85094bSMauro Carvalho Chehab }; 488ad85094bSMauro Carvalho Chehab 489ad85094bSMauro Carvalho Chehab static const struct v4l2_subdev_video_ops gc0310_video_ops = { 490ad85094bSMauro Carvalho Chehab .s_stream = gc0310_s_stream, 491ad85094bSMauro Carvalho Chehab .g_frame_interval = gc0310_g_frame_interval, 492ad85094bSMauro Carvalho Chehab }; 493ad85094bSMauro Carvalho Chehab 494ad85094bSMauro Carvalho Chehab static const struct v4l2_subdev_pad_ops gc0310_pad_ops = { 495ad85094bSMauro Carvalho Chehab .enum_mbus_code = gc0310_enum_mbus_code, 496ad85094bSMauro Carvalho Chehab .enum_frame_size = gc0310_enum_frame_size, 497ad85094bSMauro Carvalho Chehab .get_fmt = gc0310_get_fmt, 498ad85094bSMauro Carvalho Chehab .set_fmt = gc0310_set_fmt, 499ad85094bSMauro Carvalho Chehab }; 500ad85094bSMauro Carvalho Chehab 501ad85094bSMauro Carvalho Chehab static const struct v4l2_subdev_ops gc0310_ops = { 502ad85094bSMauro Carvalho Chehab .video = &gc0310_video_ops, 503ad85094bSMauro Carvalho Chehab .pad = &gc0310_pad_ops, 504ad85094bSMauro Carvalho Chehab .sensor = &gc0310_sensor_ops, 505ad85094bSMauro Carvalho Chehab }; 506ad85094bSMauro Carvalho Chehab 507ef5fb5d4SHans de Goede static int gc0310_init_controls(struct gc0310_device *dev) 508ef5fb5d4SHans de Goede { 509ef5fb5d4SHans de Goede struct v4l2_ctrl_handler *hdl = &dev->ctrls.handler; 510ef5fb5d4SHans de Goede 511ef5fb5d4SHans de Goede v4l2_ctrl_handler_init(hdl, 2); 512ef5fb5d4SHans de Goede 513ef5fb5d4SHans de Goede /* Use the same lock for controls as for everything else */ 514ef5fb5d4SHans de Goede hdl->lock = &dev->input_lock; 515ef5fb5d4SHans de Goede dev->sd.ctrl_handler = hdl; 516ef5fb5d4SHans de Goede 517ef5fb5d4SHans de Goede dev->ctrls.exposure = 518ef5fb5d4SHans de Goede v4l2_ctrl_new_std(hdl, &ctrl_ops, V4L2_CID_EXPOSURE, 0, 4095, 1, 1023); 519ef5fb5d4SHans de Goede 520ef5fb5d4SHans de Goede /* 32 steps at base gain 1 + 64 half steps at base gain 2 */ 521ef5fb5d4SHans de Goede dev->ctrls.gain = 522ef5fb5d4SHans de Goede v4l2_ctrl_new_std(hdl, &ctrl_ops, V4L2_CID_GAIN, 0, 95, 1, 31); 523ef5fb5d4SHans de Goede 524ef5fb5d4SHans de Goede return hdl->error; 525ef5fb5d4SHans de Goede } 526ef5fb5d4SHans de Goede 527ed5c2f5fSUwe Kleine-König static void gc0310_remove(struct i2c_client *client) 528ad85094bSMauro Carvalho Chehab { 529ad85094bSMauro Carvalho Chehab struct v4l2_subdev *sd = i2c_get_clientdata(client); 530ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 531bdfe0bebSMauro Carvalho Chehab 532ad85094bSMauro Carvalho Chehab dev_dbg(&client->dev, "gc0310_remove...\n"); 533ad85094bSMauro Carvalho Chehab 534ad85094bSMauro Carvalho Chehab dev->platform_data->csi_cfg(sd, 0); 535ad85094bSMauro Carvalho Chehab 536ad85094bSMauro Carvalho Chehab v4l2_device_unregister_subdev(sd); 537ad85094bSMauro Carvalho Chehab media_entity_cleanup(&dev->sd.entity); 538ef5fb5d4SHans de Goede v4l2_ctrl_handler_free(&dev->ctrls.handler); 539*2726c899SHans de Goede pm_runtime_disable(&client->dev); 540ad85094bSMauro Carvalho Chehab kfree(dev); 541ad85094bSMauro Carvalho Chehab } 542ad85094bSMauro Carvalho Chehab 543ad85094bSMauro Carvalho Chehab static int gc0310_probe(struct i2c_client *client) 544ad85094bSMauro Carvalho Chehab { 545ad85094bSMauro Carvalho Chehab struct gc0310_device *dev; 546ad85094bSMauro Carvalho Chehab int ret; 547ad85094bSMauro Carvalho Chehab void *pdata; 548c03496b3SMauro Carvalho Chehab 549ad85094bSMauro Carvalho Chehab dev = kzalloc(sizeof(*dev), GFP_KERNEL); 550ad85094bSMauro Carvalho Chehab if (!dev) 551ad85094bSMauro Carvalho Chehab return -ENOMEM; 552ad85094bSMauro Carvalho Chehab 553ad85094bSMauro Carvalho Chehab mutex_init(&dev->input_lock); 554bdfe0bebSMauro Carvalho Chehab v4l2_i2c_subdev_init(&dev->sd, client, &gc0310_ops); 5559783b96aSHans de Goede gc0310_fill_format(&dev->mode.fmt); 556ad85094bSMauro Carvalho Chehab 557ad85094bSMauro Carvalho Chehab pdata = gmin_camera_platform_data(&dev->sd, 558ad85094bSMauro Carvalho Chehab ATOMISP_INPUT_FORMAT_RAW_8, 559ad85094bSMauro Carvalho Chehab atomisp_bayer_order_grbg); 560ad85094bSMauro Carvalho Chehab if (!pdata) { 561ad85094bSMauro Carvalho Chehab ret = -EINVAL; 562ad85094bSMauro Carvalho Chehab goto out_free; 563ad85094bSMauro Carvalho Chehab } 564ad85094bSMauro Carvalho Chehab 565*2726c899SHans de Goede pm_runtime_set_suspended(&client->dev); 566*2726c899SHans de Goede pm_runtime_enable(&client->dev); 567*2726c899SHans de Goede pm_runtime_set_autosuspend_delay(&client->dev, 1000); 568*2726c899SHans de Goede pm_runtime_use_autosuspend(&client->dev); 569*2726c899SHans de Goede 570ad85094bSMauro Carvalho Chehab ret = gc0310_s_config(&dev->sd, client->irq, pdata); 571*2726c899SHans de Goede if (ret) { 572*2726c899SHans de Goede gc0310_remove(client); 573*2726c899SHans de Goede return ret; 574*2726c899SHans de Goede } 575ad85094bSMauro Carvalho Chehab 576ad85094bSMauro Carvalho Chehab ret = atomisp_register_i2c_module(&dev->sd, pdata, RAW_CAMERA); 577*2726c899SHans de Goede if (ret) { 578*2726c899SHans de Goede gc0310_remove(client); 579*2726c899SHans de Goede return ret; 580*2726c899SHans de Goede } 581ad85094bSMauro Carvalho Chehab 582ad85094bSMauro Carvalho Chehab dev->sd.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE; 583ad85094bSMauro Carvalho Chehab dev->pad.flags = MEDIA_PAD_FL_SOURCE; 584ad85094bSMauro Carvalho Chehab dev->sd.entity.function = MEDIA_ENT_F_CAM_SENSOR; 585ef5fb5d4SHans de Goede 586ef5fb5d4SHans de Goede ret = gc0310_init_controls(dev); 587ad85094bSMauro Carvalho Chehab if (ret) { 588ad85094bSMauro Carvalho Chehab gc0310_remove(client); 589ad85094bSMauro Carvalho Chehab return ret; 590ad85094bSMauro Carvalho Chehab } 591ad85094bSMauro Carvalho Chehab 592ad85094bSMauro Carvalho Chehab ret = media_entity_pads_init(&dev->sd.entity, 1, &dev->pad); 593ad85094bSMauro Carvalho Chehab if (ret) 594ad85094bSMauro Carvalho Chehab gc0310_remove(client); 595ad85094bSMauro Carvalho Chehab 596ad85094bSMauro Carvalho Chehab return ret; 597ad85094bSMauro Carvalho Chehab out_free: 598ad85094bSMauro Carvalho Chehab v4l2_device_unregister_subdev(&dev->sd); 599ad85094bSMauro Carvalho Chehab kfree(dev); 600ad85094bSMauro Carvalho Chehab return ret; 601ad85094bSMauro Carvalho Chehab } 602ad85094bSMauro Carvalho Chehab 603*2726c899SHans de Goede static int gc0310_suspend(struct device *dev) 604*2726c899SHans de Goede { 605*2726c899SHans de Goede struct v4l2_subdev *sd = dev_get_drvdata(dev); 606*2726c899SHans de Goede 607*2726c899SHans de Goede return power_down(sd); 608*2726c899SHans de Goede } 609*2726c899SHans de Goede 610*2726c899SHans de Goede static int gc0310_resume(struct device *dev) 611*2726c899SHans de Goede { 612*2726c899SHans de Goede struct v4l2_subdev *sd = dev_get_drvdata(dev); 613*2726c899SHans de Goede 614*2726c899SHans de Goede return power_up(sd); 615*2726c899SHans de Goede } 616*2726c899SHans de Goede 617*2726c899SHans de Goede static DEFINE_RUNTIME_DEV_PM_OPS(gc0310_pm_ops, gc0310_suspend, gc0310_resume, NULL); 618*2726c899SHans de Goede 619ad85094bSMauro Carvalho Chehab static const struct acpi_device_id gc0310_acpi_match[] = { 620ad85094bSMauro Carvalho Chehab {"XXGC0310"}, 621ad85094bSMauro Carvalho Chehab {"INT0310"}, 622ad85094bSMauro Carvalho Chehab {}, 623ad85094bSMauro Carvalho Chehab }; 624ad85094bSMauro Carvalho Chehab MODULE_DEVICE_TABLE(acpi, gc0310_acpi_match); 625ad85094bSMauro Carvalho Chehab 626ad85094bSMauro Carvalho Chehab static struct i2c_driver gc0310_driver = { 627ad85094bSMauro Carvalho Chehab .driver = { 628ad85094bSMauro Carvalho Chehab .name = "gc0310", 629*2726c899SHans de Goede .pm = pm_sleep_ptr(&gc0310_pm_ops), 630ad85094bSMauro Carvalho Chehab .acpi_match_table = gc0310_acpi_match, 631ad85094bSMauro Carvalho Chehab }, 632ad85094bSMauro Carvalho Chehab .probe_new = gc0310_probe, 633ad85094bSMauro Carvalho Chehab .remove = gc0310_remove, 634ad85094bSMauro Carvalho Chehab }; 635ad85094bSMauro Carvalho Chehab module_i2c_driver(gc0310_driver); 636ad85094bSMauro Carvalho Chehab 637ad85094bSMauro Carvalho Chehab MODULE_AUTHOR("Lai, Angie <angie.lai@intel.com>"); 638ad85094bSMauro Carvalho Chehab MODULE_DESCRIPTION("A low-level driver for GalaxyCore GC0310 sensors"); 639ad85094bSMauro Carvalho Chehab MODULE_LICENSE("GPL"); 640