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 /* i2c read/write stuff */ 38ad85094bSMauro Carvalho Chehab static int gc0310_read_reg(struct i2c_client *client, 39ad85094bSMauro Carvalho Chehab u16 data_length, u8 reg, u8 *val) 40ad85094bSMauro Carvalho Chehab { 41ad85094bSMauro Carvalho Chehab int err; 42ad85094bSMauro Carvalho Chehab struct i2c_msg msg[2]; 43ad85094bSMauro Carvalho Chehab unsigned char data[1]; 44ad85094bSMauro Carvalho Chehab 45ad85094bSMauro Carvalho Chehab if (!client->adapter) { 46ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "%s error, no client->adapter\n", 47ad85094bSMauro Carvalho Chehab __func__); 48ad85094bSMauro Carvalho Chehab return -ENODEV; 49ad85094bSMauro Carvalho Chehab } 50ad85094bSMauro Carvalho Chehab 51ad85094bSMauro Carvalho Chehab if (data_length != GC0310_8BIT) { 52ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "%s error, invalid data length\n", 53ad85094bSMauro Carvalho Chehab __func__); 54ad85094bSMauro Carvalho Chehab return -EINVAL; 55ad85094bSMauro Carvalho Chehab } 56ad85094bSMauro Carvalho Chehab 57ad85094bSMauro Carvalho Chehab memset(msg, 0, sizeof(msg)); 58ad85094bSMauro Carvalho Chehab 59ad85094bSMauro Carvalho Chehab msg[0].addr = client->addr; 60ad85094bSMauro Carvalho Chehab msg[0].flags = 0; 61ad85094bSMauro Carvalho Chehab msg[0].len = I2C_MSG_LENGTH; 62ad85094bSMauro Carvalho Chehab msg[0].buf = data; 63ad85094bSMauro Carvalho Chehab 64ad85094bSMauro Carvalho Chehab /* high byte goes out first */ 65ad85094bSMauro Carvalho Chehab data[0] = (u8)(reg & 0xff); 66ad85094bSMauro Carvalho Chehab 67ad85094bSMauro Carvalho Chehab msg[1].addr = client->addr; 68ad85094bSMauro Carvalho Chehab msg[1].len = data_length; 69ad85094bSMauro Carvalho Chehab msg[1].flags = I2C_M_RD; 70ad85094bSMauro Carvalho Chehab msg[1].buf = data; 71ad85094bSMauro Carvalho Chehab 72ad85094bSMauro Carvalho Chehab err = i2c_transfer(client->adapter, msg, 2); 73ad85094bSMauro Carvalho Chehab if (err != 2) { 74ad85094bSMauro Carvalho Chehab if (err >= 0) 75ad85094bSMauro Carvalho Chehab err = -EIO; 76ad85094bSMauro Carvalho Chehab dev_err(&client->dev, 77ad85094bSMauro Carvalho Chehab "read from offset 0x%x error %d", reg, err); 78ad85094bSMauro Carvalho Chehab return err; 79ad85094bSMauro Carvalho Chehab } 80ad85094bSMauro Carvalho Chehab 81ad85094bSMauro Carvalho Chehab *val = 0; 82ad85094bSMauro Carvalho Chehab /* high byte comes first */ 83ad85094bSMauro Carvalho Chehab if (data_length == GC0310_8BIT) 84ad85094bSMauro Carvalho Chehab *val = (u8)data[0]; 85ad85094bSMauro Carvalho Chehab 86ad85094bSMauro Carvalho Chehab return 0; 87ad85094bSMauro Carvalho Chehab } 88ad85094bSMauro Carvalho Chehab 89ad85094bSMauro Carvalho Chehab static int gc0310_i2c_write(struct i2c_client *client, u16 len, u8 *data) 90ad85094bSMauro Carvalho Chehab { 91ad85094bSMauro Carvalho Chehab struct i2c_msg msg; 92ad85094bSMauro Carvalho Chehab const int num_msg = 1; 93ad85094bSMauro Carvalho Chehab int ret; 94ad85094bSMauro Carvalho Chehab 95ad85094bSMauro Carvalho Chehab msg.addr = client->addr; 96ad85094bSMauro Carvalho Chehab msg.flags = 0; 97ad85094bSMauro Carvalho Chehab msg.len = len; 98ad85094bSMauro Carvalho Chehab msg.buf = data; 99ad85094bSMauro Carvalho Chehab ret = i2c_transfer(client->adapter, &msg, 1); 100ad85094bSMauro Carvalho Chehab 101ad85094bSMauro Carvalho Chehab return ret == num_msg ? 0 : -EIO; 102ad85094bSMauro Carvalho Chehab } 103ad85094bSMauro Carvalho Chehab 104ad85094bSMauro Carvalho Chehab static int gc0310_write_reg(struct i2c_client *client, u16 data_length, 105ad85094bSMauro Carvalho Chehab u8 reg, u8 val) 106ad85094bSMauro Carvalho Chehab { 107ad85094bSMauro Carvalho Chehab int ret; 108ad85094bSMauro Carvalho Chehab unsigned char data[2] = {0}; 109ad85094bSMauro Carvalho Chehab u8 *wreg = (u8 *)data; 110ad85094bSMauro Carvalho Chehab const u16 len = data_length + sizeof(u8); /* 8-bit address + data */ 111ad85094bSMauro Carvalho Chehab 112ad85094bSMauro Carvalho Chehab if (data_length != GC0310_8BIT) { 113ad85094bSMauro Carvalho Chehab dev_err(&client->dev, 114ad85094bSMauro Carvalho Chehab "%s error, invalid data_length\n", __func__); 115ad85094bSMauro Carvalho Chehab return -EINVAL; 116ad85094bSMauro Carvalho Chehab } 117ad85094bSMauro Carvalho Chehab 118ad85094bSMauro Carvalho Chehab /* high byte goes out first */ 119ad85094bSMauro Carvalho Chehab *wreg = (u8)(reg & 0xff); 120ad85094bSMauro Carvalho Chehab 121ad85094bSMauro Carvalho Chehab if (data_length == GC0310_8BIT) 122ad85094bSMauro Carvalho Chehab data[1] = (u8)(val); 123ad85094bSMauro Carvalho Chehab 124ad85094bSMauro Carvalho Chehab ret = gc0310_i2c_write(client, len, data); 125ad85094bSMauro Carvalho Chehab if (ret) 126ad85094bSMauro Carvalho Chehab dev_err(&client->dev, 127ad85094bSMauro Carvalho Chehab "write error: wrote 0x%x to offset 0x%x error %d", 128ad85094bSMauro Carvalho Chehab val, reg, ret); 129ad85094bSMauro Carvalho Chehab 130ad85094bSMauro Carvalho Chehab return ret; 131ad85094bSMauro Carvalho Chehab } 132ad85094bSMauro Carvalho Chehab 133ad85094bSMauro Carvalho Chehab /* 134ad85094bSMauro Carvalho Chehab * gc0310_write_reg_array - Initializes a list of GC0310 registers 135ad85094bSMauro Carvalho Chehab * @client: i2c driver client structure 136ad85094bSMauro Carvalho Chehab * @reglist: list of registers to be written 137*bfe06aeeSHans de Goede * @count: number of register, value pairs in the list 138ad85094bSMauro Carvalho Chehab * 139ad85094bSMauro Carvalho Chehab * This function initializes a list of registers. When consecutive addresses 140ad85094bSMauro Carvalho Chehab * are found in a row on the list, this function creates a buffer and sends 141ad85094bSMauro Carvalho Chehab * consecutive data in a single i2c_transfer(). 142ad85094bSMauro Carvalho Chehab * 143ad85094bSMauro Carvalho Chehab * __gc0310_flush_reg_array, __gc0310_buf_reg_array() and 144ad85094bSMauro Carvalho Chehab * __gc0310_write_reg_is_consecutive() are internal functions to 145ad85094bSMauro Carvalho Chehab * gc0310_write_reg_array_fast() and should be not used anywhere else. 146ad85094bSMauro Carvalho Chehab * 147ad85094bSMauro Carvalho Chehab */ 148ad85094bSMauro Carvalho Chehab 149ad85094bSMauro Carvalho Chehab static int __gc0310_flush_reg_array(struct i2c_client *client, 150ad85094bSMauro Carvalho Chehab struct gc0310_write_ctrl *ctrl) 151ad85094bSMauro Carvalho Chehab { 152ad85094bSMauro Carvalho Chehab u16 size; 153ad85094bSMauro Carvalho Chehab 154ad85094bSMauro Carvalho Chehab if (ctrl->index == 0) 155ad85094bSMauro Carvalho Chehab return 0; 156ad85094bSMauro Carvalho Chehab 157ad85094bSMauro Carvalho Chehab size = sizeof(u8) + ctrl->index; /* 8-bit address + data */ 158ad85094bSMauro Carvalho Chehab ctrl->buffer.addr = (u8)(ctrl->buffer.addr); 159ad85094bSMauro Carvalho Chehab ctrl->index = 0; 160ad85094bSMauro Carvalho Chehab 161ad85094bSMauro Carvalho Chehab return gc0310_i2c_write(client, size, (u8 *)&ctrl->buffer); 162ad85094bSMauro Carvalho Chehab } 163ad85094bSMauro Carvalho Chehab 164ad85094bSMauro Carvalho Chehab static int __gc0310_buf_reg_array(struct i2c_client *client, 165ad85094bSMauro Carvalho Chehab struct gc0310_write_ctrl *ctrl, 166ad85094bSMauro Carvalho Chehab const struct gc0310_reg *next) 167ad85094bSMauro Carvalho Chehab { 168ad85094bSMauro Carvalho Chehab int size; 169ad85094bSMauro Carvalho Chehab 170ad85094bSMauro Carvalho Chehab switch (next->type) { 171ad85094bSMauro Carvalho Chehab case GC0310_8BIT: 172ad85094bSMauro Carvalho Chehab size = 1; 173ad85094bSMauro Carvalho Chehab ctrl->buffer.data[ctrl->index] = (u8)next->val; 174ad85094bSMauro Carvalho Chehab break; 175ad85094bSMauro Carvalho Chehab default: 176ad85094bSMauro Carvalho Chehab return -EINVAL; 177ad85094bSMauro Carvalho Chehab } 178ad85094bSMauro Carvalho Chehab 179ad85094bSMauro Carvalho Chehab /* When first item is added, we need to store its starting address */ 180ad85094bSMauro Carvalho Chehab if (ctrl->index == 0) 181ad85094bSMauro Carvalho Chehab ctrl->buffer.addr = next->reg; 182ad85094bSMauro Carvalho Chehab 183ad85094bSMauro Carvalho Chehab ctrl->index += size; 184ad85094bSMauro Carvalho Chehab 185ad85094bSMauro Carvalho Chehab /* 186ad85094bSMauro Carvalho Chehab * Buffer cannot guarantee free space for u32? Better flush it to avoid 187ad85094bSMauro Carvalho Chehab * possible lack of memory for next item. 188ad85094bSMauro Carvalho Chehab */ 189ad85094bSMauro Carvalho Chehab if (ctrl->index + sizeof(u8) >= GC0310_MAX_WRITE_BUF_SIZE) 190ad85094bSMauro Carvalho Chehab return __gc0310_flush_reg_array(client, ctrl); 191ad85094bSMauro Carvalho Chehab 192ad85094bSMauro Carvalho Chehab return 0; 193ad85094bSMauro Carvalho Chehab } 194ad85094bSMauro Carvalho Chehab 195ad85094bSMauro Carvalho Chehab static int __gc0310_write_reg_is_consecutive(struct i2c_client *client, 196ad85094bSMauro Carvalho Chehab struct gc0310_write_ctrl *ctrl, 197ad85094bSMauro Carvalho Chehab const struct gc0310_reg *next) 198ad85094bSMauro Carvalho Chehab { 199ad85094bSMauro Carvalho Chehab if (ctrl->index == 0) 200ad85094bSMauro Carvalho Chehab return 1; 201ad85094bSMauro Carvalho Chehab 202ad85094bSMauro Carvalho Chehab return ctrl->buffer.addr + ctrl->index == next->reg; 203ad85094bSMauro Carvalho Chehab } 204ad85094bSMauro Carvalho Chehab 205ad85094bSMauro Carvalho Chehab static int gc0310_write_reg_array(struct i2c_client *client, 206*bfe06aeeSHans de Goede const struct gc0310_reg *reglist, int count) 207ad85094bSMauro Carvalho Chehab { 208ad85094bSMauro Carvalho Chehab struct gc0310_write_ctrl ctrl; 209*bfe06aeeSHans de Goede int i, err; 210ad85094bSMauro Carvalho Chehab 211ad85094bSMauro Carvalho Chehab ctrl.index = 0; 212*bfe06aeeSHans de Goede for (i = 0; i < count; i++) { 213ad85094bSMauro Carvalho Chehab /* 214ad85094bSMauro Carvalho Chehab * If next address is not consecutive, data needs to be 215ad85094bSMauro Carvalho Chehab * flushed before proceed. 216ad85094bSMauro Carvalho Chehab */ 217ad85094bSMauro Carvalho Chehab if (!__gc0310_write_reg_is_consecutive(client, &ctrl, 218*bfe06aeeSHans de Goede ®list[i])) { 219ad85094bSMauro Carvalho Chehab err = __gc0310_flush_reg_array(client, &ctrl); 220ad85094bSMauro Carvalho Chehab if (err) 221ad85094bSMauro Carvalho Chehab return err; 222ad85094bSMauro Carvalho Chehab } 223*bfe06aeeSHans de Goede err = __gc0310_buf_reg_array(client, &ctrl, ®list[i]); 224ad85094bSMauro Carvalho Chehab if (err) { 225ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "%s: write error, aborted\n", 226ad85094bSMauro Carvalho Chehab __func__); 227ad85094bSMauro Carvalho Chehab return err; 228ad85094bSMauro Carvalho Chehab } 229ad85094bSMauro Carvalho Chehab } 230ad85094bSMauro Carvalho Chehab 231ad85094bSMauro Carvalho Chehab return __gc0310_flush_reg_array(client, &ctrl); 232ad85094bSMauro Carvalho Chehab } 233bdfe0bebSMauro Carvalho Chehab 234ad85094bSMauro Carvalho Chehab static int gc0310_set_gain(struct v4l2_subdev *sd, int gain) 235ad85094bSMauro Carvalho Chehab 236ad85094bSMauro Carvalho Chehab { 237ad85094bSMauro Carvalho Chehab struct i2c_client *client = v4l2_get_subdevdata(sd); 238ad85094bSMauro Carvalho Chehab int ret; 239ad85094bSMauro Carvalho Chehab u8 again, dgain; 240ad85094bSMauro Carvalho Chehab 241ad85094bSMauro Carvalho Chehab if (gain < 0x20) 242ad85094bSMauro Carvalho Chehab gain = 0x20; 243ad85094bSMauro Carvalho Chehab if (gain > 0x80) 244ad85094bSMauro Carvalho Chehab gain = 0x80; 245ad85094bSMauro Carvalho Chehab 246ad85094bSMauro Carvalho Chehab if (gain >= 0x20 && gain < 0x40) { 247ad85094bSMauro Carvalho Chehab again = 0x0; /* sqrt(2) */ 248ad85094bSMauro Carvalho Chehab dgain = gain; 249ad85094bSMauro Carvalho Chehab } else { 250ad85094bSMauro Carvalho Chehab again = 0x2; /* 2 * sqrt(2) */ 251ad85094bSMauro Carvalho Chehab dgain = gain / 2; 252ad85094bSMauro Carvalho Chehab } 253ad85094bSMauro Carvalho Chehab 2542dfc978aSDeepak R Varma dev_dbg(&client->dev, "gain=0x%x again=0x%x dgain=0x%x\n", gain, again, dgain); 255ad85094bSMauro Carvalho Chehab 256ad85094bSMauro Carvalho Chehab /* set analog gain */ 257ad85094bSMauro Carvalho Chehab ret = gc0310_write_reg(client, GC0310_8BIT, 258ad85094bSMauro Carvalho Chehab GC0310_AGC_ADJ, again); 259ad85094bSMauro Carvalho Chehab if (ret) 260ad85094bSMauro Carvalho Chehab return ret; 261ad85094bSMauro Carvalho Chehab 262ad85094bSMauro Carvalho Chehab /* set digital gain */ 263ad85094bSMauro Carvalho Chehab ret = gc0310_write_reg(client, GC0310_8BIT, 264ad85094bSMauro Carvalho Chehab GC0310_DGC_ADJ, dgain); 265ad85094bSMauro Carvalho Chehab if (ret) 266ad85094bSMauro Carvalho Chehab return ret; 267ad85094bSMauro Carvalho Chehab 268ad85094bSMauro Carvalho Chehab return 0; 269ad85094bSMauro Carvalho Chehab } 270ad85094bSMauro Carvalho Chehab 271ad85094bSMauro Carvalho Chehab static int __gc0310_set_exposure(struct v4l2_subdev *sd, int coarse_itg, 272ad85094bSMauro Carvalho Chehab int gain, int digitgain) 273ad85094bSMauro Carvalho Chehab 274ad85094bSMauro Carvalho Chehab { 275ad85094bSMauro Carvalho Chehab struct i2c_client *client = v4l2_get_subdevdata(sd); 276ad85094bSMauro Carvalho Chehab int ret; 277ad85094bSMauro Carvalho Chehab 2782dfc978aSDeepak R Varma dev_dbg(&client->dev, "coarse_itg=%d gain=%d digitgain=%d\n", coarse_itg, gain, digitgain); 279ad85094bSMauro Carvalho Chehab 280ad85094bSMauro Carvalho Chehab /* set exposure */ 281ad85094bSMauro Carvalho Chehab ret = gc0310_write_reg(client, GC0310_8BIT, 282ad85094bSMauro Carvalho Chehab GC0310_AEC_PK_EXPO_L, 283ad85094bSMauro Carvalho Chehab coarse_itg & 0xff); 284ad85094bSMauro Carvalho Chehab if (ret) 285ad85094bSMauro Carvalho Chehab return ret; 286ad85094bSMauro Carvalho Chehab 287ad85094bSMauro Carvalho Chehab ret = gc0310_write_reg(client, GC0310_8BIT, 288ad85094bSMauro Carvalho Chehab GC0310_AEC_PK_EXPO_H, 289ad85094bSMauro Carvalho Chehab (coarse_itg >> 8) & 0x0f); 290ad85094bSMauro Carvalho Chehab if (ret) 291ad85094bSMauro Carvalho Chehab return ret; 292ad85094bSMauro Carvalho Chehab 293ad85094bSMauro Carvalho Chehab ret = gc0310_set_gain(sd, gain); 294ad85094bSMauro Carvalho Chehab if (ret) 295ad85094bSMauro Carvalho Chehab return ret; 296ad85094bSMauro Carvalho Chehab 297ad85094bSMauro Carvalho Chehab return ret; 298ad85094bSMauro Carvalho Chehab } 299ad85094bSMauro Carvalho Chehab 300ad85094bSMauro Carvalho Chehab static int gc0310_set_exposure(struct v4l2_subdev *sd, int exposure, 301ad85094bSMauro Carvalho Chehab int gain, int digitgain) 302ad85094bSMauro Carvalho Chehab { 303ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 304ad85094bSMauro Carvalho Chehab int ret; 305ad85094bSMauro Carvalho Chehab 306ad85094bSMauro Carvalho Chehab mutex_lock(&dev->input_lock); 307ad85094bSMauro Carvalho Chehab ret = __gc0310_set_exposure(sd, exposure, gain, digitgain); 308ad85094bSMauro Carvalho Chehab mutex_unlock(&dev->input_lock); 309ad85094bSMauro Carvalho Chehab 310ad85094bSMauro Carvalho Chehab return ret; 311ad85094bSMauro Carvalho Chehab } 312ad85094bSMauro Carvalho Chehab 313ad85094bSMauro Carvalho Chehab static long gc0310_s_exposure(struct v4l2_subdev *sd, 314ad85094bSMauro Carvalho Chehab struct atomisp_exposure *exposure) 315ad85094bSMauro Carvalho Chehab { 316ad85094bSMauro Carvalho Chehab int exp = exposure->integration_time[0]; 317ad85094bSMauro Carvalho Chehab int gain = exposure->gain[0]; 318ad85094bSMauro Carvalho Chehab int digitgain = exposure->gain[1]; 319ad85094bSMauro Carvalho Chehab 320ad85094bSMauro Carvalho Chehab /* we should not accept the invalid value below. */ 321ad85094bSMauro Carvalho Chehab if (gain == 0) { 322ad85094bSMauro Carvalho Chehab struct i2c_client *client = v4l2_get_subdevdata(sd); 323bdfe0bebSMauro Carvalho Chehab 324ad85094bSMauro Carvalho Chehab v4l2_err(client, "%s: invalid value\n", __func__); 325ad85094bSMauro Carvalho Chehab return -EINVAL; 326ad85094bSMauro Carvalho Chehab } 327ad85094bSMauro Carvalho Chehab 328ad85094bSMauro Carvalho Chehab return gc0310_set_exposure(sd, exp, gain, digitgain); 329ad85094bSMauro Carvalho Chehab } 330ad85094bSMauro Carvalho Chehab 331ad85094bSMauro Carvalho Chehab /* TO DO */ 332ad85094bSMauro Carvalho Chehab static int gc0310_v_flip(struct v4l2_subdev *sd, s32 value) 333ad85094bSMauro Carvalho Chehab { 334ad85094bSMauro Carvalho Chehab return 0; 335ad85094bSMauro Carvalho Chehab } 336ad85094bSMauro Carvalho Chehab 337ad85094bSMauro Carvalho Chehab /* TO DO */ 338ad85094bSMauro Carvalho Chehab static int gc0310_h_flip(struct v4l2_subdev *sd, s32 value) 339ad85094bSMauro Carvalho Chehab { 340ad85094bSMauro Carvalho Chehab return 0; 341ad85094bSMauro Carvalho Chehab } 342ad85094bSMauro Carvalho Chehab 343ad85094bSMauro Carvalho Chehab static long gc0310_ioctl(struct v4l2_subdev *sd, unsigned int cmd, void *arg) 344ad85094bSMauro Carvalho Chehab { 345ad85094bSMauro Carvalho Chehab switch (cmd) { 346ad85094bSMauro Carvalho Chehab case ATOMISP_IOC_S_EXPOSURE: 347ad85094bSMauro Carvalho Chehab return gc0310_s_exposure(sd, arg); 348ad85094bSMauro Carvalho Chehab default: 349ad85094bSMauro Carvalho Chehab return -EINVAL; 350ad85094bSMauro Carvalho Chehab } 351ad85094bSMauro Carvalho Chehab return 0; 352ad85094bSMauro Carvalho Chehab } 353ad85094bSMauro Carvalho Chehab 354ad85094bSMauro Carvalho Chehab /* This returns the exposure time being used. This should only be used 355ad85094bSMauro Carvalho Chehab * for filling in EXIF data, not for actual image processing. 356ad85094bSMauro Carvalho Chehab */ 357ad85094bSMauro Carvalho Chehab static int gc0310_q_exposure(struct v4l2_subdev *sd, s32 *value) 358ad85094bSMauro Carvalho Chehab { 359ad85094bSMauro Carvalho Chehab struct i2c_client *client = v4l2_get_subdevdata(sd); 360ad85094bSMauro Carvalho Chehab u8 reg_v; 361ad85094bSMauro Carvalho Chehab int ret; 362ad85094bSMauro Carvalho Chehab 363ad85094bSMauro Carvalho Chehab /* get exposure */ 364ad85094bSMauro Carvalho Chehab ret = gc0310_read_reg(client, GC0310_8BIT, 365ad85094bSMauro Carvalho Chehab GC0310_AEC_PK_EXPO_L, 366ad85094bSMauro Carvalho Chehab ®_v); 367ad85094bSMauro Carvalho Chehab if (ret) 368ad85094bSMauro Carvalho Chehab goto err; 369ad85094bSMauro Carvalho Chehab 370ad85094bSMauro Carvalho Chehab *value = reg_v; 371ad85094bSMauro Carvalho Chehab ret = gc0310_read_reg(client, GC0310_8BIT, 372ad85094bSMauro Carvalho Chehab GC0310_AEC_PK_EXPO_H, 373ad85094bSMauro Carvalho Chehab ®_v); 374ad85094bSMauro Carvalho Chehab if (ret) 375ad85094bSMauro Carvalho Chehab goto err; 376ad85094bSMauro Carvalho Chehab 377ad85094bSMauro Carvalho Chehab *value = *value + (reg_v << 8); 378ad85094bSMauro Carvalho Chehab err: 379ad85094bSMauro Carvalho Chehab return ret; 380ad85094bSMauro Carvalho Chehab } 381ad85094bSMauro Carvalho Chehab 382ad85094bSMauro Carvalho Chehab static int gc0310_s_ctrl(struct v4l2_ctrl *ctrl) 383ad85094bSMauro Carvalho Chehab { 384ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = 385ad85094bSMauro Carvalho Chehab container_of(ctrl->handler, struct gc0310_device, ctrl_handler); 386ad85094bSMauro Carvalho Chehab struct i2c_client *client = v4l2_get_subdevdata(&dev->sd); 387ad85094bSMauro Carvalho Chehab int ret = 0; 388ad85094bSMauro Carvalho Chehab 389ad85094bSMauro Carvalho Chehab switch (ctrl->id) { 390ad85094bSMauro Carvalho Chehab case V4L2_CID_VFLIP: 391ad85094bSMauro Carvalho Chehab dev_dbg(&client->dev, "%s: CID_VFLIP:%d.\n", 392ad85094bSMauro Carvalho Chehab __func__, ctrl->val); 393ad85094bSMauro Carvalho Chehab ret = gc0310_v_flip(&dev->sd, ctrl->val); 394ad85094bSMauro Carvalho Chehab break; 395ad85094bSMauro Carvalho Chehab case V4L2_CID_HFLIP: 396ad85094bSMauro Carvalho Chehab dev_dbg(&client->dev, "%s: CID_HFLIP:%d.\n", 397ad85094bSMauro Carvalho Chehab __func__, ctrl->val); 398ad85094bSMauro Carvalho Chehab ret = gc0310_h_flip(&dev->sd, ctrl->val); 399ad85094bSMauro Carvalho Chehab break; 400ad85094bSMauro Carvalho Chehab default: 401ad85094bSMauro Carvalho Chehab ret = -EINVAL; 402ad85094bSMauro Carvalho Chehab } 403ad85094bSMauro Carvalho Chehab return ret; 404ad85094bSMauro Carvalho Chehab } 405ad85094bSMauro Carvalho Chehab 406ad85094bSMauro Carvalho Chehab static int gc0310_g_volatile_ctrl(struct v4l2_ctrl *ctrl) 407ad85094bSMauro Carvalho Chehab { 408ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = 409ad85094bSMauro Carvalho Chehab container_of(ctrl->handler, struct gc0310_device, ctrl_handler); 410ad85094bSMauro Carvalho Chehab int ret = 0; 411ad85094bSMauro Carvalho Chehab 412ad85094bSMauro Carvalho Chehab switch (ctrl->id) { 413ad85094bSMauro Carvalho Chehab case V4L2_CID_EXPOSURE_ABSOLUTE: 414ad85094bSMauro Carvalho Chehab ret = gc0310_q_exposure(&dev->sd, &ctrl->val); 415ad85094bSMauro Carvalho Chehab break; 416ad85094bSMauro Carvalho Chehab default: 417ad85094bSMauro Carvalho Chehab ret = -EINVAL; 418ad85094bSMauro Carvalho Chehab } 419ad85094bSMauro Carvalho Chehab 420ad85094bSMauro Carvalho Chehab return ret; 421ad85094bSMauro Carvalho Chehab } 422ad85094bSMauro Carvalho Chehab 423ad85094bSMauro Carvalho Chehab static const struct v4l2_ctrl_ops ctrl_ops = { 424ad85094bSMauro Carvalho Chehab .s_ctrl = gc0310_s_ctrl, 425ad85094bSMauro Carvalho Chehab .g_volatile_ctrl = gc0310_g_volatile_ctrl 426ad85094bSMauro Carvalho Chehab }; 427ad85094bSMauro Carvalho Chehab 428ad85094bSMauro Carvalho Chehab static const struct v4l2_ctrl_config gc0310_controls[] = { 429ad85094bSMauro Carvalho Chehab { 430ad85094bSMauro Carvalho Chehab .ops = &ctrl_ops, 431ad85094bSMauro Carvalho Chehab .id = V4L2_CID_EXPOSURE_ABSOLUTE, 432ad85094bSMauro Carvalho Chehab .type = V4L2_CTRL_TYPE_INTEGER, 433ad85094bSMauro Carvalho Chehab .name = "exposure", 434ad85094bSMauro Carvalho Chehab .min = 0x0, 435ad85094bSMauro Carvalho Chehab .max = 0xffff, 436ad85094bSMauro Carvalho Chehab .step = 0x01, 437ad85094bSMauro Carvalho Chehab .def = 0x00, 438ad85094bSMauro Carvalho Chehab .flags = 0, 439ad85094bSMauro Carvalho Chehab }, 440ad85094bSMauro Carvalho Chehab { 441ad85094bSMauro Carvalho Chehab .ops = &ctrl_ops, 442ad85094bSMauro Carvalho Chehab .id = V4L2_CID_VFLIP, 443ad85094bSMauro Carvalho Chehab .type = V4L2_CTRL_TYPE_BOOLEAN, 444ad85094bSMauro Carvalho Chehab .name = "Flip", 445ad85094bSMauro Carvalho Chehab .min = 0, 446ad85094bSMauro Carvalho Chehab .max = 1, 447ad85094bSMauro Carvalho Chehab .step = 1, 448ad85094bSMauro Carvalho Chehab .def = 0, 449ad85094bSMauro Carvalho Chehab }, 450ad85094bSMauro Carvalho Chehab { 451ad85094bSMauro Carvalho Chehab .ops = &ctrl_ops, 452ad85094bSMauro Carvalho Chehab .id = V4L2_CID_HFLIP, 453ad85094bSMauro Carvalho Chehab .type = V4L2_CTRL_TYPE_BOOLEAN, 454ad85094bSMauro Carvalho Chehab .name = "Mirror", 455ad85094bSMauro Carvalho Chehab .min = 0, 456ad85094bSMauro Carvalho Chehab .max = 1, 457ad85094bSMauro Carvalho Chehab .step = 1, 458ad85094bSMauro Carvalho Chehab .def = 0, 459ad85094bSMauro Carvalho Chehab }, 460ad85094bSMauro Carvalho Chehab }; 461ad85094bSMauro Carvalho Chehab 462ad85094bSMauro Carvalho Chehab static int gc0310_init(struct v4l2_subdev *sd) 463ad85094bSMauro Carvalho Chehab { 464ad85094bSMauro Carvalho Chehab int ret; 465ad85094bSMauro Carvalho Chehab struct i2c_client *client = v4l2_get_subdevdata(sd); 466ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 467ad85094bSMauro Carvalho Chehab 468ad85094bSMauro Carvalho Chehab mutex_lock(&dev->input_lock); 469ad85094bSMauro Carvalho Chehab 4704636a85cSMauro Carvalho Chehab /* set initial registers */ 471*bfe06aeeSHans de Goede ret = gc0310_write_reg_array(client, gc0310_reset_register, 472*bfe06aeeSHans de Goede ARRAY_SIZE(gc0310_reset_register)); 473ad85094bSMauro Carvalho Chehab 474ad85094bSMauro Carvalho Chehab /* restore settings */ 475ad85094bSMauro Carvalho Chehab gc0310_res = gc0310_res_preview; 476ad85094bSMauro Carvalho Chehab N_RES = N_RES_PREVIEW; 477ad85094bSMauro Carvalho Chehab 478ad85094bSMauro Carvalho Chehab mutex_unlock(&dev->input_lock); 479ad85094bSMauro Carvalho Chehab 480ad85094bSMauro Carvalho Chehab return ret; 481ad85094bSMauro Carvalho Chehab } 482ad85094bSMauro Carvalho Chehab 483ad85094bSMauro Carvalho Chehab static int power_ctrl(struct v4l2_subdev *sd, bool flag) 484ad85094bSMauro Carvalho Chehab { 485ad85094bSMauro Carvalho Chehab int ret = 0; 486ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 487bdfe0bebSMauro Carvalho Chehab 488ad85094bSMauro Carvalho Chehab if (!dev || !dev->platform_data) 489ad85094bSMauro Carvalho Chehab return -ENODEV; 490ad85094bSMauro Carvalho Chehab 491ad85094bSMauro Carvalho Chehab if (flag) { 492ad85094bSMauro Carvalho Chehab /* The upstream module driver (written to Crystal 493ad85094bSMauro Carvalho Chehab * Cove) had this logic to pulse the rails low first. 494ad85094bSMauro Carvalho Chehab * This appears to break things on the MRD7 with the 495ad85094bSMauro Carvalho Chehab * X-Powers PMIC... 496ad85094bSMauro Carvalho Chehab * 497ad85094bSMauro Carvalho Chehab * ret = dev->platform_data->v1p8_ctrl(sd, 0); 498ad85094bSMauro Carvalho Chehab * ret |= dev->platform_data->v2p8_ctrl(sd, 0); 499ad85094bSMauro Carvalho Chehab * mdelay(50); 500ad85094bSMauro Carvalho Chehab */ 501ad85094bSMauro Carvalho Chehab ret |= dev->platform_data->v1p8_ctrl(sd, 1); 502ad85094bSMauro Carvalho Chehab ret |= dev->platform_data->v2p8_ctrl(sd, 1); 503ad85094bSMauro Carvalho Chehab usleep_range(10000, 15000); 504ad85094bSMauro Carvalho Chehab } 505ad85094bSMauro Carvalho Chehab 506ad85094bSMauro Carvalho Chehab if (!flag || ret) { 507ad85094bSMauro Carvalho Chehab ret |= dev->platform_data->v1p8_ctrl(sd, 0); 508ad85094bSMauro Carvalho Chehab ret |= dev->platform_data->v2p8_ctrl(sd, 0); 509ad85094bSMauro Carvalho Chehab } 510ad85094bSMauro Carvalho Chehab return ret; 511ad85094bSMauro Carvalho Chehab } 512ad85094bSMauro Carvalho Chehab 513ad85094bSMauro Carvalho Chehab static int gpio_ctrl(struct v4l2_subdev *sd, bool flag) 514ad85094bSMauro Carvalho Chehab { 515ad85094bSMauro Carvalho Chehab int ret; 516ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 517ad85094bSMauro Carvalho Chehab 518ad85094bSMauro Carvalho Chehab if (!dev || !dev->platform_data) 519ad85094bSMauro Carvalho Chehab return -ENODEV; 520ad85094bSMauro Carvalho Chehab 521ad85094bSMauro Carvalho Chehab /* GPIO0 == "reset" (active low), GPIO1 == "power down" */ 522ad85094bSMauro Carvalho Chehab if (flag) { 523ad85094bSMauro Carvalho Chehab /* Pulse reset, then release power down */ 524ad85094bSMauro Carvalho Chehab ret = dev->platform_data->gpio0_ctrl(sd, 0); 525ad85094bSMauro Carvalho Chehab usleep_range(5000, 10000); 526ad85094bSMauro Carvalho Chehab ret |= dev->platform_data->gpio0_ctrl(sd, 1); 527ad85094bSMauro Carvalho Chehab usleep_range(10000, 15000); 528ad85094bSMauro Carvalho Chehab ret |= dev->platform_data->gpio1_ctrl(sd, 0); 529ad85094bSMauro Carvalho Chehab usleep_range(10000, 15000); 530ad85094bSMauro Carvalho Chehab } else { 531ad85094bSMauro Carvalho Chehab ret = dev->platform_data->gpio1_ctrl(sd, 1); 532ad85094bSMauro Carvalho Chehab ret |= dev->platform_data->gpio0_ctrl(sd, 0); 533ad85094bSMauro Carvalho Chehab } 534ad85094bSMauro Carvalho Chehab return ret; 535ad85094bSMauro Carvalho Chehab } 536ad85094bSMauro Carvalho Chehab 537ad85094bSMauro Carvalho Chehab static int power_up(struct v4l2_subdev *sd) 538ad85094bSMauro Carvalho Chehab { 539ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 540ad85094bSMauro Carvalho Chehab struct i2c_client *client = v4l2_get_subdevdata(sd); 541ad85094bSMauro Carvalho Chehab int ret; 542ad85094bSMauro Carvalho Chehab 543ad85094bSMauro Carvalho Chehab if (!dev->platform_data) { 544ad85094bSMauro Carvalho Chehab dev_err(&client->dev, 545ad85094bSMauro Carvalho Chehab "no camera_sensor_platform_data"); 546ad85094bSMauro Carvalho Chehab return -ENODEV; 547ad85094bSMauro Carvalho Chehab } 548ad85094bSMauro Carvalho Chehab 549c5fafbadSHans de Goede if (dev->power_on) 550c5fafbadSHans de Goede return 0; /* Already on */ 551c5fafbadSHans de Goede 552ad85094bSMauro Carvalho Chehab /* power control */ 553ad85094bSMauro Carvalho Chehab ret = power_ctrl(sd, 1); 554ad85094bSMauro Carvalho Chehab if (ret) 555ad85094bSMauro Carvalho Chehab goto fail_power; 556ad85094bSMauro Carvalho Chehab 557ad85094bSMauro Carvalho Chehab /* flis clock control */ 558ad85094bSMauro Carvalho Chehab ret = dev->platform_data->flisclk_ctrl(sd, 1); 559ad85094bSMauro Carvalho Chehab if (ret) 560ad85094bSMauro Carvalho Chehab goto fail_clk; 561ad85094bSMauro Carvalho Chehab 562ad85094bSMauro Carvalho Chehab /* gpio ctrl */ 563ad85094bSMauro Carvalho Chehab ret = gpio_ctrl(sd, 1); 564ad85094bSMauro Carvalho Chehab if (ret) { 565ad85094bSMauro Carvalho Chehab ret = gpio_ctrl(sd, 1); 566ad85094bSMauro Carvalho Chehab if (ret) 567ad85094bSMauro Carvalho Chehab goto fail_gpio; 568ad85094bSMauro Carvalho Chehab } 569ad85094bSMauro Carvalho Chehab 570ad85094bSMauro Carvalho Chehab msleep(100); 571ad85094bSMauro Carvalho Chehab 572c5fafbadSHans de Goede dev->power_on = true; 573ad85094bSMauro Carvalho Chehab return 0; 574ad85094bSMauro Carvalho Chehab 575ad85094bSMauro Carvalho Chehab fail_gpio: 576ad85094bSMauro Carvalho Chehab dev->platform_data->flisclk_ctrl(sd, 0); 577ad85094bSMauro Carvalho Chehab fail_clk: 578ad85094bSMauro Carvalho Chehab power_ctrl(sd, 0); 579ad85094bSMauro Carvalho Chehab fail_power: 580ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "sensor power-up failed\n"); 581ad85094bSMauro Carvalho Chehab 582ad85094bSMauro Carvalho Chehab return ret; 583ad85094bSMauro Carvalho Chehab } 584ad85094bSMauro Carvalho Chehab 585ad85094bSMauro Carvalho Chehab static int power_down(struct v4l2_subdev *sd) 586ad85094bSMauro Carvalho Chehab { 587ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 588ad85094bSMauro Carvalho Chehab struct i2c_client *client = v4l2_get_subdevdata(sd); 589ad85094bSMauro Carvalho Chehab int ret = 0; 590ad85094bSMauro Carvalho Chehab 591ad85094bSMauro Carvalho Chehab if (!dev->platform_data) { 592ad85094bSMauro Carvalho Chehab dev_err(&client->dev, 593ad85094bSMauro Carvalho Chehab "no camera_sensor_platform_data"); 594ad85094bSMauro Carvalho Chehab return -ENODEV; 595ad85094bSMauro Carvalho Chehab } 596ad85094bSMauro Carvalho Chehab 597c5fafbadSHans de Goede if (!dev->power_on) 598c5fafbadSHans de Goede return 0; /* Already off */ 599c5fafbadSHans de Goede 600ad85094bSMauro Carvalho Chehab /* gpio ctrl */ 601ad85094bSMauro Carvalho Chehab ret = gpio_ctrl(sd, 0); 602ad85094bSMauro Carvalho Chehab if (ret) { 603ad85094bSMauro Carvalho Chehab ret = gpio_ctrl(sd, 0); 604ad85094bSMauro Carvalho Chehab if (ret) 605ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "gpio failed 2\n"); 606ad85094bSMauro Carvalho Chehab } 607ad85094bSMauro Carvalho Chehab 608ad85094bSMauro Carvalho Chehab ret = dev->platform_data->flisclk_ctrl(sd, 0); 609ad85094bSMauro Carvalho Chehab if (ret) 610ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "flisclk failed\n"); 611ad85094bSMauro Carvalho Chehab 612ad85094bSMauro Carvalho Chehab /* power control */ 613ad85094bSMauro Carvalho Chehab ret = power_ctrl(sd, 0); 614ad85094bSMauro Carvalho Chehab if (ret) 615ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "vprog failed.\n"); 616ad85094bSMauro Carvalho Chehab 617c5fafbadSHans de Goede dev->power_on = false; 618ad85094bSMauro Carvalho Chehab return ret; 619ad85094bSMauro Carvalho Chehab } 620ad85094bSMauro Carvalho Chehab 621ad85094bSMauro Carvalho Chehab static int gc0310_s_power(struct v4l2_subdev *sd, int on) 622ad85094bSMauro Carvalho Chehab { 623ad85094bSMauro Carvalho Chehab int ret; 624bdfe0bebSMauro Carvalho Chehab 625ad85094bSMauro Carvalho Chehab if (on == 0) 626ad85094bSMauro Carvalho Chehab return power_down(sd); 6274658e1dbSLeonid Kushnir 628dfe59c78SLeonid Kushnir ret = power_up(sd); 629dfe59c78SLeonid Kushnir if (ret) 630ad85094bSMauro Carvalho Chehab return ret; 631dfe59c78SLeonid Kushnir 632dfe59c78SLeonid Kushnir return gc0310_init(sd); 633ad85094bSMauro Carvalho Chehab } 634ad85094bSMauro Carvalho Chehab 635ad85094bSMauro Carvalho Chehab /* TODO: remove it. */ 636ad85094bSMauro Carvalho Chehab static int startup(struct v4l2_subdev *sd) 637ad85094bSMauro Carvalho Chehab { 638ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 639ad85094bSMauro Carvalho Chehab struct i2c_client *client = v4l2_get_subdevdata(sd); 640ad85094bSMauro Carvalho Chehab int ret = 0; 641ad85094bSMauro Carvalho Chehab 642*bfe06aeeSHans de Goede ret = gc0310_write_reg_array(client, dev->res->regs, dev->res->reg_count); 643ad85094bSMauro Carvalho Chehab if (ret) { 644ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "gc0310 write register err.\n"); 645ad85094bSMauro Carvalho Chehab return ret; 646ad85094bSMauro Carvalho Chehab } 647ad85094bSMauro Carvalho Chehab 648ad85094bSMauro Carvalho Chehab return ret; 649ad85094bSMauro Carvalho Chehab } 650ad85094bSMauro Carvalho Chehab 651ad85094bSMauro Carvalho Chehab static int gc0310_set_fmt(struct v4l2_subdev *sd, 6520d346d2aSTomi Valkeinen struct v4l2_subdev_state *sd_state, 653ad85094bSMauro Carvalho Chehab struct v4l2_subdev_format *format) 654ad85094bSMauro Carvalho Chehab { 655ad85094bSMauro Carvalho Chehab struct v4l2_mbus_framefmt *fmt = &format->format; 656ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 657ad85094bSMauro Carvalho Chehab struct i2c_client *client = v4l2_get_subdevdata(sd); 658ad85094bSMauro Carvalho Chehab struct camera_mipi_info *gc0310_info = NULL; 659e3b14bf8SMauro Carvalho Chehab struct gc0310_resolution *res; 660ad85094bSMauro Carvalho Chehab int ret = 0; 661bdfe0bebSMauro Carvalho Chehab 662ad85094bSMauro Carvalho Chehab if (format->pad) 663ad85094bSMauro Carvalho Chehab return -EINVAL; 664ad85094bSMauro Carvalho Chehab 665ad85094bSMauro Carvalho Chehab if (!fmt) 666ad85094bSMauro Carvalho Chehab return -EINVAL; 667ad85094bSMauro Carvalho Chehab 668ad85094bSMauro Carvalho Chehab gc0310_info = v4l2_get_subdev_hostdata(sd); 669ad85094bSMauro Carvalho Chehab if (!gc0310_info) 670ad85094bSMauro Carvalho Chehab return -EINVAL; 671ad85094bSMauro Carvalho Chehab 672ad85094bSMauro Carvalho Chehab mutex_lock(&dev->input_lock); 673ad85094bSMauro Carvalho Chehab 674e3b14bf8SMauro Carvalho Chehab res = v4l2_find_nearest_size(gc0310_res_preview, 675e3b14bf8SMauro Carvalho Chehab ARRAY_SIZE(gc0310_res_preview), width, 676e3b14bf8SMauro Carvalho Chehab height, fmt->width, fmt->height); 677e3b14bf8SMauro Carvalho Chehab if (!res) 678e3b14bf8SMauro Carvalho Chehab res = &gc0310_res_preview[N_RES - 1]; 679e3b14bf8SMauro Carvalho Chehab 680e3b14bf8SMauro Carvalho Chehab fmt->width = res->width; 681e3b14bf8SMauro Carvalho Chehab fmt->height = res->height; 682e3b14bf8SMauro Carvalho Chehab dev->res = res; 683e3b14bf8SMauro Carvalho Chehab 684ad85094bSMauro Carvalho Chehab fmt->code = MEDIA_BUS_FMT_SGRBG8_1X8; 685ad85094bSMauro Carvalho Chehab 686ad85094bSMauro Carvalho Chehab if (format->which == V4L2_SUBDEV_FORMAT_TRY) { 6870d346d2aSTomi Valkeinen sd_state->pads->try_fmt = *fmt; 688ad85094bSMauro Carvalho Chehab mutex_unlock(&dev->input_lock); 689ad85094bSMauro Carvalho Chehab return 0; 690ad85094bSMauro Carvalho Chehab } 691ad85094bSMauro Carvalho Chehab 692c5fafbadSHans de Goede /* s_power has not been called yet for std v4l2 clients (camorama) */ 693c5fafbadSHans de Goede power_up(sd); 694c5fafbadSHans de Goede 6952dfc978aSDeepak R Varma dev_dbg(&client->dev, "%s: before gc0310_write_reg_array %s\n", 696e3b14bf8SMauro Carvalho Chehab __func__, dev->res->desc); 697ad85094bSMauro Carvalho Chehab ret = startup(sd); 698ad85094bSMauro Carvalho Chehab if (ret) { 699ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "gc0310 startup err\n"); 700ad85094bSMauro Carvalho Chehab goto err; 701ad85094bSMauro Carvalho Chehab } 702ad85094bSMauro Carvalho Chehab 703ad85094bSMauro Carvalho Chehab err: 704ad85094bSMauro Carvalho Chehab mutex_unlock(&dev->input_lock); 705ad85094bSMauro Carvalho Chehab return ret; 706ad85094bSMauro Carvalho Chehab } 707ad85094bSMauro Carvalho Chehab 708ad85094bSMauro Carvalho Chehab static int gc0310_get_fmt(struct v4l2_subdev *sd, 7090d346d2aSTomi Valkeinen struct v4l2_subdev_state *sd_state, 710ad85094bSMauro Carvalho Chehab struct v4l2_subdev_format *format) 711ad85094bSMauro Carvalho Chehab { 712ad85094bSMauro Carvalho Chehab struct v4l2_mbus_framefmt *fmt = &format->format; 713ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 714ad85094bSMauro Carvalho Chehab 715ad85094bSMauro Carvalho Chehab if (format->pad) 716ad85094bSMauro Carvalho Chehab return -EINVAL; 717ad85094bSMauro Carvalho Chehab 718ad85094bSMauro Carvalho Chehab if (!fmt) 719ad85094bSMauro Carvalho Chehab return -EINVAL; 720ad85094bSMauro Carvalho Chehab 721e3b14bf8SMauro Carvalho Chehab fmt->width = dev->res->width; 722e3b14bf8SMauro Carvalho Chehab fmt->height = dev->res->height; 723ad85094bSMauro Carvalho Chehab fmt->code = MEDIA_BUS_FMT_SGRBG8_1X8; 724ad85094bSMauro Carvalho Chehab 725ad85094bSMauro Carvalho Chehab return 0; 726ad85094bSMauro Carvalho Chehab } 727ad85094bSMauro Carvalho Chehab 728ad85094bSMauro Carvalho Chehab static int gc0310_detect(struct i2c_client *client) 729ad85094bSMauro Carvalho Chehab { 730ad85094bSMauro Carvalho Chehab struct i2c_adapter *adapter = client->adapter; 731ad85094bSMauro Carvalho Chehab u8 high, low; 732ad85094bSMauro Carvalho Chehab int ret; 733ad85094bSMauro Carvalho Chehab u16 id; 734ad85094bSMauro Carvalho Chehab 735ad85094bSMauro Carvalho Chehab if (!i2c_check_functionality(adapter, I2C_FUNC_I2C)) 736ad85094bSMauro Carvalho Chehab return -ENODEV; 737ad85094bSMauro Carvalho Chehab 738ad85094bSMauro Carvalho Chehab ret = gc0310_read_reg(client, GC0310_8BIT, 739ad85094bSMauro Carvalho Chehab GC0310_SC_CMMN_CHIP_ID_H, &high); 740ad85094bSMauro Carvalho Chehab if (ret) { 741ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "read sensor_id_high failed\n"); 742ad85094bSMauro Carvalho Chehab return -ENODEV; 743ad85094bSMauro Carvalho Chehab } 744ad85094bSMauro Carvalho Chehab ret = gc0310_read_reg(client, GC0310_8BIT, 745ad85094bSMauro Carvalho Chehab GC0310_SC_CMMN_CHIP_ID_L, &low); 746ad85094bSMauro Carvalho Chehab if (ret) { 747ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "read sensor_id_low failed\n"); 748ad85094bSMauro Carvalho Chehab return -ENODEV; 749ad85094bSMauro Carvalho Chehab } 750ad85094bSMauro Carvalho Chehab id = ((((u16)high) << 8) | (u16)low); 7512dfc978aSDeepak R Varma dev_dbg(&client->dev, "sensor ID = 0x%x\n", id); 752ad85094bSMauro Carvalho Chehab 753ad85094bSMauro Carvalho Chehab if (id != GC0310_ID) { 754eaa399ebSMauro Carvalho Chehab dev_err(&client->dev, "sensor ID error, read id = 0x%x, target id = 0x%x\n", id, 755eaa399ebSMauro Carvalho Chehab GC0310_ID); 756ad85094bSMauro Carvalho Chehab return -ENODEV; 757ad85094bSMauro Carvalho Chehab } 758ad85094bSMauro Carvalho Chehab 759ad85094bSMauro Carvalho Chehab dev_dbg(&client->dev, "detect gc0310 success\n"); 760ad85094bSMauro Carvalho Chehab 761ad85094bSMauro Carvalho Chehab return 0; 762ad85094bSMauro Carvalho Chehab } 763ad85094bSMauro Carvalho Chehab 764ad85094bSMauro Carvalho Chehab static int gc0310_s_stream(struct v4l2_subdev *sd, int enable) 765ad85094bSMauro Carvalho Chehab { 766ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 767ad85094bSMauro Carvalho Chehab struct i2c_client *client = v4l2_get_subdevdata(sd); 768ad85094bSMauro Carvalho Chehab int ret; 769ad85094bSMauro Carvalho Chehab 7702dfc978aSDeepak R Varma dev_dbg(&client->dev, "%s S enable=%d\n", __func__, enable); 771ad85094bSMauro Carvalho Chehab mutex_lock(&dev->input_lock); 772ad85094bSMauro Carvalho Chehab 773ad85094bSMauro Carvalho Chehab if (enable) { 774ad85094bSMauro Carvalho Chehab /* enable per frame MIPI and sensor ctrl reset */ 775ad85094bSMauro Carvalho Chehab ret = gc0310_write_reg(client, GC0310_8BIT, 776ad85094bSMauro Carvalho Chehab 0xFE, 0x30); 777ad85094bSMauro Carvalho Chehab if (ret) { 778ad85094bSMauro Carvalho Chehab mutex_unlock(&dev->input_lock); 779ad85094bSMauro Carvalho Chehab return ret; 780ad85094bSMauro Carvalho Chehab } 781ad85094bSMauro Carvalho Chehab } 782ad85094bSMauro Carvalho Chehab 783ad85094bSMauro Carvalho Chehab ret = gc0310_write_reg(client, GC0310_8BIT, 784ad85094bSMauro Carvalho Chehab GC0310_RESET_RELATED, GC0310_REGISTER_PAGE_3); 785ad85094bSMauro Carvalho Chehab if (ret) { 786ad85094bSMauro Carvalho Chehab mutex_unlock(&dev->input_lock); 787ad85094bSMauro Carvalho Chehab return ret; 788ad85094bSMauro Carvalho Chehab } 789ad85094bSMauro Carvalho Chehab 790ad85094bSMauro Carvalho Chehab ret = gc0310_write_reg(client, GC0310_8BIT, GC0310_SW_STREAM, 791ad85094bSMauro Carvalho Chehab enable ? GC0310_START_STREAMING : 792ad85094bSMauro Carvalho Chehab GC0310_STOP_STREAMING); 793ad85094bSMauro Carvalho Chehab if (ret) { 794ad85094bSMauro Carvalho Chehab mutex_unlock(&dev->input_lock); 795ad85094bSMauro Carvalho Chehab return ret; 796ad85094bSMauro Carvalho Chehab } 797ad85094bSMauro Carvalho Chehab 798ad85094bSMauro Carvalho Chehab ret = gc0310_write_reg(client, GC0310_8BIT, 799ad85094bSMauro Carvalho Chehab GC0310_RESET_RELATED, GC0310_REGISTER_PAGE_0); 800ad85094bSMauro Carvalho Chehab if (ret) { 801ad85094bSMauro Carvalho Chehab mutex_unlock(&dev->input_lock); 802ad85094bSMauro Carvalho Chehab return ret; 803ad85094bSMauro Carvalho Chehab } 804ad85094bSMauro Carvalho Chehab 805ad85094bSMauro Carvalho Chehab mutex_unlock(&dev->input_lock); 806ad85094bSMauro Carvalho Chehab return ret; 807ad85094bSMauro Carvalho Chehab } 808ad85094bSMauro Carvalho Chehab 809ad85094bSMauro Carvalho Chehab static int gc0310_s_config(struct v4l2_subdev *sd, 810ad85094bSMauro Carvalho Chehab int irq, void *platform_data) 811ad85094bSMauro Carvalho Chehab { 812ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 813ad85094bSMauro Carvalho Chehab struct i2c_client *client = v4l2_get_subdevdata(sd); 814ad85094bSMauro Carvalho Chehab int ret = 0; 815ad85094bSMauro Carvalho Chehab 816ad85094bSMauro Carvalho Chehab if (!platform_data) 817ad85094bSMauro Carvalho Chehab return -ENODEV; 818ad85094bSMauro Carvalho Chehab 819ad85094bSMauro Carvalho Chehab dev->platform_data = 820ad85094bSMauro Carvalho Chehab (struct camera_sensor_platform_data *)platform_data; 821ad85094bSMauro Carvalho Chehab 822ad85094bSMauro Carvalho Chehab mutex_lock(&dev->input_lock); 823ad85094bSMauro Carvalho Chehab /* power off the module, then power on it in future 824ad85094bSMauro Carvalho Chehab * as first power on by board may not fulfill the 825ad85094bSMauro Carvalho Chehab * power on sequqence needed by the module 826ad85094bSMauro Carvalho Chehab */ 827c5fafbadSHans de Goede dev->power_on = true; /* force power_down() to run */ 828ad85094bSMauro Carvalho Chehab ret = power_down(sd); 829ad85094bSMauro Carvalho Chehab if (ret) { 830ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "gc0310 power-off err.\n"); 831ad85094bSMauro Carvalho Chehab goto fail_power_off; 832ad85094bSMauro Carvalho Chehab } 833ad85094bSMauro Carvalho Chehab 834ad85094bSMauro Carvalho Chehab ret = power_up(sd); 835ad85094bSMauro Carvalho Chehab if (ret) { 836ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "gc0310 power-up err.\n"); 837ad85094bSMauro Carvalho Chehab goto fail_power_on; 838ad85094bSMauro Carvalho Chehab } 839ad85094bSMauro Carvalho Chehab 840ad85094bSMauro Carvalho Chehab ret = dev->platform_data->csi_cfg(sd, 1); 841ad85094bSMauro Carvalho Chehab if (ret) 842ad85094bSMauro Carvalho Chehab goto fail_csi_cfg; 843ad85094bSMauro Carvalho Chehab 844ad85094bSMauro Carvalho Chehab /* config & detect sensor */ 845ad85094bSMauro Carvalho Chehab ret = gc0310_detect(client); 846ad85094bSMauro Carvalho Chehab if (ret) { 847ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "gc0310_detect err s_config.\n"); 848ad85094bSMauro Carvalho Chehab goto fail_csi_cfg; 849ad85094bSMauro Carvalho Chehab } 850ad85094bSMauro Carvalho Chehab 851ad85094bSMauro Carvalho Chehab /* turn off sensor, after probed */ 852ad85094bSMauro Carvalho Chehab ret = power_down(sd); 853ad85094bSMauro Carvalho Chehab if (ret) { 854ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "gc0310 power-off err.\n"); 855ad85094bSMauro Carvalho Chehab goto fail_csi_cfg; 856ad85094bSMauro Carvalho Chehab } 857ad85094bSMauro Carvalho Chehab mutex_unlock(&dev->input_lock); 858ad85094bSMauro Carvalho Chehab 859ad85094bSMauro Carvalho Chehab return 0; 860ad85094bSMauro Carvalho Chehab 861ad85094bSMauro Carvalho Chehab fail_csi_cfg: 862ad85094bSMauro Carvalho Chehab dev->platform_data->csi_cfg(sd, 0); 863ad85094bSMauro Carvalho Chehab fail_power_on: 864ad85094bSMauro Carvalho Chehab power_down(sd); 865ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "sensor power-gating failed\n"); 866ad85094bSMauro Carvalho Chehab fail_power_off: 867ad85094bSMauro Carvalho Chehab mutex_unlock(&dev->input_lock); 868ad85094bSMauro Carvalho Chehab return ret; 869ad85094bSMauro Carvalho Chehab } 870ad85094bSMauro Carvalho Chehab 871ad85094bSMauro Carvalho Chehab static int gc0310_g_frame_interval(struct v4l2_subdev *sd, 872ad85094bSMauro Carvalho Chehab struct v4l2_subdev_frame_interval *interval) 873ad85094bSMauro Carvalho Chehab { 874ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 875ad85094bSMauro Carvalho Chehab 876ad85094bSMauro Carvalho Chehab interval->interval.numerator = 1; 877e3b14bf8SMauro Carvalho Chehab interval->interval.denominator = dev->res->fps; 878ad85094bSMauro Carvalho Chehab 879ad85094bSMauro Carvalho Chehab return 0; 880ad85094bSMauro Carvalho Chehab } 881ad85094bSMauro Carvalho Chehab 882ad85094bSMauro Carvalho Chehab static int gc0310_enum_mbus_code(struct v4l2_subdev *sd, 8830d346d2aSTomi Valkeinen struct v4l2_subdev_state *sd_state, 884ad85094bSMauro Carvalho Chehab struct v4l2_subdev_mbus_code_enum *code) 885ad85094bSMauro Carvalho Chehab { 886ad85094bSMauro Carvalho Chehab if (code->index >= MAX_FMTS) 887ad85094bSMauro Carvalho Chehab return -EINVAL; 888ad85094bSMauro Carvalho Chehab 889ad85094bSMauro Carvalho Chehab code->code = MEDIA_BUS_FMT_SGRBG8_1X8; 890ad85094bSMauro Carvalho Chehab return 0; 891ad85094bSMauro Carvalho Chehab } 892ad85094bSMauro Carvalho Chehab 893ad85094bSMauro Carvalho Chehab static int gc0310_enum_frame_size(struct v4l2_subdev *sd, 8940d346d2aSTomi Valkeinen struct v4l2_subdev_state *sd_state, 895ad85094bSMauro Carvalho Chehab struct v4l2_subdev_frame_size_enum *fse) 896ad85094bSMauro Carvalho Chehab { 897ad85094bSMauro Carvalho Chehab int index = fse->index; 898ad85094bSMauro Carvalho Chehab 899ad85094bSMauro Carvalho Chehab if (index >= N_RES) 900ad85094bSMauro Carvalho Chehab return -EINVAL; 901ad85094bSMauro Carvalho Chehab 902ad85094bSMauro Carvalho Chehab fse->min_width = gc0310_res[index].width; 903ad85094bSMauro Carvalho Chehab fse->min_height = gc0310_res[index].height; 904ad85094bSMauro Carvalho Chehab fse->max_width = gc0310_res[index].width; 905ad85094bSMauro Carvalho Chehab fse->max_height = gc0310_res[index].height; 906ad85094bSMauro Carvalho Chehab 907ad85094bSMauro Carvalho Chehab return 0; 908ad85094bSMauro Carvalho Chehab } 909ad85094bSMauro Carvalho Chehab 910ad85094bSMauro Carvalho Chehab static int gc0310_g_skip_frames(struct v4l2_subdev *sd, u32 *frames) 911ad85094bSMauro Carvalho Chehab { 912ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 913ad85094bSMauro Carvalho Chehab 914ad85094bSMauro Carvalho Chehab mutex_lock(&dev->input_lock); 915e3b14bf8SMauro Carvalho Chehab *frames = dev->res->skip_frames; 916ad85094bSMauro Carvalho Chehab mutex_unlock(&dev->input_lock); 917ad85094bSMauro Carvalho Chehab 918ad85094bSMauro Carvalho Chehab return 0; 919ad85094bSMauro Carvalho Chehab } 920ad85094bSMauro Carvalho Chehab 921ad85094bSMauro Carvalho Chehab static const struct v4l2_subdev_sensor_ops gc0310_sensor_ops = { 922ad85094bSMauro Carvalho Chehab .g_skip_frames = gc0310_g_skip_frames, 923ad85094bSMauro Carvalho Chehab }; 924ad85094bSMauro Carvalho Chehab 925ad85094bSMauro Carvalho Chehab static const struct v4l2_subdev_video_ops gc0310_video_ops = { 926ad85094bSMauro Carvalho Chehab .s_stream = gc0310_s_stream, 927ad85094bSMauro Carvalho Chehab .g_frame_interval = gc0310_g_frame_interval, 928ad85094bSMauro Carvalho Chehab }; 929ad85094bSMauro Carvalho Chehab 930ad85094bSMauro Carvalho Chehab static const struct v4l2_subdev_core_ops gc0310_core_ops = { 931ad85094bSMauro Carvalho Chehab .s_power = gc0310_s_power, 932ad85094bSMauro Carvalho Chehab .ioctl = gc0310_ioctl, 933ad85094bSMauro Carvalho Chehab }; 934ad85094bSMauro Carvalho Chehab 935ad85094bSMauro Carvalho Chehab static const struct v4l2_subdev_pad_ops gc0310_pad_ops = { 936ad85094bSMauro Carvalho Chehab .enum_mbus_code = gc0310_enum_mbus_code, 937ad85094bSMauro Carvalho Chehab .enum_frame_size = gc0310_enum_frame_size, 938ad85094bSMauro Carvalho Chehab .get_fmt = gc0310_get_fmt, 939ad85094bSMauro Carvalho Chehab .set_fmt = gc0310_set_fmt, 940ad85094bSMauro Carvalho Chehab }; 941ad85094bSMauro Carvalho Chehab 942ad85094bSMauro Carvalho Chehab static const struct v4l2_subdev_ops gc0310_ops = { 943ad85094bSMauro Carvalho Chehab .core = &gc0310_core_ops, 944ad85094bSMauro Carvalho Chehab .video = &gc0310_video_ops, 945ad85094bSMauro Carvalho Chehab .pad = &gc0310_pad_ops, 946ad85094bSMauro Carvalho Chehab .sensor = &gc0310_sensor_ops, 947ad85094bSMauro Carvalho Chehab }; 948ad85094bSMauro Carvalho Chehab 949ed5c2f5fSUwe Kleine-König static void gc0310_remove(struct i2c_client *client) 950ad85094bSMauro Carvalho Chehab { 951ad85094bSMauro Carvalho Chehab struct v4l2_subdev *sd = i2c_get_clientdata(client); 952ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 953bdfe0bebSMauro Carvalho Chehab 954ad85094bSMauro Carvalho Chehab dev_dbg(&client->dev, "gc0310_remove...\n"); 955ad85094bSMauro Carvalho Chehab 956ad85094bSMauro Carvalho Chehab dev->platform_data->csi_cfg(sd, 0); 957ad85094bSMauro Carvalho Chehab 958ad85094bSMauro Carvalho Chehab v4l2_device_unregister_subdev(sd); 959ad85094bSMauro Carvalho Chehab media_entity_cleanup(&dev->sd.entity); 960ad85094bSMauro Carvalho Chehab v4l2_ctrl_handler_free(&dev->ctrl_handler); 961ad85094bSMauro Carvalho Chehab kfree(dev); 962ad85094bSMauro Carvalho Chehab } 963ad85094bSMauro Carvalho Chehab 964ad85094bSMauro Carvalho Chehab static int gc0310_probe(struct i2c_client *client) 965ad85094bSMauro Carvalho Chehab { 966ad85094bSMauro Carvalho Chehab struct gc0310_device *dev; 967ad85094bSMauro Carvalho Chehab int ret; 968ad85094bSMauro Carvalho Chehab void *pdata; 969ad85094bSMauro Carvalho Chehab unsigned int i; 970c03496b3SMauro Carvalho Chehab 971ad85094bSMauro Carvalho Chehab dev = kzalloc(sizeof(*dev), GFP_KERNEL); 972ad85094bSMauro Carvalho Chehab if (!dev) 973ad85094bSMauro Carvalho Chehab return -ENOMEM; 974ad85094bSMauro Carvalho Chehab 975ad85094bSMauro Carvalho Chehab mutex_init(&dev->input_lock); 976ad85094bSMauro Carvalho Chehab 977e3b14bf8SMauro Carvalho Chehab dev->res = &gc0310_res_preview[0]; 978bdfe0bebSMauro Carvalho Chehab v4l2_i2c_subdev_init(&dev->sd, client, &gc0310_ops); 979ad85094bSMauro Carvalho Chehab 980ad85094bSMauro Carvalho Chehab pdata = gmin_camera_platform_data(&dev->sd, 981ad85094bSMauro Carvalho Chehab ATOMISP_INPUT_FORMAT_RAW_8, 982ad85094bSMauro Carvalho Chehab atomisp_bayer_order_grbg); 983ad85094bSMauro Carvalho Chehab if (!pdata) { 984ad85094bSMauro Carvalho Chehab ret = -EINVAL; 985ad85094bSMauro Carvalho Chehab goto out_free; 986ad85094bSMauro Carvalho Chehab } 987ad85094bSMauro Carvalho Chehab 988ad85094bSMauro Carvalho Chehab ret = gc0310_s_config(&dev->sd, client->irq, pdata); 989ad85094bSMauro Carvalho Chehab if (ret) 990ad85094bSMauro Carvalho Chehab goto out_free; 991ad85094bSMauro Carvalho Chehab 992ad85094bSMauro Carvalho Chehab ret = atomisp_register_i2c_module(&dev->sd, pdata, RAW_CAMERA); 993ad85094bSMauro Carvalho Chehab if (ret) 994ad85094bSMauro Carvalho Chehab goto out_free; 995ad85094bSMauro Carvalho Chehab 996ad85094bSMauro Carvalho Chehab dev->sd.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE; 997ad85094bSMauro Carvalho Chehab dev->pad.flags = MEDIA_PAD_FL_SOURCE; 998ad85094bSMauro Carvalho Chehab dev->format.code = MEDIA_BUS_FMT_SGRBG8_1X8; 999ad85094bSMauro Carvalho Chehab dev->sd.entity.function = MEDIA_ENT_F_CAM_SENSOR; 1000ad85094bSMauro Carvalho Chehab ret = 1001ad85094bSMauro Carvalho Chehab v4l2_ctrl_handler_init(&dev->ctrl_handler, 1002ad85094bSMauro Carvalho Chehab ARRAY_SIZE(gc0310_controls)); 1003ad85094bSMauro Carvalho Chehab if (ret) { 1004ad85094bSMauro Carvalho Chehab gc0310_remove(client); 1005ad85094bSMauro Carvalho Chehab return ret; 1006ad85094bSMauro Carvalho Chehab } 1007ad85094bSMauro Carvalho Chehab 1008ad85094bSMauro Carvalho Chehab for (i = 0; i < ARRAY_SIZE(gc0310_controls); i++) 1009ad85094bSMauro Carvalho Chehab v4l2_ctrl_new_custom(&dev->ctrl_handler, &gc0310_controls[i], 1010ad85094bSMauro Carvalho Chehab NULL); 1011ad85094bSMauro Carvalho Chehab 1012ad85094bSMauro Carvalho Chehab if (dev->ctrl_handler.error) { 1013ad85094bSMauro Carvalho Chehab gc0310_remove(client); 1014ad85094bSMauro Carvalho Chehab return dev->ctrl_handler.error; 1015ad85094bSMauro Carvalho Chehab } 1016ad85094bSMauro Carvalho Chehab 1017ad85094bSMauro Carvalho Chehab /* Use same lock for controls as for everything else. */ 1018ad85094bSMauro Carvalho Chehab dev->ctrl_handler.lock = &dev->input_lock; 1019ad85094bSMauro Carvalho Chehab dev->sd.ctrl_handler = &dev->ctrl_handler; 1020ad85094bSMauro Carvalho Chehab 1021ad85094bSMauro Carvalho Chehab ret = media_entity_pads_init(&dev->sd.entity, 1, &dev->pad); 1022ad85094bSMauro Carvalho Chehab if (ret) 1023ad85094bSMauro Carvalho Chehab gc0310_remove(client); 1024ad85094bSMauro Carvalho Chehab 1025ad85094bSMauro Carvalho Chehab return ret; 1026ad85094bSMauro Carvalho Chehab out_free: 1027ad85094bSMauro Carvalho Chehab v4l2_device_unregister_subdev(&dev->sd); 1028ad85094bSMauro Carvalho Chehab kfree(dev); 1029ad85094bSMauro Carvalho Chehab return ret; 1030ad85094bSMauro Carvalho Chehab } 1031ad85094bSMauro Carvalho Chehab 1032ad85094bSMauro Carvalho Chehab static const struct acpi_device_id gc0310_acpi_match[] = { 1033ad85094bSMauro Carvalho Chehab {"XXGC0310"}, 1034ad85094bSMauro Carvalho Chehab {"INT0310"}, 1035ad85094bSMauro Carvalho Chehab {}, 1036ad85094bSMauro Carvalho Chehab }; 1037ad85094bSMauro Carvalho Chehab MODULE_DEVICE_TABLE(acpi, gc0310_acpi_match); 1038ad85094bSMauro Carvalho Chehab 1039ad85094bSMauro Carvalho Chehab static struct i2c_driver gc0310_driver = { 1040ad85094bSMauro Carvalho Chehab .driver = { 1041ad85094bSMauro Carvalho Chehab .name = "gc0310", 1042ad85094bSMauro Carvalho Chehab .acpi_match_table = gc0310_acpi_match, 1043ad85094bSMauro Carvalho Chehab }, 1044ad85094bSMauro Carvalho Chehab .probe_new = gc0310_probe, 1045ad85094bSMauro Carvalho Chehab .remove = gc0310_remove, 1046ad85094bSMauro Carvalho Chehab }; 1047ad85094bSMauro Carvalho Chehab module_i2c_driver(gc0310_driver); 1048ad85094bSMauro Carvalho Chehab 1049ad85094bSMauro Carvalho Chehab MODULE_AUTHOR("Lai, Angie <angie.lai@intel.com>"); 1050ad85094bSMauro Carvalho Chehab MODULE_DESCRIPTION("A low-level driver for GalaxyCore GC0310 sensors"); 1051ad85094bSMauro Carvalho Chehab MODULE_LICENSE("GPL"); 1052