1ad85094bSMauro Carvalho Chehab /* 2ad85094bSMauro Carvalho Chehab * Support for GalaxyCore GC0310 VGA camera sensor. 3ad85094bSMauro Carvalho Chehab * 4ad85094bSMauro Carvalho Chehab * Copyright (c) 2013 Intel Corporation. All Rights Reserved. 5ad85094bSMauro Carvalho Chehab * 6ad85094bSMauro Carvalho Chehab * This program is free software; you can redistribute it and/or 7ad85094bSMauro Carvalho Chehab * modify it under the terms of the GNU General Public License version 8ad85094bSMauro Carvalho Chehab * 2 as published by the Free Software Foundation. 9ad85094bSMauro Carvalho Chehab * 10ad85094bSMauro Carvalho Chehab * This program is distributed in the hope that it will be useful, 11ad85094bSMauro Carvalho Chehab * but WITHOUT ANY WARRANTY; without even the implied warranty of 12ad85094bSMauro Carvalho Chehab * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 13ad85094bSMauro Carvalho Chehab * GNU General Public License for more details. 14ad85094bSMauro Carvalho Chehab * 15ad85094bSMauro Carvalho Chehab */ 16ad85094bSMauro Carvalho Chehab 17ad85094bSMauro Carvalho Chehab #include <linux/module.h> 18ad85094bSMauro Carvalho Chehab #include <linux/types.h> 19ad85094bSMauro Carvalho Chehab #include <linux/kernel.h> 20ad85094bSMauro Carvalho Chehab #include <linux/mm.h> 21ad85094bSMauro Carvalho Chehab #include <linux/string.h> 22ad85094bSMauro Carvalho Chehab #include <linux/errno.h> 23ad85094bSMauro Carvalho Chehab #include <linux/init.h> 24ad85094bSMauro Carvalho Chehab #include <linux/kmod.h> 25ad85094bSMauro Carvalho Chehab #include <linux/device.h> 26ad85094bSMauro Carvalho Chehab #include <linux/delay.h> 27ad85094bSMauro Carvalho Chehab #include <linux/slab.h> 28ad85094bSMauro Carvalho Chehab #include <linux/i2c.h> 29ad85094bSMauro Carvalho Chehab #include <linux/moduleparam.h> 30ad85094bSMauro Carvalho Chehab #include <media/v4l2-device.h> 31ad85094bSMauro Carvalho Chehab #include <linux/io.h> 32ad85094bSMauro Carvalho Chehab #include "../include/linux/atomisp_gmin_platform.h" 33ad85094bSMauro Carvalho Chehab 34ad85094bSMauro Carvalho Chehab #include "gc0310.h" 35ad85094bSMauro Carvalho Chehab 36ad85094bSMauro Carvalho Chehab /* i2c read/write stuff */ 37ad85094bSMauro Carvalho Chehab static int gc0310_read_reg(struct i2c_client *client, 38ad85094bSMauro Carvalho Chehab u16 data_length, u8 reg, u8 *val) 39ad85094bSMauro Carvalho Chehab { 40ad85094bSMauro Carvalho Chehab int err; 41ad85094bSMauro Carvalho Chehab struct i2c_msg msg[2]; 42ad85094bSMauro Carvalho Chehab unsigned char data[1]; 43ad85094bSMauro Carvalho Chehab 44ad85094bSMauro Carvalho Chehab if (!client->adapter) { 45ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "%s error, no client->adapter\n", 46ad85094bSMauro Carvalho Chehab __func__); 47ad85094bSMauro Carvalho Chehab return -ENODEV; 48ad85094bSMauro Carvalho Chehab } 49ad85094bSMauro Carvalho Chehab 50ad85094bSMauro Carvalho Chehab if (data_length != GC0310_8BIT) { 51ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "%s error, invalid data length\n", 52ad85094bSMauro Carvalho Chehab __func__); 53ad85094bSMauro Carvalho Chehab return -EINVAL; 54ad85094bSMauro Carvalho Chehab } 55ad85094bSMauro Carvalho Chehab 56ad85094bSMauro Carvalho Chehab memset(msg, 0, sizeof(msg)); 57ad85094bSMauro Carvalho Chehab 58ad85094bSMauro Carvalho Chehab msg[0].addr = client->addr; 59ad85094bSMauro Carvalho Chehab msg[0].flags = 0; 60ad85094bSMauro Carvalho Chehab msg[0].len = I2C_MSG_LENGTH; 61ad85094bSMauro Carvalho Chehab msg[0].buf = data; 62ad85094bSMauro Carvalho Chehab 63ad85094bSMauro Carvalho Chehab /* high byte goes out first */ 64ad85094bSMauro Carvalho Chehab data[0] = (u8)(reg & 0xff); 65ad85094bSMauro Carvalho Chehab 66ad85094bSMauro Carvalho Chehab msg[1].addr = client->addr; 67ad85094bSMauro Carvalho Chehab msg[1].len = data_length; 68ad85094bSMauro Carvalho Chehab msg[1].flags = I2C_M_RD; 69ad85094bSMauro Carvalho Chehab msg[1].buf = data; 70ad85094bSMauro Carvalho Chehab 71ad85094bSMauro Carvalho Chehab err = i2c_transfer(client->adapter, msg, 2); 72ad85094bSMauro Carvalho Chehab if (err != 2) { 73ad85094bSMauro Carvalho Chehab if (err >= 0) 74ad85094bSMauro Carvalho Chehab err = -EIO; 75ad85094bSMauro Carvalho Chehab dev_err(&client->dev, 76ad85094bSMauro Carvalho Chehab "read from offset 0x%x error %d", reg, err); 77ad85094bSMauro Carvalho Chehab return err; 78ad85094bSMauro Carvalho Chehab } 79ad85094bSMauro Carvalho Chehab 80ad85094bSMauro Carvalho Chehab *val = 0; 81ad85094bSMauro Carvalho Chehab /* high byte comes first */ 82ad85094bSMauro Carvalho Chehab if (data_length == GC0310_8BIT) 83ad85094bSMauro Carvalho Chehab *val = (u8)data[0]; 84ad85094bSMauro Carvalho Chehab 85ad85094bSMauro Carvalho Chehab return 0; 86ad85094bSMauro Carvalho Chehab } 87ad85094bSMauro Carvalho Chehab 88ad85094bSMauro Carvalho Chehab static int gc0310_i2c_write(struct i2c_client *client, u16 len, u8 *data) 89ad85094bSMauro Carvalho Chehab { 90ad85094bSMauro Carvalho Chehab struct i2c_msg msg; 91ad85094bSMauro Carvalho Chehab const int num_msg = 1; 92ad85094bSMauro Carvalho Chehab int ret; 93ad85094bSMauro Carvalho Chehab 94ad85094bSMauro Carvalho Chehab msg.addr = client->addr; 95ad85094bSMauro Carvalho Chehab msg.flags = 0; 96ad85094bSMauro Carvalho Chehab msg.len = len; 97ad85094bSMauro Carvalho Chehab msg.buf = data; 98ad85094bSMauro Carvalho Chehab ret = i2c_transfer(client->adapter, &msg, 1); 99ad85094bSMauro Carvalho Chehab 100ad85094bSMauro Carvalho Chehab return ret == num_msg ? 0 : -EIO; 101ad85094bSMauro Carvalho Chehab } 102ad85094bSMauro Carvalho Chehab 103ad85094bSMauro Carvalho Chehab static int gc0310_write_reg(struct i2c_client *client, u16 data_length, 104ad85094bSMauro Carvalho Chehab u8 reg, u8 val) 105ad85094bSMauro Carvalho Chehab { 106ad85094bSMauro Carvalho Chehab int ret; 107ad85094bSMauro Carvalho Chehab unsigned char data[2] = {0}; 108ad85094bSMauro Carvalho Chehab u8 *wreg = (u8 *)data; 109ad85094bSMauro Carvalho Chehab const u16 len = data_length + sizeof(u8); /* 8-bit address + data */ 110ad85094bSMauro Carvalho Chehab 111ad85094bSMauro Carvalho Chehab if (data_length != GC0310_8BIT) { 112ad85094bSMauro Carvalho Chehab dev_err(&client->dev, 113ad85094bSMauro Carvalho Chehab "%s error, invalid data_length\n", __func__); 114ad85094bSMauro Carvalho Chehab return -EINVAL; 115ad85094bSMauro Carvalho Chehab } 116ad85094bSMauro Carvalho Chehab 117ad85094bSMauro Carvalho Chehab /* high byte goes out first */ 118ad85094bSMauro Carvalho Chehab *wreg = (u8)(reg & 0xff); 119ad85094bSMauro Carvalho Chehab 120ad85094bSMauro Carvalho Chehab if (data_length == GC0310_8BIT) 121ad85094bSMauro Carvalho Chehab data[1] = (u8)(val); 122ad85094bSMauro Carvalho Chehab 123ad85094bSMauro Carvalho Chehab ret = gc0310_i2c_write(client, len, data); 124ad85094bSMauro Carvalho Chehab if (ret) 125ad85094bSMauro Carvalho Chehab dev_err(&client->dev, 126ad85094bSMauro Carvalho Chehab "write error: wrote 0x%x to offset 0x%x error %d", 127ad85094bSMauro Carvalho Chehab val, reg, ret); 128ad85094bSMauro Carvalho Chehab 129ad85094bSMauro Carvalho Chehab return ret; 130ad85094bSMauro Carvalho Chehab } 131ad85094bSMauro Carvalho Chehab 132ad85094bSMauro Carvalho Chehab /* 133ad85094bSMauro Carvalho Chehab * gc0310_write_reg_array - Initializes a list of GC0310 registers 134ad85094bSMauro Carvalho Chehab * @client: i2c driver client structure 135ad85094bSMauro Carvalho Chehab * @reglist: list of registers to be written 136ad85094bSMauro Carvalho Chehab * 137ad85094bSMauro Carvalho Chehab * This function initializes a list of registers. When consecutive addresses 138ad85094bSMauro Carvalho Chehab * are found in a row on the list, this function creates a buffer and sends 139ad85094bSMauro Carvalho Chehab * consecutive data in a single i2c_transfer(). 140ad85094bSMauro Carvalho Chehab * 141ad85094bSMauro Carvalho Chehab * __gc0310_flush_reg_array, __gc0310_buf_reg_array() and 142ad85094bSMauro Carvalho Chehab * __gc0310_write_reg_is_consecutive() are internal functions to 143ad85094bSMauro Carvalho Chehab * gc0310_write_reg_array_fast() and should be not used anywhere else. 144ad85094bSMauro Carvalho Chehab * 145ad85094bSMauro Carvalho Chehab */ 146ad85094bSMauro Carvalho Chehab 147ad85094bSMauro Carvalho Chehab static int __gc0310_flush_reg_array(struct i2c_client *client, 148ad85094bSMauro Carvalho Chehab struct gc0310_write_ctrl *ctrl) 149ad85094bSMauro Carvalho Chehab { 150ad85094bSMauro Carvalho Chehab u16 size; 151ad85094bSMauro Carvalho Chehab 152ad85094bSMauro Carvalho Chehab if (ctrl->index == 0) 153ad85094bSMauro Carvalho Chehab return 0; 154ad85094bSMauro Carvalho Chehab 155ad85094bSMauro Carvalho Chehab size = sizeof(u8) + ctrl->index; /* 8-bit address + data */ 156ad85094bSMauro Carvalho Chehab ctrl->buffer.addr = (u8)(ctrl->buffer.addr); 157ad85094bSMauro Carvalho Chehab ctrl->index = 0; 158ad85094bSMauro Carvalho Chehab 159ad85094bSMauro Carvalho Chehab return gc0310_i2c_write(client, size, (u8 *)&ctrl->buffer); 160ad85094bSMauro Carvalho Chehab } 161ad85094bSMauro Carvalho Chehab 162ad85094bSMauro Carvalho Chehab static int __gc0310_buf_reg_array(struct i2c_client *client, 163ad85094bSMauro Carvalho Chehab struct gc0310_write_ctrl *ctrl, 164ad85094bSMauro Carvalho Chehab const struct gc0310_reg *next) 165ad85094bSMauro Carvalho Chehab { 166ad85094bSMauro Carvalho Chehab int size; 167ad85094bSMauro Carvalho Chehab 168ad85094bSMauro Carvalho Chehab switch (next->type) { 169ad85094bSMauro Carvalho Chehab case GC0310_8BIT: 170ad85094bSMauro Carvalho Chehab size = 1; 171ad85094bSMauro Carvalho Chehab ctrl->buffer.data[ctrl->index] = (u8)next->val; 172ad85094bSMauro Carvalho Chehab break; 173ad85094bSMauro Carvalho Chehab default: 174ad85094bSMauro Carvalho Chehab return -EINVAL; 175ad85094bSMauro Carvalho Chehab } 176ad85094bSMauro Carvalho Chehab 177ad85094bSMauro Carvalho Chehab /* When first item is added, we need to store its starting address */ 178ad85094bSMauro Carvalho Chehab if (ctrl->index == 0) 179ad85094bSMauro Carvalho Chehab ctrl->buffer.addr = next->reg; 180ad85094bSMauro Carvalho Chehab 181ad85094bSMauro Carvalho Chehab ctrl->index += size; 182ad85094bSMauro Carvalho Chehab 183ad85094bSMauro Carvalho Chehab /* 184ad85094bSMauro Carvalho Chehab * Buffer cannot guarantee free space for u32? Better flush it to avoid 185ad85094bSMauro Carvalho Chehab * possible lack of memory for next item. 186ad85094bSMauro Carvalho Chehab */ 187ad85094bSMauro Carvalho Chehab if (ctrl->index + sizeof(u8) >= GC0310_MAX_WRITE_BUF_SIZE) 188ad85094bSMauro Carvalho Chehab return __gc0310_flush_reg_array(client, ctrl); 189ad85094bSMauro Carvalho Chehab 190ad85094bSMauro Carvalho Chehab return 0; 191ad85094bSMauro Carvalho Chehab } 192ad85094bSMauro Carvalho Chehab 193ad85094bSMauro Carvalho Chehab static int __gc0310_write_reg_is_consecutive(struct i2c_client *client, 194ad85094bSMauro Carvalho Chehab struct gc0310_write_ctrl *ctrl, 195ad85094bSMauro Carvalho Chehab const struct gc0310_reg *next) 196ad85094bSMauro Carvalho Chehab { 197ad85094bSMauro Carvalho Chehab if (ctrl->index == 0) 198ad85094bSMauro Carvalho Chehab return 1; 199ad85094bSMauro Carvalho Chehab 200ad85094bSMauro Carvalho Chehab return ctrl->buffer.addr + ctrl->index == next->reg; 201ad85094bSMauro Carvalho Chehab } 202ad85094bSMauro Carvalho Chehab 203ad85094bSMauro Carvalho Chehab static int gc0310_write_reg_array(struct i2c_client *client, 204ad85094bSMauro Carvalho Chehab const struct gc0310_reg *reglist) 205ad85094bSMauro Carvalho Chehab { 206ad85094bSMauro Carvalho Chehab const struct gc0310_reg *next = reglist; 207ad85094bSMauro Carvalho Chehab struct gc0310_write_ctrl ctrl; 208ad85094bSMauro Carvalho Chehab int err; 209ad85094bSMauro Carvalho Chehab 210ad85094bSMauro Carvalho Chehab ctrl.index = 0; 211ad85094bSMauro Carvalho Chehab for (; next->type != GC0310_TOK_TERM; next++) { 212ad85094bSMauro Carvalho Chehab switch (next->type & GC0310_TOK_MASK) { 213ad85094bSMauro Carvalho Chehab case GC0310_TOK_DELAY: 214ad85094bSMauro Carvalho Chehab err = __gc0310_flush_reg_array(client, &ctrl); 215ad85094bSMauro Carvalho Chehab if (err) 216ad85094bSMauro Carvalho Chehab return err; 217ad85094bSMauro Carvalho Chehab msleep(next->val); 218ad85094bSMauro Carvalho Chehab break; 219ad85094bSMauro Carvalho Chehab default: 220ad85094bSMauro Carvalho Chehab /* 221ad85094bSMauro Carvalho Chehab * If next address is not consecutive, data needs to be 222ad85094bSMauro Carvalho Chehab * flushed before proceed. 223ad85094bSMauro Carvalho Chehab */ 224ad85094bSMauro Carvalho Chehab if (!__gc0310_write_reg_is_consecutive(client, &ctrl, 225ad85094bSMauro Carvalho Chehab next)) { 226ad85094bSMauro Carvalho Chehab err = __gc0310_flush_reg_array(client, &ctrl); 227ad85094bSMauro Carvalho Chehab if (err) 228ad85094bSMauro Carvalho Chehab return err; 229ad85094bSMauro Carvalho Chehab } 230ad85094bSMauro Carvalho Chehab err = __gc0310_buf_reg_array(client, &ctrl, next); 231ad85094bSMauro Carvalho Chehab if (err) { 232ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "%s: write error, aborted\n", 233ad85094bSMauro Carvalho Chehab __func__); 234ad85094bSMauro Carvalho Chehab return err; 235ad85094bSMauro Carvalho Chehab } 236ad85094bSMauro Carvalho Chehab break; 237ad85094bSMauro Carvalho Chehab } 238ad85094bSMauro Carvalho Chehab } 239ad85094bSMauro Carvalho Chehab 240ad85094bSMauro Carvalho Chehab return __gc0310_flush_reg_array(client, &ctrl); 241ad85094bSMauro Carvalho Chehab } 242bdfe0bebSMauro Carvalho Chehab 243ad85094bSMauro Carvalho Chehab static int gc0310_g_focal(struct v4l2_subdev *sd, s32 *val) 244ad85094bSMauro Carvalho Chehab { 245ad85094bSMauro Carvalho Chehab *val = (GC0310_FOCAL_LENGTH_NUM << 16) | GC0310_FOCAL_LENGTH_DEM; 246ad85094bSMauro Carvalho Chehab return 0; 247ad85094bSMauro Carvalho Chehab } 248ad85094bSMauro Carvalho Chehab 249ad85094bSMauro Carvalho Chehab static int gc0310_g_fnumber(struct v4l2_subdev *sd, s32 *val) 250ad85094bSMauro Carvalho Chehab { 251ad85094bSMauro Carvalho Chehab /*const f number for imx*/ 252ad85094bSMauro Carvalho Chehab *val = (GC0310_F_NUMBER_DEFAULT_NUM << 16) | GC0310_F_NUMBER_DEM; 253ad85094bSMauro Carvalho Chehab return 0; 254ad85094bSMauro Carvalho Chehab } 255ad85094bSMauro Carvalho Chehab 256ad85094bSMauro Carvalho Chehab static int gc0310_g_fnumber_range(struct v4l2_subdev *sd, s32 *val) 257ad85094bSMauro Carvalho Chehab { 258ad85094bSMauro Carvalho Chehab *val = (GC0310_F_NUMBER_DEFAULT_NUM << 24) | 259ad85094bSMauro Carvalho Chehab (GC0310_F_NUMBER_DEM << 16) | 260ad85094bSMauro Carvalho Chehab (GC0310_F_NUMBER_DEFAULT_NUM << 8) | GC0310_F_NUMBER_DEM; 261ad85094bSMauro Carvalho Chehab return 0; 262ad85094bSMauro Carvalho Chehab } 263ad85094bSMauro Carvalho Chehab 264ad85094bSMauro Carvalho Chehab static int gc0310_g_bin_factor_x(struct v4l2_subdev *sd, s32 *val) 265ad85094bSMauro Carvalho Chehab { 266ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 267ad85094bSMauro Carvalho Chehab 268ad85094bSMauro Carvalho Chehab *val = gc0310_res[dev->fmt_idx].bin_factor_x; 269ad85094bSMauro Carvalho Chehab 270ad85094bSMauro Carvalho Chehab return 0; 271ad85094bSMauro Carvalho Chehab } 272ad85094bSMauro Carvalho Chehab 273ad85094bSMauro Carvalho Chehab static int gc0310_g_bin_factor_y(struct v4l2_subdev *sd, s32 *val) 274ad85094bSMauro Carvalho Chehab { 275ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 276ad85094bSMauro Carvalho Chehab 277ad85094bSMauro Carvalho Chehab *val = gc0310_res[dev->fmt_idx].bin_factor_y; 278ad85094bSMauro Carvalho Chehab 279ad85094bSMauro Carvalho Chehab return 0; 280ad85094bSMauro Carvalho Chehab } 281ad85094bSMauro Carvalho Chehab 282ad85094bSMauro Carvalho Chehab static int gc0310_get_intg_factor(struct i2c_client *client, 283ad85094bSMauro Carvalho Chehab struct camera_mipi_info *info, 284ad85094bSMauro Carvalho Chehab const struct gc0310_resolution *res) 285ad85094bSMauro Carvalho Chehab { 286ad85094bSMauro Carvalho Chehab struct v4l2_subdev *sd = i2c_get_clientdata(client); 287ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 288ad85094bSMauro Carvalho Chehab struct atomisp_sensor_mode_data *buf = &info->data; 289ad85094bSMauro Carvalho Chehab u16 val; 290ad85094bSMauro Carvalho Chehab u8 reg_val; 291ad85094bSMauro Carvalho Chehab int ret; 292ad85094bSMauro Carvalho Chehab unsigned int hori_blanking; 293ad85094bSMauro Carvalho Chehab unsigned int vert_blanking; 294ad85094bSMauro Carvalho Chehab unsigned int sh_delay; 295ad85094bSMauro Carvalho Chehab 296ad85094bSMauro Carvalho Chehab if (!info) 297ad85094bSMauro Carvalho Chehab return -EINVAL; 298ad85094bSMauro Carvalho Chehab 299ad85094bSMauro Carvalho Chehab /* pixel clock calculattion */ 300ad85094bSMauro Carvalho Chehab dev->vt_pix_clk_freq_mhz = 14400000; // 16.8MHz 301ad85094bSMauro Carvalho Chehab buf->vt_pix_clk_freq_mhz = dev->vt_pix_clk_freq_mhz; 302ad85094bSMauro Carvalho Chehab pr_info("vt_pix_clk_freq_mhz=%d\n", buf->vt_pix_clk_freq_mhz); 303ad85094bSMauro Carvalho Chehab 304ad85094bSMauro Carvalho Chehab /* get integration time */ 305ad85094bSMauro Carvalho Chehab buf->coarse_integration_time_min = GC0310_COARSE_INTG_TIME_MIN; 306ad85094bSMauro Carvalho Chehab buf->coarse_integration_time_max_margin = 307ad85094bSMauro Carvalho Chehab GC0310_COARSE_INTG_TIME_MAX_MARGIN; 308ad85094bSMauro Carvalho Chehab 309ad85094bSMauro Carvalho Chehab buf->fine_integration_time_min = GC0310_FINE_INTG_TIME_MIN; 310ad85094bSMauro Carvalho Chehab buf->fine_integration_time_max_margin = 311ad85094bSMauro Carvalho Chehab GC0310_FINE_INTG_TIME_MAX_MARGIN; 312ad85094bSMauro Carvalho Chehab 313ad85094bSMauro Carvalho Chehab buf->fine_integration_time_def = GC0310_FINE_INTG_TIME_MIN; 314ad85094bSMauro Carvalho Chehab buf->read_mode = res->bin_mode; 315ad85094bSMauro Carvalho Chehab 316ad85094bSMauro Carvalho Chehab /* get the cropping and output resolution to ISP for this mode. */ 317ad85094bSMauro Carvalho Chehab /* Getting crop_horizontal_start */ 318ad85094bSMauro Carvalho Chehab ret = gc0310_read_reg(client, GC0310_8BIT, 319ad85094bSMauro Carvalho Chehab GC0310_H_CROP_START_H, ®_val); 320ad85094bSMauro Carvalho Chehab if (ret) 321ad85094bSMauro Carvalho Chehab return ret; 322ad85094bSMauro Carvalho Chehab val = (reg_val & 0xFF) << 8; 323ad85094bSMauro Carvalho Chehab ret = gc0310_read_reg(client, GC0310_8BIT, 324ad85094bSMauro Carvalho Chehab GC0310_H_CROP_START_L, ®_val); 325ad85094bSMauro Carvalho Chehab if (ret) 326ad85094bSMauro Carvalho Chehab return ret; 327ad85094bSMauro Carvalho Chehab buf->crop_horizontal_start = val | (reg_val & 0xFF); 328ad85094bSMauro Carvalho Chehab pr_info("crop_horizontal_start=%d\n", buf->crop_horizontal_start); 329ad85094bSMauro Carvalho Chehab 330ad85094bSMauro Carvalho Chehab /* Getting crop_vertical_start */ 331ad85094bSMauro Carvalho Chehab ret = gc0310_read_reg(client, GC0310_8BIT, 332ad85094bSMauro Carvalho Chehab GC0310_V_CROP_START_H, ®_val); 333ad85094bSMauro Carvalho Chehab if (ret) 334ad85094bSMauro Carvalho Chehab return ret; 335ad85094bSMauro Carvalho Chehab val = (reg_val & 0xFF) << 8; 336ad85094bSMauro Carvalho Chehab ret = gc0310_read_reg(client, GC0310_8BIT, 337ad85094bSMauro Carvalho Chehab GC0310_V_CROP_START_L, ®_val); 338ad85094bSMauro Carvalho Chehab if (ret) 339ad85094bSMauro Carvalho Chehab return ret; 340ad85094bSMauro Carvalho Chehab buf->crop_vertical_start = val | (reg_val & 0xFF); 341ad85094bSMauro Carvalho Chehab pr_info("crop_vertical_start=%d\n", buf->crop_vertical_start); 342ad85094bSMauro Carvalho Chehab 343ad85094bSMauro Carvalho Chehab /* Getting output_width */ 344ad85094bSMauro Carvalho Chehab ret = gc0310_read_reg(client, GC0310_8BIT, 345ad85094bSMauro Carvalho Chehab GC0310_H_OUTSIZE_H, ®_val); 346ad85094bSMauro Carvalho Chehab if (ret) 347ad85094bSMauro Carvalho Chehab return ret; 348ad85094bSMauro Carvalho Chehab val = (reg_val & 0xFF) << 8; 349ad85094bSMauro Carvalho Chehab ret = gc0310_read_reg(client, GC0310_8BIT, 350ad85094bSMauro Carvalho Chehab GC0310_H_OUTSIZE_L, ®_val); 351ad85094bSMauro Carvalho Chehab if (ret) 352ad85094bSMauro Carvalho Chehab return ret; 353ad85094bSMauro Carvalho Chehab buf->output_width = val | (reg_val & 0xFF); 354ad85094bSMauro Carvalho Chehab pr_info("output_width=%d\n", buf->output_width); 355ad85094bSMauro Carvalho Chehab 356ad85094bSMauro Carvalho Chehab /* Getting output_height */ 357ad85094bSMauro Carvalho Chehab ret = gc0310_read_reg(client, GC0310_8BIT, 358ad85094bSMauro Carvalho Chehab GC0310_V_OUTSIZE_H, ®_val); 359ad85094bSMauro Carvalho Chehab if (ret) 360ad85094bSMauro Carvalho Chehab return ret; 361ad85094bSMauro Carvalho Chehab val = (reg_val & 0xFF) << 8; 362ad85094bSMauro Carvalho Chehab ret = gc0310_read_reg(client, GC0310_8BIT, 363ad85094bSMauro Carvalho Chehab GC0310_V_OUTSIZE_L, ®_val); 364ad85094bSMauro Carvalho Chehab if (ret) 365ad85094bSMauro Carvalho Chehab return ret; 366ad85094bSMauro Carvalho Chehab buf->output_height = val | (reg_val & 0xFF); 367ad85094bSMauro Carvalho Chehab pr_info("output_height=%d\n", buf->output_height); 368ad85094bSMauro Carvalho Chehab 369ad85094bSMauro Carvalho Chehab buf->crop_horizontal_end = buf->crop_horizontal_start + buf->output_width - 1; 370ad85094bSMauro Carvalho Chehab buf->crop_vertical_end = buf->crop_vertical_start + buf->output_height - 1; 371ad85094bSMauro Carvalho Chehab pr_info("crop_horizontal_end=%d\n", buf->crop_horizontal_end); 372ad85094bSMauro Carvalho Chehab pr_info("crop_vertical_end=%d\n", buf->crop_vertical_end); 373ad85094bSMauro Carvalho Chehab 374ad85094bSMauro Carvalho Chehab /* Getting line_length_pck */ 375ad85094bSMauro Carvalho Chehab ret = gc0310_read_reg(client, GC0310_8BIT, 376ad85094bSMauro Carvalho Chehab GC0310_H_BLANKING_H, ®_val); 377ad85094bSMauro Carvalho Chehab if (ret) 378ad85094bSMauro Carvalho Chehab return ret; 379ad85094bSMauro Carvalho Chehab val = (reg_val & 0xFF) << 8; 380ad85094bSMauro Carvalho Chehab ret = gc0310_read_reg(client, GC0310_8BIT, 381ad85094bSMauro Carvalho Chehab GC0310_H_BLANKING_L, ®_val); 382ad85094bSMauro Carvalho Chehab if (ret) 383ad85094bSMauro Carvalho Chehab return ret; 384ad85094bSMauro Carvalho Chehab hori_blanking = val | (reg_val & 0xFF); 385ad85094bSMauro Carvalho Chehab ret = gc0310_read_reg(client, GC0310_8BIT, 386ad85094bSMauro Carvalho Chehab GC0310_SH_DELAY, ®_val); 387ad85094bSMauro Carvalho Chehab if (ret) 388ad85094bSMauro Carvalho Chehab return ret; 389ad85094bSMauro Carvalho Chehab sh_delay = reg_val; 390ad85094bSMauro Carvalho Chehab buf->line_length_pck = buf->output_width + hori_blanking + sh_delay + 4; 391eaa399ebSMauro Carvalho Chehab pr_info("hori_blanking=%d sh_delay=%d line_length_pck=%d\n", hori_blanking, 392eaa399ebSMauro Carvalho Chehab sh_delay, buf->line_length_pck); 393ad85094bSMauro Carvalho Chehab 394ad85094bSMauro Carvalho Chehab /* Getting frame_length_lines */ 395ad85094bSMauro Carvalho Chehab ret = gc0310_read_reg(client, GC0310_8BIT, 396ad85094bSMauro Carvalho Chehab GC0310_V_BLANKING_H, ®_val); 397ad85094bSMauro Carvalho Chehab if (ret) 398ad85094bSMauro Carvalho Chehab return ret; 399ad85094bSMauro Carvalho Chehab val = (reg_val & 0xFF) << 8; 400ad85094bSMauro Carvalho Chehab ret = gc0310_read_reg(client, GC0310_8BIT, 401ad85094bSMauro Carvalho Chehab GC0310_V_BLANKING_L, ®_val); 402ad85094bSMauro Carvalho Chehab if (ret) 403ad85094bSMauro Carvalho Chehab return ret; 404ad85094bSMauro Carvalho Chehab vert_blanking = val | (reg_val & 0xFF); 405ad85094bSMauro Carvalho Chehab buf->frame_length_lines = buf->output_height + vert_blanking; 406eaa399ebSMauro Carvalho Chehab pr_info("vert_blanking=%d frame_length_lines=%d\n", vert_blanking, 407eaa399ebSMauro Carvalho Chehab buf->frame_length_lines); 408ad85094bSMauro Carvalho Chehab 409ad85094bSMauro Carvalho Chehab buf->binning_factor_x = res->bin_factor_x ? 410ad85094bSMauro Carvalho Chehab res->bin_factor_x : 1; 411ad85094bSMauro Carvalho Chehab buf->binning_factor_y = res->bin_factor_y ? 412ad85094bSMauro Carvalho Chehab res->bin_factor_y : 1; 413ad85094bSMauro Carvalho Chehab return 0; 414ad85094bSMauro Carvalho Chehab } 415ad85094bSMauro Carvalho Chehab 416ad85094bSMauro Carvalho Chehab static int gc0310_set_gain(struct v4l2_subdev *sd, int gain) 417ad85094bSMauro Carvalho Chehab 418ad85094bSMauro Carvalho Chehab { 419ad85094bSMauro Carvalho Chehab struct i2c_client *client = v4l2_get_subdevdata(sd); 420ad85094bSMauro Carvalho Chehab int ret; 421ad85094bSMauro Carvalho Chehab u8 again, dgain; 422ad85094bSMauro Carvalho Chehab 423ad85094bSMauro Carvalho Chehab if (gain < 0x20) 424ad85094bSMauro Carvalho Chehab gain = 0x20; 425ad85094bSMauro Carvalho Chehab if (gain > 0x80) 426ad85094bSMauro Carvalho Chehab gain = 0x80; 427ad85094bSMauro Carvalho Chehab 428ad85094bSMauro Carvalho Chehab if (gain >= 0x20 && gain < 0x40) { 429ad85094bSMauro Carvalho Chehab again = 0x0; /* sqrt(2) */ 430ad85094bSMauro Carvalho Chehab dgain = gain; 431ad85094bSMauro Carvalho Chehab } else { 432ad85094bSMauro Carvalho Chehab again = 0x2; /* 2 * sqrt(2) */ 433ad85094bSMauro Carvalho Chehab dgain = gain / 2; 434ad85094bSMauro Carvalho Chehab } 435ad85094bSMauro Carvalho Chehab 436ad85094bSMauro Carvalho Chehab pr_info("gain=0x%x again=0x%x dgain=0x%x\n", gain, again, dgain); 437ad85094bSMauro Carvalho Chehab 438ad85094bSMauro Carvalho Chehab /* set analog gain */ 439ad85094bSMauro Carvalho Chehab ret = gc0310_write_reg(client, GC0310_8BIT, 440ad85094bSMauro Carvalho Chehab GC0310_AGC_ADJ, again); 441ad85094bSMauro Carvalho Chehab if (ret) 442ad85094bSMauro Carvalho Chehab return ret; 443ad85094bSMauro Carvalho Chehab 444ad85094bSMauro Carvalho Chehab /* set digital gain */ 445ad85094bSMauro Carvalho Chehab ret = gc0310_write_reg(client, GC0310_8BIT, 446ad85094bSMauro Carvalho Chehab GC0310_DGC_ADJ, dgain); 447ad85094bSMauro Carvalho Chehab if (ret) 448ad85094bSMauro Carvalho Chehab return ret; 449ad85094bSMauro Carvalho Chehab 450ad85094bSMauro Carvalho Chehab return 0; 451ad85094bSMauro Carvalho Chehab } 452ad85094bSMauro Carvalho Chehab 453ad85094bSMauro Carvalho Chehab static int __gc0310_set_exposure(struct v4l2_subdev *sd, int coarse_itg, 454ad85094bSMauro Carvalho Chehab int gain, int digitgain) 455ad85094bSMauro Carvalho Chehab 456ad85094bSMauro Carvalho Chehab { 457ad85094bSMauro Carvalho Chehab struct i2c_client *client = v4l2_get_subdevdata(sd); 458ad85094bSMauro Carvalho Chehab int ret; 459ad85094bSMauro Carvalho Chehab 460ad85094bSMauro Carvalho Chehab pr_info("coarse_itg=%d gain=%d digitgain=%d\n", coarse_itg, gain, digitgain); 461ad85094bSMauro Carvalho Chehab 462ad85094bSMauro Carvalho Chehab /* set exposure */ 463ad85094bSMauro Carvalho Chehab ret = gc0310_write_reg(client, GC0310_8BIT, 464ad85094bSMauro Carvalho Chehab GC0310_AEC_PK_EXPO_L, 465ad85094bSMauro Carvalho Chehab coarse_itg & 0xff); 466ad85094bSMauro Carvalho Chehab if (ret) 467ad85094bSMauro Carvalho Chehab return ret; 468ad85094bSMauro Carvalho Chehab 469ad85094bSMauro Carvalho Chehab ret = gc0310_write_reg(client, GC0310_8BIT, 470ad85094bSMauro Carvalho Chehab GC0310_AEC_PK_EXPO_H, 471ad85094bSMauro Carvalho Chehab (coarse_itg >> 8) & 0x0f); 472ad85094bSMauro Carvalho Chehab if (ret) 473ad85094bSMauro Carvalho Chehab return ret; 474ad85094bSMauro Carvalho Chehab 475ad85094bSMauro Carvalho Chehab ret = gc0310_set_gain(sd, gain); 476ad85094bSMauro Carvalho Chehab if (ret) 477ad85094bSMauro Carvalho Chehab return ret; 478ad85094bSMauro Carvalho Chehab 479ad85094bSMauro Carvalho Chehab return ret; 480ad85094bSMauro Carvalho Chehab } 481ad85094bSMauro Carvalho Chehab 482ad85094bSMauro Carvalho Chehab static int gc0310_set_exposure(struct v4l2_subdev *sd, int exposure, 483ad85094bSMauro Carvalho Chehab int gain, int digitgain) 484ad85094bSMauro Carvalho Chehab { 485ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 486ad85094bSMauro Carvalho Chehab int ret; 487ad85094bSMauro Carvalho Chehab 488ad85094bSMauro Carvalho Chehab mutex_lock(&dev->input_lock); 489ad85094bSMauro Carvalho Chehab ret = __gc0310_set_exposure(sd, exposure, gain, digitgain); 490ad85094bSMauro Carvalho Chehab mutex_unlock(&dev->input_lock); 491ad85094bSMauro Carvalho Chehab 492ad85094bSMauro Carvalho Chehab return ret; 493ad85094bSMauro Carvalho Chehab } 494ad85094bSMauro Carvalho Chehab 495ad85094bSMauro Carvalho Chehab static long gc0310_s_exposure(struct v4l2_subdev *sd, 496ad85094bSMauro Carvalho Chehab struct atomisp_exposure *exposure) 497ad85094bSMauro Carvalho Chehab { 498ad85094bSMauro Carvalho Chehab int exp = exposure->integration_time[0]; 499ad85094bSMauro Carvalho Chehab int gain = exposure->gain[0]; 500ad85094bSMauro Carvalho Chehab int digitgain = exposure->gain[1]; 501ad85094bSMauro Carvalho Chehab 502ad85094bSMauro Carvalho Chehab /* we should not accept the invalid value below. */ 503ad85094bSMauro Carvalho Chehab if (gain == 0) { 504ad85094bSMauro Carvalho Chehab struct i2c_client *client = v4l2_get_subdevdata(sd); 505bdfe0bebSMauro Carvalho Chehab 506ad85094bSMauro Carvalho Chehab v4l2_err(client, "%s: invalid value\n", __func__); 507ad85094bSMauro Carvalho Chehab return -EINVAL; 508ad85094bSMauro Carvalho Chehab } 509ad85094bSMauro Carvalho Chehab 510ad85094bSMauro Carvalho Chehab return gc0310_set_exposure(sd, exp, gain, digitgain); 511ad85094bSMauro Carvalho Chehab } 512ad85094bSMauro Carvalho Chehab 513ad85094bSMauro Carvalho Chehab /* TO DO */ 514ad85094bSMauro Carvalho Chehab static int gc0310_v_flip(struct v4l2_subdev *sd, s32 value) 515ad85094bSMauro Carvalho Chehab { 516ad85094bSMauro Carvalho Chehab return 0; 517ad85094bSMauro Carvalho Chehab } 518ad85094bSMauro Carvalho Chehab 519ad85094bSMauro Carvalho Chehab /* TO DO */ 520ad85094bSMauro Carvalho Chehab static int gc0310_h_flip(struct v4l2_subdev *sd, s32 value) 521ad85094bSMauro Carvalho Chehab { 522ad85094bSMauro Carvalho Chehab return 0; 523ad85094bSMauro Carvalho Chehab } 524ad85094bSMauro Carvalho Chehab 525ad85094bSMauro Carvalho Chehab static long gc0310_ioctl(struct v4l2_subdev *sd, unsigned int cmd, void *arg) 526ad85094bSMauro Carvalho Chehab { 527ad85094bSMauro Carvalho Chehab switch (cmd) { 528ad85094bSMauro Carvalho Chehab case ATOMISP_IOC_S_EXPOSURE: 529ad85094bSMauro Carvalho Chehab return gc0310_s_exposure(sd, arg); 530ad85094bSMauro Carvalho Chehab default: 531ad85094bSMauro Carvalho Chehab return -EINVAL; 532ad85094bSMauro Carvalho Chehab } 533ad85094bSMauro Carvalho Chehab return 0; 534ad85094bSMauro Carvalho Chehab } 535ad85094bSMauro Carvalho Chehab 536ad85094bSMauro Carvalho Chehab /* This returns the exposure time being used. This should only be used 537ad85094bSMauro Carvalho Chehab * for filling in EXIF data, not for actual image processing. 538ad85094bSMauro Carvalho Chehab */ 539ad85094bSMauro Carvalho Chehab static int gc0310_q_exposure(struct v4l2_subdev *sd, s32 *value) 540ad85094bSMauro Carvalho Chehab { 541ad85094bSMauro Carvalho Chehab struct i2c_client *client = v4l2_get_subdevdata(sd); 542ad85094bSMauro Carvalho Chehab u8 reg_v; 543ad85094bSMauro Carvalho Chehab int ret; 544ad85094bSMauro Carvalho Chehab 545ad85094bSMauro Carvalho Chehab /* get exposure */ 546ad85094bSMauro Carvalho Chehab ret = gc0310_read_reg(client, GC0310_8BIT, 547ad85094bSMauro Carvalho Chehab GC0310_AEC_PK_EXPO_L, 548ad85094bSMauro Carvalho Chehab ®_v); 549ad85094bSMauro Carvalho Chehab if (ret) 550ad85094bSMauro Carvalho Chehab goto err; 551ad85094bSMauro Carvalho Chehab 552ad85094bSMauro Carvalho Chehab *value = reg_v; 553ad85094bSMauro Carvalho Chehab ret = gc0310_read_reg(client, GC0310_8BIT, 554ad85094bSMauro Carvalho Chehab GC0310_AEC_PK_EXPO_H, 555ad85094bSMauro Carvalho Chehab ®_v); 556ad85094bSMauro Carvalho Chehab if (ret) 557ad85094bSMauro Carvalho Chehab goto err; 558ad85094bSMauro Carvalho Chehab 559ad85094bSMauro Carvalho Chehab *value = *value + (reg_v << 8); 560ad85094bSMauro Carvalho Chehab err: 561ad85094bSMauro Carvalho Chehab return ret; 562ad85094bSMauro Carvalho Chehab } 563ad85094bSMauro Carvalho Chehab 564ad85094bSMauro Carvalho Chehab static int gc0310_s_ctrl(struct v4l2_ctrl *ctrl) 565ad85094bSMauro Carvalho Chehab { 566ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = 567ad85094bSMauro Carvalho Chehab container_of(ctrl->handler, struct gc0310_device, ctrl_handler); 568ad85094bSMauro Carvalho Chehab struct i2c_client *client = v4l2_get_subdevdata(&dev->sd); 569ad85094bSMauro Carvalho Chehab int ret = 0; 570ad85094bSMauro Carvalho Chehab 571ad85094bSMauro Carvalho Chehab switch (ctrl->id) { 572ad85094bSMauro Carvalho Chehab case V4L2_CID_VFLIP: 573ad85094bSMauro Carvalho Chehab dev_dbg(&client->dev, "%s: CID_VFLIP:%d.\n", 574ad85094bSMauro Carvalho Chehab __func__, ctrl->val); 575ad85094bSMauro Carvalho Chehab ret = gc0310_v_flip(&dev->sd, ctrl->val); 576ad85094bSMauro Carvalho Chehab break; 577ad85094bSMauro Carvalho Chehab case V4L2_CID_HFLIP: 578ad85094bSMauro Carvalho Chehab dev_dbg(&client->dev, "%s: CID_HFLIP:%d.\n", 579ad85094bSMauro Carvalho Chehab __func__, ctrl->val); 580ad85094bSMauro Carvalho Chehab ret = gc0310_h_flip(&dev->sd, ctrl->val); 581ad85094bSMauro Carvalho Chehab break; 582ad85094bSMauro Carvalho Chehab default: 583ad85094bSMauro Carvalho Chehab ret = -EINVAL; 584ad85094bSMauro Carvalho Chehab } 585ad85094bSMauro Carvalho Chehab return ret; 586ad85094bSMauro Carvalho Chehab } 587ad85094bSMauro Carvalho Chehab 588ad85094bSMauro Carvalho Chehab static int gc0310_g_volatile_ctrl(struct v4l2_ctrl *ctrl) 589ad85094bSMauro Carvalho Chehab { 590ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = 591ad85094bSMauro Carvalho Chehab container_of(ctrl->handler, struct gc0310_device, ctrl_handler); 592ad85094bSMauro Carvalho Chehab int ret = 0; 593ad85094bSMauro Carvalho Chehab 594ad85094bSMauro Carvalho Chehab switch (ctrl->id) { 595ad85094bSMauro Carvalho Chehab case V4L2_CID_EXPOSURE_ABSOLUTE: 596ad85094bSMauro Carvalho Chehab ret = gc0310_q_exposure(&dev->sd, &ctrl->val); 597ad85094bSMauro Carvalho Chehab break; 598ad85094bSMauro Carvalho Chehab case V4L2_CID_FOCAL_ABSOLUTE: 599ad85094bSMauro Carvalho Chehab ret = gc0310_g_focal(&dev->sd, &ctrl->val); 600ad85094bSMauro Carvalho Chehab break; 601ad85094bSMauro Carvalho Chehab case V4L2_CID_FNUMBER_ABSOLUTE: 602ad85094bSMauro Carvalho Chehab ret = gc0310_g_fnumber(&dev->sd, &ctrl->val); 603ad85094bSMauro Carvalho Chehab break; 604ad85094bSMauro Carvalho Chehab case V4L2_CID_FNUMBER_RANGE: 605ad85094bSMauro Carvalho Chehab ret = gc0310_g_fnumber_range(&dev->sd, &ctrl->val); 606ad85094bSMauro Carvalho Chehab break; 607ad85094bSMauro Carvalho Chehab case V4L2_CID_BIN_FACTOR_HORZ: 608ad85094bSMauro Carvalho Chehab ret = gc0310_g_bin_factor_x(&dev->sd, &ctrl->val); 609ad85094bSMauro Carvalho Chehab break; 610ad85094bSMauro Carvalho Chehab case V4L2_CID_BIN_FACTOR_VERT: 611ad85094bSMauro Carvalho Chehab ret = gc0310_g_bin_factor_y(&dev->sd, &ctrl->val); 612ad85094bSMauro Carvalho Chehab break; 613ad85094bSMauro Carvalho Chehab default: 614ad85094bSMauro Carvalho Chehab ret = -EINVAL; 615ad85094bSMauro Carvalho Chehab } 616ad85094bSMauro Carvalho Chehab 617ad85094bSMauro Carvalho Chehab return ret; 618ad85094bSMauro Carvalho Chehab } 619ad85094bSMauro Carvalho Chehab 620ad85094bSMauro Carvalho Chehab static const struct v4l2_ctrl_ops ctrl_ops = { 621ad85094bSMauro Carvalho Chehab .s_ctrl = gc0310_s_ctrl, 622ad85094bSMauro Carvalho Chehab .g_volatile_ctrl = gc0310_g_volatile_ctrl 623ad85094bSMauro Carvalho Chehab }; 624ad85094bSMauro Carvalho Chehab 625ad85094bSMauro Carvalho Chehab static const struct v4l2_ctrl_config gc0310_controls[] = { 626ad85094bSMauro Carvalho Chehab { 627ad85094bSMauro Carvalho Chehab .ops = &ctrl_ops, 628ad85094bSMauro Carvalho Chehab .id = V4L2_CID_EXPOSURE_ABSOLUTE, 629ad85094bSMauro Carvalho Chehab .type = V4L2_CTRL_TYPE_INTEGER, 630ad85094bSMauro Carvalho Chehab .name = "exposure", 631ad85094bSMauro Carvalho Chehab .min = 0x0, 632ad85094bSMauro Carvalho Chehab .max = 0xffff, 633ad85094bSMauro Carvalho Chehab .step = 0x01, 634ad85094bSMauro Carvalho Chehab .def = 0x00, 635ad85094bSMauro Carvalho Chehab .flags = 0, 636ad85094bSMauro Carvalho Chehab }, 637ad85094bSMauro Carvalho Chehab { 638ad85094bSMauro Carvalho Chehab .ops = &ctrl_ops, 639ad85094bSMauro Carvalho Chehab .id = V4L2_CID_VFLIP, 640ad85094bSMauro Carvalho Chehab .type = V4L2_CTRL_TYPE_BOOLEAN, 641ad85094bSMauro Carvalho Chehab .name = "Flip", 642ad85094bSMauro Carvalho Chehab .min = 0, 643ad85094bSMauro Carvalho Chehab .max = 1, 644ad85094bSMauro Carvalho Chehab .step = 1, 645ad85094bSMauro Carvalho Chehab .def = 0, 646ad85094bSMauro Carvalho Chehab }, 647ad85094bSMauro Carvalho Chehab { 648ad85094bSMauro Carvalho Chehab .ops = &ctrl_ops, 649ad85094bSMauro Carvalho Chehab .id = V4L2_CID_HFLIP, 650ad85094bSMauro Carvalho Chehab .type = V4L2_CTRL_TYPE_BOOLEAN, 651ad85094bSMauro Carvalho Chehab .name = "Mirror", 652ad85094bSMauro Carvalho Chehab .min = 0, 653ad85094bSMauro Carvalho Chehab .max = 1, 654ad85094bSMauro Carvalho Chehab .step = 1, 655ad85094bSMauro Carvalho Chehab .def = 0, 656ad85094bSMauro Carvalho Chehab }, 657ad85094bSMauro Carvalho Chehab { 658ad85094bSMauro Carvalho Chehab .ops = &ctrl_ops, 659ad85094bSMauro Carvalho Chehab .id = V4L2_CID_FOCAL_ABSOLUTE, 660ad85094bSMauro Carvalho Chehab .type = V4L2_CTRL_TYPE_INTEGER, 661ad85094bSMauro Carvalho Chehab .name = "focal length", 662ad85094bSMauro Carvalho Chehab .min = GC0310_FOCAL_LENGTH_DEFAULT, 663ad85094bSMauro Carvalho Chehab .max = GC0310_FOCAL_LENGTH_DEFAULT, 664ad85094bSMauro Carvalho Chehab .step = 0x01, 665ad85094bSMauro Carvalho Chehab .def = GC0310_FOCAL_LENGTH_DEFAULT, 666ad85094bSMauro Carvalho Chehab .flags = 0, 667ad85094bSMauro Carvalho Chehab }, 668ad85094bSMauro Carvalho Chehab { 669ad85094bSMauro Carvalho Chehab .ops = &ctrl_ops, 670ad85094bSMauro Carvalho Chehab .id = V4L2_CID_FNUMBER_ABSOLUTE, 671ad85094bSMauro Carvalho Chehab .type = V4L2_CTRL_TYPE_INTEGER, 672ad85094bSMauro Carvalho Chehab .name = "f-number", 673ad85094bSMauro Carvalho Chehab .min = GC0310_F_NUMBER_DEFAULT, 674ad85094bSMauro Carvalho Chehab .max = GC0310_F_NUMBER_DEFAULT, 675ad85094bSMauro Carvalho Chehab .step = 0x01, 676ad85094bSMauro Carvalho Chehab .def = GC0310_F_NUMBER_DEFAULT, 677ad85094bSMauro Carvalho Chehab .flags = 0, 678ad85094bSMauro Carvalho Chehab }, 679ad85094bSMauro Carvalho Chehab { 680ad85094bSMauro Carvalho Chehab .ops = &ctrl_ops, 681ad85094bSMauro Carvalho Chehab .id = V4L2_CID_FNUMBER_RANGE, 682ad85094bSMauro Carvalho Chehab .type = V4L2_CTRL_TYPE_INTEGER, 683ad85094bSMauro Carvalho Chehab .name = "f-number range", 684ad85094bSMauro Carvalho Chehab .min = GC0310_F_NUMBER_RANGE, 685ad85094bSMauro Carvalho Chehab .max = GC0310_F_NUMBER_RANGE, 686ad85094bSMauro Carvalho Chehab .step = 0x01, 687ad85094bSMauro Carvalho Chehab .def = GC0310_F_NUMBER_RANGE, 688ad85094bSMauro Carvalho Chehab .flags = 0, 689ad85094bSMauro Carvalho Chehab }, 690ad85094bSMauro Carvalho Chehab { 691ad85094bSMauro Carvalho Chehab .ops = &ctrl_ops, 692ad85094bSMauro Carvalho Chehab .id = V4L2_CID_BIN_FACTOR_HORZ, 693ad85094bSMauro Carvalho Chehab .type = V4L2_CTRL_TYPE_INTEGER, 694ad85094bSMauro Carvalho Chehab .name = "horizontal binning factor", 695ad85094bSMauro Carvalho Chehab .min = 0, 696ad85094bSMauro Carvalho Chehab .max = GC0310_BIN_FACTOR_MAX, 697ad85094bSMauro Carvalho Chehab .step = 1, 698ad85094bSMauro Carvalho Chehab .def = 0, 699ad85094bSMauro Carvalho Chehab .flags = 0, 700ad85094bSMauro Carvalho Chehab }, 701ad85094bSMauro Carvalho Chehab { 702ad85094bSMauro Carvalho Chehab .ops = &ctrl_ops, 703ad85094bSMauro Carvalho Chehab .id = V4L2_CID_BIN_FACTOR_VERT, 704ad85094bSMauro Carvalho Chehab .type = V4L2_CTRL_TYPE_INTEGER, 705ad85094bSMauro Carvalho Chehab .name = "vertical binning factor", 706ad85094bSMauro Carvalho Chehab .min = 0, 707ad85094bSMauro Carvalho Chehab .max = GC0310_BIN_FACTOR_MAX, 708ad85094bSMauro Carvalho Chehab .step = 1, 709ad85094bSMauro Carvalho Chehab .def = 0, 710ad85094bSMauro Carvalho Chehab .flags = 0, 711ad85094bSMauro Carvalho Chehab }, 712ad85094bSMauro Carvalho Chehab }; 713ad85094bSMauro Carvalho Chehab 714ad85094bSMauro Carvalho Chehab static int gc0310_init(struct v4l2_subdev *sd) 715ad85094bSMauro Carvalho Chehab { 716ad85094bSMauro Carvalho Chehab int ret; 717ad85094bSMauro Carvalho Chehab struct i2c_client *client = v4l2_get_subdevdata(sd); 718ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 719ad85094bSMauro Carvalho Chehab 720ad85094bSMauro Carvalho Chehab pr_info("%s S\n", __func__); 721ad85094bSMauro Carvalho Chehab mutex_lock(&dev->input_lock); 722ad85094bSMauro Carvalho Chehab 7234636a85cSMauro Carvalho Chehab /* set initial registers */ 724ad85094bSMauro Carvalho Chehab ret = gc0310_write_reg_array(client, gc0310_reset_register); 725ad85094bSMauro Carvalho Chehab 726ad85094bSMauro Carvalho Chehab /* restore settings */ 727ad85094bSMauro Carvalho Chehab gc0310_res = gc0310_res_preview; 728ad85094bSMauro Carvalho Chehab N_RES = N_RES_PREVIEW; 729ad85094bSMauro Carvalho Chehab 730ad85094bSMauro Carvalho Chehab mutex_unlock(&dev->input_lock); 731ad85094bSMauro Carvalho Chehab 732ad85094bSMauro Carvalho Chehab pr_info("%s E\n", __func__); 733ad85094bSMauro Carvalho Chehab return ret; 734ad85094bSMauro Carvalho Chehab } 735ad85094bSMauro Carvalho Chehab 736ad85094bSMauro Carvalho Chehab static int power_ctrl(struct v4l2_subdev *sd, bool flag) 737ad85094bSMauro Carvalho Chehab { 738ad85094bSMauro Carvalho Chehab int ret = 0; 739ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 740bdfe0bebSMauro Carvalho Chehab 741ad85094bSMauro Carvalho Chehab if (!dev || !dev->platform_data) 742ad85094bSMauro Carvalho Chehab return -ENODEV; 743ad85094bSMauro Carvalho Chehab 744ad85094bSMauro Carvalho Chehab if (flag) { 745ad85094bSMauro Carvalho Chehab /* The upstream module driver (written to Crystal 746ad85094bSMauro Carvalho Chehab * Cove) had this logic to pulse the rails low first. 747ad85094bSMauro Carvalho Chehab * This appears to break things on the MRD7 with the 748ad85094bSMauro Carvalho Chehab * X-Powers PMIC... 749ad85094bSMauro Carvalho Chehab * 750ad85094bSMauro Carvalho Chehab * ret = dev->platform_data->v1p8_ctrl(sd, 0); 751ad85094bSMauro Carvalho Chehab * ret |= dev->platform_data->v2p8_ctrl(sd, 0); 752ad85094bSMauro Carvalho Chehab * mdelay(50); 753ad85094bSMauro Carvalho Chehab */ 754ad85094bSMauro Carvalho Chehab ret |= dev->platform_data->v1p8_ctrl(sd, 1); 755ad85094bSMauro Carvalho Chehab ret |= dev->platform_data->v2p8_ctrl(sd, 1); 756ad85094bSMauro Carvalho Chehab usleep_range(10000, 15000); 757ad85094bSMauro Carvalho Chehab } 758ad85094bSMauro Carvalho Chehab 759ad85094bSMauro Carvalho Chehab if (!flag || ret) { 760ad85094bSMauro Carvalho Chehab ret |= dev->platform_data->v1p8_ctrl(sd, 0); 761ad85094bSMauro Carvalho Chehab ret |= dev->platform_data->v2p8_ctrl(sd, 0); 762ad85094bSMauro Carvalho Chehab } 763ad85094bSMauro Carvalho Chehab return ret; 764ad85094bSMauro Carvalho Chehab } 765ad85094bSMauro Carvalho Chehab 766ad85094bSMauro Carvalho Chehab static int gpio_ctrl(struct v4l2_subdev *sd, bool flag) 767ad85094bSMauro Carvalho Chehab { 768ad85094bSMauro Carvalho Chehab int ret; 769ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 770ad85094bSMauro Carvalho Chehab 771ad85094bSMauro Carvalho Chehab if (!dev || !dev->platform_data) 772ad85094bSMauro Carvalho Chehab return -ENODEV; 773ad85094bSMauro Carvalho Chehab 774ad85094bSMauro Carvalho Chehab /* GPIO0 == "reset" (active low), GPIO1 == "power down" */ 775ad85094bSMauro Carvalho Chehab if (flag) { 776ad85094bSMauro Carvalho Chehab /* Pulse reset, then release power down */ 777ad85094bSMauro Carvalho Chehab ret = dev->platform_data->gpio0_ctrl(sd, 0); 778ad85094bSMauro Carvalho Chehab usleep_range(5000, 10000); 779ad85094bSMauro Carvalho Chehab ret |= dev->platform_data->gpio0_ctrl(sd, 1); 780ad85094bSMauro Carvalho Chehab usleep_range(10000, 15000); 781ad85094bSMauro Carvalho Chehab ret |= dev->platform_data->gpio1_ctrl(sd, 0); 782ad85094bSMauro Carvalho Chehab usleep_range(10000, 15000); 783ad85094bSMauro Carvalho Chehab } else { 784ad85094bSMauro Carvalho Chehab ret = dev->platform_data->gpio1_ctrl(sd, 1); 785ad85094bSMauro Carvalho Chehab ret |= dev->platform_data->gpio0_ctrl(sd, 0); 786ad85094bSMauro Carvalho Chehab } 787ad85094bSMauro Carvalho Chehab return ret; 788ad85094bSMauro Carvalho Chehab } 789ad85094bSMauro Carvalho Chehab 790ad85094bSMauro Carvalho Chehab static int power_down(struct v4l2_subdev *sd); 791ad85094bSMauro Carvalho Chehab 792ad85094bSMauro Carvalho Chehab static int power_up(struct v4l2_subdev *sd) 793ad85094bSMauro Carvalho Chehab { 794ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 795ad85094bSMauro Carvalho Chehab struct i2c_client *client = v4l2_get_subdevdata(sd); 796ad85094bSMauro Carvalho Chehab int ret; 797ad85094bSMauro Carvalho Chehab 798ad85094bSMauro Carvalho Chehab pr_info("%s S\n", __func__); 799ad85094bSMauro Carvalho Chehab if (!dev->platform_data) { 800ad85094bSMauro Carvalho Chehab dev_err(&client->dev, 801ad85094bSMauro Carvalho Chehab "no camera_sensor_platform_data"); 802ad85094bSMauro Carvalho Chehab return -ENODEV; 803ad85094bSMauro Carvalho Chehab } 804ad85094bSMauro Carvalho Chehab 805ad85094bSMauro Carvalho Chehab /* power control */ 806ad85094bSMauro Carvalho Chehab ret = power_ctrl(sd, 1); 807ad85094bSMauro Carvalho Chehab if (ret) 808ad85094bSMauro Carvalho Chehab goto fail_power; 809ad85094bSMauro Carvalho Chehab 810ad85094bSMauro Carvalho Chehab /* flis clock control */ 811ad85094bSMauro Carvalho Chehab ret = dev->platform_data->flisclk_ctrl(sd, 1); 812ad85094bSMauro Carvalho Chehab if (ret) 813ad85094bSMauro Carvalho Chehab goto fail_clk; 814ad85094bSMauro Carvalho Chehab 815ad85094bSMauro Carvalho Chehab /* gpio ctrl */ 816ad85094bSMauro Carvalho Chehab ret = gpio_ctrl(sd, 1); 817ad85094bSMauro Carvalho Chehab if (ret) { 818ad85094bSMauro Carvalho Chehab ret = gpio_ctrl(sd, 1); 819ad85094bSMauro Carvalho Chehab if (ret) 820ad85094bSMauro Carvalho Chehab goto fail_gpio; 821ad85094bSMauro Carvalho Chehab } 822ad85094bSMauro Carvalho Chehab 823ad85094bSMauro Carvalho Chehab msleep(100); 824ad85094bSMauro Carvalho Chehab 825ad85094bSMauro Carvalho Chehab pr_info("%s E\n", __func__); 826ad85094bSMauro Carvalho Chehab return 0; 827ad85094bSMauro Carvalho Chehab 828ad85094bSMauro Carvalho Chehab fail_gpio: 829ad85094bSMauro Carvalho Chehab dev->platform_data->flisclk_ctrl(sd, 0); 830ad85094bSMauro Carvalho Chehab fail_clk: 831ad85094bSMauro Carvalho Chehab power_ctrl(sd, 0); 832ad85094bSMauro Carvalho Chehab fail_power: 833ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "sensor power-up failed\n"); 834ad85094bSMauro Carvalho Chehab 835ad85094bSMauro Carvalho Chehab return ret; 836ad85094bSMauro Carvalho Chehab } 837ad85094bSMauro Carvalho Chehab 838ad85094bSMauro Carvalho Chehab static int power_down(struct v4l2_subdev *sd) 839ad85094bSMauro Carvalho Chehab { 840ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 841ad85094bSMauro Carvalho Chehab struct i2c_client *client = v4l2_get_subdevdata(sd); 842ad85094bSMauro Carvalho Chehab int ret = 0; 843ad85094bSMauro Carvalho Chehab 844ad85094bSMauro Carvalho Chehab if (!dev->platform_data) { 845ad85094bSMauro Carvalho Chehab dev_err(&client->dev, 846ad85094bSMauro Carvalho Chehab "no camera_sensor_platform_data"); 847ad85094bSMauro Carvalho Chehab return -ENODEV; 848ad85094bSMauro Carvalho Chehab } 849ad85094bSMauro Carvalho Chehab 850ad85094bSMauro Carvalho Chehab /* gpio ctrl */ 851ad85094bSMauro Carvalho Chehab ret = gpio_ctrl(sd, 0); 852ad85094bSMauro Carvalho Chehab if (ret) { 853ad85094bSMauro Carvalho Chehab ret = gpio_ctrl(sd, 0); 854ad85094bSMauro Carvalho Chehab if (ret) 855ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "gpio failed 2\n"); 856ad85094bSMauro Carvalho Chehab } 857ad85094bSMauro Carvalho Chehab 858ad85094bSMauro Carvalho Chehab ret = dev->platform_data->flisclk_ctrl(sd, 0); 859ad85094bSMauro Carvalho Chehab if (ret) 860ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "flisclk failed\n"); 861ad85094bSMauro Carvalho Chehab 862ad85094bSMauro Carvalho Chehab /* power control */ 863ad85094bSMauro Carvalho Chehab ret = power_ctrl(sd, 0); 864ad85094bSMauro Carvalho Chehab if (ret) 865ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "vprog failed.\n"); 866ad85094bSMauro Carvalho Chehab 867ad85094bSMauro Carvalho Chehab return ret; 868ad85094bSMauro Carvalho Chehab } 869ad85094bSMauro Carvalho Chehab 870ad85094bSMauro Carvalho Chehab static int gc0310_s_power(struct v4l2_subdev *sd, int on) 871ad85094bSMauro Carvalho Chehab { 872ad85094bSMauro Carvalho Chehab int ret; 873bdfe0bebSMauro Carvalho Chehab 874ad85094bSMauro Carvalho Chehab if (on == 0) 875ad85094bSMauro Carvalho Chehab return power_down(sd); 876ad85094bSMauro Carvalho Chehab else { 877ad85094bSMauro Carvalho Chehab ret = power_up(sd); 878ad85094bSMauro Carvalho Chehab if (!ret) 879ad85094bSMauro Carvalho Chehab return gc0310_init(sd); 880ad85094bSMauro Carvalho Chehab } 881ad85094bSMauro Carvalho Chehab return ret; 882ad85094bSMauro Carvalho Chehab } 883ad85094bSMauro Carvalho Chehab 884ad85094bSMauro Carvalho Chehab /* 885ad85094bSMauro Carvalho Chehab * distance - calculate the distance 886ad85094bSMauro Carvalho Chehab * @res: resolution 887ad85094bSMauro Carvalho Chehab * @w: width 888ad85094bSMauro Carvalho Chehab * @h: height 889ad85094bSMauro Carvalho Chehab * 890ad85094bSMauro Carvalho Chehab * Get the gap between resolution and w/h. 891ad85094bSMauro Carvalho Chehab * res->width/height smaller than w/h wouldn't be considered. 892ad85094bSMauro Carvalho Chehab * Returns the value of gap or -1 if fail. 893ad85094bSMauro Carvalho Chehab */ 894ad85094bSMauro Carvalho Chehab #define LARGEST_ALLOWED_RATIO_MISMATCH 800 895ad85094bSMauro Carvalho Chehab static int distance(struct gc0310_resolution *res, u32 w, u32 h) 896ad85094bSMauro Carvalho Chehab { 897ad85094bSMauro Carvalho Chehab unsigned int w_ratio = (res->width << 13) / w; 898ad85094bSMauro Carvalho Chehab unsigned int h_ratio; 899ad85094bSMauro Carvalho Chehab int match; 900ad85094bSMauro Carvalho Chehab 901ad85094bSMauro Carvalho Chehab if (h == 0) 902ad85094bSMauro Carvalho Chehab return -1; 903ad85094bSMauro Carvalho Chehab h_ratio = (res->height << 13) / h; 904ad85094bSMauro Carvalho Chehab if (h_ratio == 0) 905ad85094bSMauro Carvalho Chehab return -1; 906bdfe0bebSMauro Carvalho Chehab match = abs(((w_ratio << 13) / h_ratio) - 8192); 907ad85094bSMauro Carvalho Chehab 908bdfe0bebSMauro Carvalho Chehab if ((w_ratio < 8192) || (h_ratio < 8192) || 909ad85094bSMauro Carvalho Chehab (match > LARGEST_ALLOWED_RATIO_MISMATCH)) 910ad85094bSMauro Carvalho Chehab return -1; 911ad85094bSMauro Carvalho Chehab 912ad85094bSMauro Carvalho Chehab return w_ratio + h_ratio; 913ad85094bSMauro Carvalho Chehab } 914ad85094bSMauro Carvalho Chehab 915ad85094bSMauro Carvalho Chehab /* Return the nearest higher resolution index */ 916ad85094bSMauro Carvalho Chehab static int nearest_resolution_index(int w, int h) 917ad85094bSMauro Carvalho Chehab { 918ad85094bSMauro Carvalho Chehab int i; 919ad85094bSMauro Carvalho Chehab int idx = -1; 920ad85094bSMauro Carvalho Chehab int dist; 921ad85094bSMauro Carvalho Chehab int min_dist = INT_MAX; 922ad85094bSMauro Carvalho Chehab struct gc0310_resolution *tmp_res = NULL; 923ad85094bSMauro Carvalho Chehab 924ad85094bSMauro Carvalho Chehab for (i = 0; i < N_RES; i++) { 925ad85094bSMauro Carvalho Chehab tmp_res = &gc0310_res[i]; 926ad85094bSMauro Carvalho Chehab dist = distance(tmp_res, w, h); 927ad85094bSMauro Carvalho Chehab if (dist == -1) 928ad85094bSMauro Carvalho Chehab continue; 929ad85094bSMauro Carvalho Chehab if (dist < min_dist) { 930ad85094bSMauro Carvalho Chehab min_dist = dist; 931ad85094bSMauro Carvalho Chehab idx = i; 932ad85094bSMauro Carvalho Chehab } 933ad85094bSMauro Carvalho Chehab } 934ad85094bSMauro Carvalho Chehab 935ad85094bSMauro Carvalho Chehab return idx; 936ad85094bSMauro Carvalho Chehab } 937ad85094bSMauro Carvalho Chehab 938ad85094bSMauro Carvalho Chehab static int get_resolution_index(int w, int h) 939ad85094bSMauro Carvalho Chehab { 940ad85094bSMauro Carvalho Chehab int i; 941ad85094bSMauro Carvalho Chehab 942ad85094bSMauro Carvalho Chehab for (i = 0; i < N_RES; i++) { 943ad85094bSMauro Carvalho Chehab if (w != gc0310_res[i].width) 944ad85094bSMauro Carvalho Chehab continue; 945ad85094bSMauro Carvalho Chehab if (h != gc0310_res[i].height) 946ad85094bSMauro Carvalho Chehab continue; 947ad85094bSMauro Carvalho Chehab 948ad85094bSMauro Carvalho Chehab return i; 949ad85094bSMauro Carvalho Chehab } 950ad85094bSMauro Carvalho Chehab 951ad85094bSMauro Carvalho Chehab return -1; 952ad85094bSMauro Carvalho Chehab } 953ad85094bSMauro Carvalho Chehab 954ad85094bSMauro Carvalho Chehab /* TODO: remove it. */ 955ad85094bSMauro Carvalho Chehab static int startup(struct v4l2_subdev *sd) 956ad85094bSMauro Carvalho Chehab { 957ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 958ad85094bSMauro Carvalho Chehab struct i2c_client *client = v4l2_get_subdevdata(sd); 959ad85094bSMauro Carvalho Chehab int ret = 0; 960ad85094bSMauro Carvalho Chehab 961ad85094bSMauro Carvalho Chehab pr_info("%s S\n", __func__); 962ad85094bSMauro Carvalho Chehab 963ad85094bSMauro Carvalho Chehab ret = gc0310_write_reg_array(client, gc0310_res[dev->fmt_idx].regs); 964ad85094bSMauro Carvalho Chehab if (ret) { 965ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "gc0310 write register err.\n"); 966ad85094bSMauro Carvalho Chehab return ret; 967ad85094bSMauro Carvalho Chehab } 968ad85094bSMauro Carvalho Chehab 969ad85094bSMauro Carvalho Chehab pr_info("%s E\n", __func__); 970ad85094bSMauro Carvalho Chehab return ret; 971ad85094bSMauro Carvalho Chehab } 972ad85094bSMauro Carvalho Chehab 973ad85094bSMauro Carvalho Chehab static int gc0310_set_fmt(struct v4l2_subdev *sd, 974ad85094bSMauro Carvalho Chehab struct v4l2_subdev_pad_config *cfg, 975ad85094bSMauro Carvalho Chehab struct v4l2_subdev_format *format) 976ad85094bSMauro Carvalho Chehab { 977ad85094bSMauro Carvalho Chehab struct v4l2_mbus_framefmt *fmt = &format->format; 978ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 979ad85094bSMauro Carvalho Chehab struct i2c_client *client = v4l2_get_subdevdata(sd); 980ad85094bSMauro Carvalho Chehab struct camera_mipi_info *gc0310_info = NULL; 981ad85094bSMauro Carvalho Chehab int ret = 0; 982ad85094bSMauro Carvalho Chehab int idx = 0; 983bdfe0bebSMauro Carvalho Chehab 984ad85094bSMauro Carvalho Chehab pr_info("%s S\n", __func__); 985ad85094bSMauro Carvalho Chehab 986ad85094bSMauro Carvalho Chehab if (format->pad) 987ad85094bSMauro Carvalho Chehab return -EINVAL; 988ad85094bSMauro Carvalho Chehab 989ad85094bSMauro Carvalho Chehab if (!fmt) 990ad85094bSMauro Carvalho Chehab return -EINVAL; 991ad85094bSMauro Carvalho Chehab 992ad85094bSMauro Carvalho Chehab gc0310_info = v4l2_get_subdev_hostdata(sd); 993ad85094bSMauro Carvalho Chehab if (!gc0310_info) 994ad85094bSMauro Carvalho Chehab return -EINVAL; 995ad85094bSMauro Carvalho Chehab 996ad85094bSMauro Carvalho Chehab mutex_lock(&dev->input_lock); 997ad85094bSMauro Carvalho Chehab 998ad85094bSMauro Carvalho Chehab idx = nearest_resolution_index(fmt->width, fmt->height); 999ad85094bSMauro Carvalho Chehab if (idx == -1) { 1000ad85094bSMauro Carvalho Chehab /* return the largest resolution */ 1001ad85094bSMauro Carvalho Chehab fmt->width = gc0310_res[N_RES - 1].width; 1002ad85094bSMauro Carvalho Chehab fmt->height = gc0310_res[N_RES - 1].height; 1003ad85094bSMauro Carvalho Chehab } else { 1004ad85094bSMauro Carvalho Chehab fmt->width = gc0310_res[idx].width; 1005ad85094bSMauro Carvalho Chehab fmt->height = gc0310_res[idx].height; 1006ad85094bSMauro Carvalho Chehab } 1007ad85094bSMauro Carvalho Chehab fmt->code = MEDIA_BUS_FMT_SGRBG8_1X8; 1008ad85094bSMauro Carvalho Chehab 1009ad85094bSMauro Carvalho Chehab if (format->which == V4L2_SUBDEV_FORMAT_TRY) { 1010ad85094bSMauro Carvalho Chehab cfg->try_fmt = *fmt; 1011ad85094bSMauro Carvalho Chehab mutex_unlock(&dev->input_lock); 1012ad85094bSMauro Carvalho Chehab return 0; 1013ad85094bSMauro Carvalho Chehab } 1014ad85094bSMauro Carvalho Chehab 1015ad85094bSMauro Carvalho Chehab dev->fmt_idx = get_resolution_index(fmt->width, fmt->height); 1016ad85094bSMauro Carvalho Chehab if (dev->fmt_idx == -1) { 1017ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "get resolution fail\n"); 1018ad85094bSMauro Carvalho Chehab mutex_unlock(&dev->input_lock); 1019ad85094bSMauro Carvalho Chehab return -EINVAL; 1020ad85094bSMauro Carvalho Chehab } 1021ad85094bSMauro Carvalho Chehab 1022bdfe0bebSMauro Carvalho Chehab printk("%s: before gc0310_write_reg_array %s\n", __func__, 1023ad85094bSMauro Carvalho Chehab gc0310_res[dev->fmt_idx].desc); 1024ad85094bSMauro Carvalho Chehab ret = startup(sd); 1025ad85094bSMauro Carvalho Chehab if (ret) { 1026ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "gc0310 startup err\n"); 1027ad85094bSMauro Carvalho Chehab goto err; 1028ad85094bSMauro Carvalho Chehab } 1029ad85094bSMauro Carvalho Chehab 1030ad85094bSMauro Carvalho Chehab ret = gc0310_get_intg_factor(client, gc0310_info, 1031ad85094bSMauro Carvalho Chehab &gc0310_res[dev->fmt_idx]); 1032ad85094bSMauro Carvalho Chehab if (ret) { 1033ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "failed to get integration_factor\n"); 1034ad85094bSMauro Carvalho Chehab goto err; 1035ad85094bSMauro Carvalho Chehab } 1036ad85094bSMauro Carvalho Chehab 1037ad85094bSMauro Carvalho Chehab pr_info("%s E\n", __func__); 1038ad85094bSMauro Carvalho Chehab err: 1039ad85094bSMauro Carvalho Chehab mutex_unlock(&dev->input_lock); 1040ad85094bSMauro Carvalho Chehab return ret; 1041ad85094bSMauro Carvalho Chehab } 1042ad85094bSMauro Carvalho Chehab 1043ad85094bSMauro Carvalho Chehab static int gc0310_get_fmt(struct v4l2_subdev *sd, 1044ad85094bSMauro Carvalho Chehab struct v4l2_subdev_pad_config *cfg, 1045ad85094bSMauro Carvalho Chehab struct v4l2_subdev_format *format) 1046ad85094bSMauro Carvalho Chehab { 1047ad85094bSMauro Carvalho Chehab struct v4l2_mbus_framefmt *fmt = &format->format; 1048ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 1049ad85094bSMauro Carvalho Chehab 1050ad85094bSMauro Carvalho Chehab if (format->pad) 1051ad85094bSMauro Carvalho Chehab return -EINVAL; 1052ad85094bSMauro Carvalho Chehab 1053ad85094bSMauro Carvalho Chehab if (!fmt) 1054ad85094bSMauro Carvalho Chehab return -EINVAL; 1055ad85094bSMauro Carvalho Chehab 1056ad85094bSMauro Carvalho Chehab fmt->width = gc0310_res[dev->fmt_idx].width; 1057ad85094bSMauro Carvalho Chehab fmt->height = gc0310_res[dev->fmt_idx].height; 1058ad85094bSMauro Carvalho Chehab fmt->code = MEDIA_BUS_FMT_SGRBG8_1X8; 1059ad85094bSMauro Carvalho Chehab 1060ad85094bSMauro Carvalho Chehab return 0; 1061ad85094bSMauro Carvalho Chehab } 1062ad85094bSMauro Carvalho Chehab 1063ad85094bSMauro Carvalho Chehab static int gc0310_detect(struct i2c_client *client) 1064ad85094bSMauro Carvalho Chehab { 1065ad85094bSMauro Carvalho Chehab struct i2c_adapter *adapter = client->adapter; 1066ad85094bSMauro Carvalho Chehab u8 high, low; 1067ad85094bSMauro Carvalho Chehab int ret; 1068ad85094bSMauro Carvalho Chehab u16 id; 1069ad85094bSMauro Carvalho Chehab 1070ad85094bSMauro Carvalho Chehab pr_info("%s S\n", __func__); 1071ad85094bSMauro Carvalho Chehab if (!i2c_check_functionality(adapter, I2C_FUNC_I2C)) 1072ad85094bSMauro Carvalho Chehab return -ENODEV; 1073ad85094bSMauro Carvalho Chehab 1074ad85094bSMauro Carvalho Chehab ret = gc0310_read_reg(client, GC0310_8BIT, 1075ad85094bSMauro Carvalho Chehab GC0310_SC_CMMN_CHIP_ID_H, &high); 1076ad85094bSMauro Carvalho Chehab if (ret) { 1077ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "read sensor_id_high failed\n"); 1078ad85094bSMauro Carvalho Chehab return -ENODEV; 1079ad85094bSMauro Carvalho Chehab } 1080ad85094bSMauro Carvalho Chehab ret = gc0310_read_reg(client, GC0310_8BIT, 1081ad85094bSMauro Carvalho Chehab GC0310_SC_CMMN_CHIP_ID_L, &low); 1082ad85094bSMauro Carvalho Chehab if (ret) { 1083ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "read sensor_id_low failed\n"); 1084ad85094bSMauro Carvalho Chehab return -ENODEV; 1085ad85094bSMauro Carvalho Chehab } 1086ad85094bSMauro Carvalho Chehab id = ((((u16)high) << 8) | (u16)low); 1087ad85094bSMauro Carvalho Chehab pr_info("sensor ID = 0x%x\n", id); 1088ad85094bSMauro Carvalho Chehab 1089ad85094bSMauro Carvalho Chehab if (id != GC0310_ID) { 1090eaa399ebSMauro Carvalho Chehab dev_err(&client->dev, "sensor ID error, read id = 0x%x, target id = 0x%x\n", id, 1091eaa399ebSMauro Carvalho Chehab GC0310_ID); 1092ad85094bSMauro Carvalho Chehab return -ENODEV; 1093ad85094bSMauro Carvalho Chehab } 1094ad85094bSMauro Carvalho Chehab 1095ad85094bSMauro Carvalho Chehab dev_dbg(&client->dev, "detect gc0310 success\n"); 1096ad85094bSMauro Carvalho Chehab 1097ad85094bSMauro Carvalho Chehab pr_info("%s E\n", __func__); 1098ad85094bSMauro Carvalho Chehab 1099ad85094bSMauro Carvalho Chehab return 0; 1100ad85094bSMauro Carvalho Chehab } 1101ad85094bSMauro Carvalho Chehab 1102ad85094bSMauro Carvalho Chehab static int gc0310_s_stream(struct v4l2_subdev *sd, int enable) 1103ad85094bSMauro Carvalho Chehab { 1104ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 1105ad85094bSMauro Carvalho Chehab struct i2c_client *client = v4l2_get_subdevdata(sd); 1106ad85094bSMauro Carvalho Chehab int ret; 1107ad85094bSMauro Carvalho Chehab 1108ad85094bSMauro Carvalho Chehab pr_info("%s S enable=%d\n", __func__, enable); 1109ad85094bSMauro Carvalho Chehab mutex_lock(&dev->input_lock); 1110ad85094bSMauro Carvalho Chehab 1111ad85094bSMauro Carvalho Chehab if (enable) { 1112ad85094bSMauro Carvalho Chehab /* enable per frame MIPI and sensor ctrl reset */ 1113ad85094bSMauro Carvalho Chehab ret = gc0310_write_reg(client, GC0310_8BIT, 1114ad85094bSMauro Carvalho Chehab 0xFE, 0x30); 1115ad85094bSMauro Carvalho Chehab if (ret) { 1116ad85094bSMauro Carvalho Chehab mutex_unlock(&dev->input_lock); 1117ad85094bSMauro Carvalho Chehab return ret; 1118ad85094bSMauro Carvalho Chehab } 1119ad85094bSMauro Carvalho Chehab } 1120ad85094bSMauro Carvalho Chehab 1121ad85094bSMauro Carvalho Chehab ret = gc0310_write_reg(client, GC0310_8BIT, 1122ad85094bSMauro Carvalho Chehab GC0310_RESET_RELATED, GC0310_REGISTER_PAGE_3); 1123ad85094bSMauro Carvalho Chehab if (ret) { 1124ad85094bSMauro Carvalho Chehab mutex_unlock(&dev->input_lock); 1125ad85094bSMauro Carvalho Chehab return ret; 1126ad85094bSMauro Carvalho Chehab } 1127ad85094bSMauro Carvalho Chehab 1128ad85094bSMauro Carvalho Chehab ret = gc0310_write_reg(client, GC0310_8BIT, GC0310_SW_STREAM, 1129ad85094bSMauro Carvalho Chehab enable ? GC0310_START_STREAMING : 1130ad85094bSMauro Carvalho Chehab GC0310_STOP_STREAMING); 1131ad85094bSMauro Carvalho Chehab if (ret) { 1132ad85094bSMauro Carvalho Chehab mutex_unlock(&dev->input_lock); 1133ad85094bSMauro Carvalho Chehab return ret; 1134ad85094bSMauro Carvalho Chehab } 1135ad85094bSMauro Carvalho Chehab 1136ad85094bSMauro Carvalho Chehab ret = gc0310_write_reg(client, GC0310_8BIT, 1137ad85094bSMauro Carvalho Chehab GC0310_RESET_RELATED, GC0310_REGISTER_PAGE_0); 1138ad85094bSMauro Carvalho Chehab if (ret) { 1139ad85094bSMauro Carvalho Chehab mutex_unlock(&dev->input_lock); 1140ad85094bSMauro Carvalho Chehab return ret; 1141ad85094bSMauro Carvalho Chehab } 1142ad85094bSMauro Carvalho Chehab 1143ad85094bSMauro Carvalho Chehab mutex_unlock(&dev->input_lock); 1144ad85094bSMauro Carvalho Chehab pr_info("%s E\n", __func__); 1145ad85094bSMauro Carvalho Chehab return ret; 1146ad85094bSMauro Carvalho Chehab } 1147ad85094bSMauro Carvalho Chehab 1148ad85094bSMauro Carvalho Chehab static int gc0310_s_config(struct v4l2_subdev *sd, 1149ad85094bSMauro Carvalho Chehab int irq, void *platform_data) 1150ad85094bSMauro Carvalho Chehab { 1151ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 1152ad85094bSMauro Carvalho Chehab struct i2c_client *client = v4l2_get_subdevdata(sd); 1153ad85094bSMauro Carvalho Chehab int ret = 0; 1154ad85094bSMauro Carvalho Chehab 1155ad85094bSMauro Carvalho Chehab pr_info("%s S\n", __func__); 1156ad85094bSMauro Carvalho Chehab if (!platform_data) 1157ad85094bSMauro Carvalho Chehab return -ENODEV; 1158ad85094bSMauro Carvalho Chehab 1159ad85094bSMauro Carvalho Chehab dev->platform_data = 1160ad85094bSMauro Carvalho Chehab (struct camera_sensor_platform_data *)platform_data; 1161ad85094bSMauro Carvalho Chehab 1162ad85094bSMauro Carvalho Chehab mutex_lock(&dev->input_lock); 1163ad85094bSMauro Carvalho Chehab /* power off the module, then power on it in future 1164ad85094bSMauro Carvalho Chehab * as first power on by board may not fulfill the 1165ad85094bSMauro Carvalho Chehab * power on sequqence needed by the module 1166ad85094bSMauro Carvalho Chehab */ 1167ad85094bSMauro Carvalho Chehab ret = power_down(sd); 1168ad85094bSMauro Carvalho Chehab if (ret) { 1169ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "gc0310 power-off err.\n"); 1170ad85094bSMauro Carvalho Chehab goto fail_power_off; 1171ad85094bSMauro Carvalho Chehab } 1172ad85094bSMauro Carvalho Chehab 1173ad85094bSMauro Carvalho Chehab ret = power_up(sd); 1174ad85094bSMauro Carvalho Chehab if (ret) { 1175ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "gc0310 power-up err.\n"); 1176ad85094bSMauro Carvalho Chehab goto fail_power_on; 1177ad85094bSMauro Carvalho Chehab } 1178ad85094bSMauro Carvalho Chehab 1179ad85094bSMauro Carvalho Chehab ret = dev->platform_data->csi_cfg(sd, 1); 1180ad85094bSMauro Carvalho Chehab if (ret) 1181ad85094bSMauro Carvalho Chehab goto fail_csi_cfg; 1182ad85094bSMauro Carvalho Chehab 1183ad85094bSMauro Carvalho Chehab /* config & detect sensor */ 1184ad85094bSMauro Carvalho Chehab ret = gc0310_detect(client); 1185ad85094bSMauro Carvalho Chehab if (ret) { 1186ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "gc0310_detect err s_config.\n"); 1187ad85094bSMauro Carvalho Chehab goto fail_csi_cfg; 1188ad85094bSMauro Carvalho Chehab } 1189ad85094bSMauro Carvalho Chehab 1190ad85094bSMauro Carvalho Chehab /* turn off sensor, after probed */ 1191ad85094bSMauro Carvalho Chehab ret = power_down(sd); 1192ad85094bSMauro Carvalho Chehab if (ret) { 1193ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "gc0310 power-off err.\n"); 1194ad85094bSMauro Carvalho Chehab goto fail_csi_cfg; 1195ad85094bSMauro Carvalho Chehab } 1196ad85094bSMauro Carvalho Chehab mutex_unlock(&dev->input_lock); 1197ad85094bSMauro Carvalho Chehab 1198ad85094bSMauro Carvalho Chehab pr_info("%s E\n", __func__); 1199ad85094bSMauro Carvalho Chehab return 0; 1200ad85094bSMauro Carvalho Chehab 1201ad85094bSMauro Carvalho Chehab fail_csi_cfg: 1202ad85094bSMauro Carvalho Chehab dev->platform_data->csi_cfg(sd, 0); 1203ad85094bSMauro Carvalho Chehab fail_power_on: 1204ad85094bSMauro Carvalho Chehab power_down(sd); 1205ad85094bSMauro Carvalho Chehab dev_err(&client->dev, "sensor power-gating failed\n"); 1206ad85094bSMauro Carvalho Chehab fail_power_off: 1207ad85094bSMauro Carvalho Chehab mutex_unlock(&dev->input_lock); 1208ad85094bSMauro Carvalho Chehab return ret; 1209ad85094bSMauro Carvalho Chehab } 1210ad85094bSMauro Carvalho Chehab 1211ad85094bSMauro Carvalho Chehab static int gc0310_g_frame_interval(struct v4l2_subdev *sd, 1212ad85094bSMauro Carvalho Chehab struct v4l2_subdev_frame_interval *interval) 1213ad85094bSMauro Carvalho Chehab { 1214ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 1215ad85094bSMauro Carvalho Chehab 1216ad85094bSMauro Carvalho Chehab interval->interval.numerator = 1; 1217ad85094bSMauro Carvalho Chehab interval->interval.denominator = gc0310_res[dev->fmt_idx].fps; 1218ad85094bSMauro Carvalho Chehab 1219ad85094bSMauro Carvalho Chehab return 0; 1220ad85094bSMauro Carvalho Chehab } 1221ad85094bSMauro Carvalho Chehab 1222ad85094bSMauro Carvalho Chehab static int gc0310_enum_mbus_code(struct v4l2_subdev *sd, 1223ad85094bSMauro Carvalho Chehab struct v4l2_subdev_pad_config *cfg, 1224ad85094bSMauro Carvalho Chehab struct v4l2_subdev_mbus_code_enum *code) 1225ad85094bSMauro Carvalho Chehab { 1226ad85094bSMauro Carvalho Chehab if (code->index >= MAX_FMTS) 1227ad85094bSMauro Carvalho Chehab return -EINVAL; 1228ad85094bSMauro Carvalho Chehab 1229ad85094bSMauro Carvalho Chehab code->code = MEDIA_BUS_FMT_SGRBG8_1X8; 1230ad85094bSMauro Carvalho Chehab return 0; 1231ad85094bSMauro Carvalho Chehab } 1232ad85094bSMauro Carvalho Chehab 1233ad85094bSMauro Carvalho Chehab static int gc0310_enum_frame_size(struct v4l2_subdev *sd, 1234ad85094bSMauro Carvalho Chehab struct v4l2_subdev_pad_config *cfg, 1235ad85094bSMauro Carvalho Chehab struct v4l2_subdev_frame_size_enum *fse) 1236ad85094bSMauro Carvalho Chehab { 1237ad85094bSMauro Carvalho Chehab int index = fse->index; 1238ad85094bSMauro Carvalho Chehab 1239ad85094bSMauro Carvalho Chehab if (index >= N_RES) 1240ad85094bSMauro Carvalho Chehab return -EINVAL; 1241ad85094bSMauro Carvalho Chehab 1242ad85094bSMauro Carvalho Chehab fse->min_width = gc0310_res[index].width; 1243ad85094bSMauro Carvalho Chehab fse->min_height = gc0310_res[index].height; 1244ad85094bSMauro Carvalho Chehab fse->max_width = gc0310_res[index].width; 1245ad85094bSMauro Carvalho Chehab fse->max_height = gc0310_res[index].height; 1246ad85094bSMauro Carvalho Chehab 1247ad85094bSMauro Carvalho Chehab return 0; 1248ad85094bSMauro Carvalho Chehab } 1249ad85094bSMauro Carvalho Chehab 1250ad85094bSMauro Carvalho Chehab static int gc0310_g_skip_frames(struct v4l2_subdev *sd, u32 *frames) 1251ad85094bSMauro Carvalho Chehab { 1252ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 1253ad85094bSMauro Carvalho Chehab 1254ad85094bSMauro Carvalho Chehab mutex_lock(&dev->input_lock); 1255ad85094bSMauro Carvalho Chehab *frames = gc0310_res[dev->fmt_idx].skip_frames; 1256ad85094bSMauro Carvalho Chehab mutex_unlock(&dev->input_lock); 1257ad85094bSMauro Carvalho Chehab 1258ad85094bSMauro Carvalho Chehab return 0; 1259ad85094bSMauro Carvalho Chehab } 1260ad85094bSMauro Carvalho Chehab 1261ad85094bSMauro Carvalho Chehab static const struct v4l2_subdev_sensor_ops gc0310_sensor_ops = { 1262ad85094bSMauro Carvalho Chehab .g_skip_frames = gc0310_g_skip_frames, 1263ad85094bSMauro Carvalho Chehab }; 1264ad85094bSMauro Carvalho Chehab 1265ad85094bSMauro Carvalho Chehab static const struct v4l2_subdev_video_ops gc0310_video_ops = { 1266ad85094bSMauro Carvalho Chehab .s_stream = gc0310_s_stream, 1267ad85094bSMauro Carvalho Chehab .g_frame_interval = gc0310_g_frame_interval, 1268ad85094bSMauro Carvalho Chehab }; 1269ad85094bSMauro Carvalho Chehab 1270ad85094bSMauro Carvalho Chehab static const struct v4l2_subdev_core_ops gc0310_core_ops = { 1271ad85094bSMauro Carvalho Chehab .s_power = gc0310_s_power, 1272ad85094bSMauro Carvalho Chehab .ioctl = gc0310_ioctl, 1273ad85094bSMauro Carvalho Chehab }; 1274ad85094bSMauro Carvalho Chehab 1275ad85094bSMauro Carvalho Chehab static const struct v4l2_subdev_pad_ops gc0310_pad_ops = { 1276ad85094bSMauro Carvalho Chehab .enum_mbus_code = gc0310_enum_mbus_code, 1277ad85094bSMauro Carvalho Chehab .enum_frame_size = gc0310_enum_frame_size, 1278ad85094bSMauro Carvalho Chehab .get_fmt = gc0310_get_fmt, 1279ad85094bSMauro Carvalho Chehab .set_fmt = gc0310_set_fmt, 1280ad85094bSMauro Carvalho Chehab }; 1281ad85094bSMauro Carvalho Chehab 1282ad85094bSMauro Carvalho Chehab static const struct v4l2_subdev_ops gc0310_ops = { 1283ad85094bSMauro Carvalho Chehab .core = &gc0310_core_ops, 1284ad85094bSMauro Carvalho Chehab .video = &gc0310_video_ops, 1285ad85094bSMauro Carvalho Chehab .pad = &gc0310_pad_ops, 1286ad85094bSMauro Carvalho Chehab .sensor = &gc0310_sensor_ops, 1287ad85094bSMauro Carvalho Chehab }; 1288ad85094bSMauro Carvalho Chehab 1289ad85094bSMauro Carvalho Chehab static int gc0310_remove(struct i2c_client *client) 1290ad85094bSMauro Carvalho Chehab { 1291ad85094bSMauro Carvalho Chehab struct v4l2_subdev *sd = i2c_get_clientdata(client); 1292ad85094bSMauro Carvalho Chehab struct gc0310_device *dev = to_gc0310_sensor(sd); 1293bdfe0bebSMauro Carvalho Chehab 1294ad85094bSMauro Carvalho Chehab dev_dbg(&client->dev, "gc0310_remove...\n"); 1295ad85094bSMauro Carvalho Chehab 1296ad85094bSMauro Carvalho Chehab dev->platform_data->csi_cfg(sd, 0); 1297ad85094bSMauro Carvalho Chehab 1298ad85094bSMauro Carvalho Chehab v4l2_device_unregister_subdev(sd); 1299ad85094bSMauro Carvalho Chehab media_entity_cleanup(&dev->sd.entity); 1300ad85094bSMauro Carvalho Chehab v4l2_ctrl_handler_free(&dev->ctrl_handler); 1301ad85094bSMauro Carvalho Chehab kfree(dev); 1302ad85094bSMauro Carvalho Chehab 1303ad85094bSMauro Carvalho Chehab return 0; 1304ad85094bSMauro Carvalho Chehab } 1305ad85094bSMauro Carvalho Chehab 1306ad85094bSMauro Carvalho Chehab static int gc0310_probe(struct i2c_client *client) 1307ad85094bSMauro Carvalho Chehab { 1308ad85094bSMauro Carvalho Chehab struct gc0310_device *dev; 1309ad85094bSMauro Carvalho Chehab int ret; 1310ad85094bSMauro Carvalho Chehab void *pdata; 1311ad85094bSMauro Carvalho Chehab unsigned int i; 13120d64e942SMauro Carvalho Chehab acpi_handle handle; 13130d64e942SMauro Carvalho Chehab struct acpi_device *adev; 1314ad85094bSMauro Carvalho Chehab 13150d64e942SMauro Carvalho Chehab handle = ACPI_HANDLE(&client->dev); 13160d64e942SMauro Carvalho Chehab if (!handle || acpi_bus_get_device(handle, &adev)) { 13170d64e942SMauro Carvalho Chehab dev_err(&client->dev, "Error could not get ACPI device\n"); 13180d64e942SMauro Carvalho Chehab return -ENODEV; 13190d64e942SMauro Carvalho Chehab } 13200d64e942SMauro Carvalho Chehab pr_info("%s: ACPI detected it on bus ID=%s, HID=%s\n", 13210d64e942SMauro Carvalho Chehab __func__, acpi_device_bid(adev), acpi_device_hid(adev)); 1322c03496b3SMauro Carvalho Chehab // FIXME: may need to release resources allocated by acpi_bus_get_device() 1323c03496b3SMauro Carvalho Chehab 13240d64e942SMauro Carvalho Chehab 1325ad85094bSMauro Carvalho Chehab dev = kzalloc(sizeof(*dev), GFP_KERNEL); 1326ad85094bSMauro Carvalho Chehab if (!dev) 1327ad85094bSMauro Carvalho Chehab return -ENOMEM; 1328ad85094bSMauro Carvalho Chehab 1329ad85094bSMauro Carvalho Chehab mutex_init(&dev->input_lock); 1330ad85094bSMauro Carvalho Chehab 1331ad85094bSMauro Carvalho Chehab dev->fmt_idx = 0; 1332bdfe0bebSMauro Carvalho Chehab v4l2_i2c_subdev_init(&dev->sd, client, &gc0310_ops); 1333ad85094bSMauro Carvalho Chehab 1334ad85094bSMauro Carvalho Chehab pdata = gmin_camera_platform_data(&dev->sd, 1335ad85094bSMauro Carvalho Chehab ATOMISP_INPUT_FORMAT_RAW_8, 1336ad85094bSMauro Carvalho Chehab atomisp_bayer_order_grbg); 1337ad85094bSMauro Carvalho Chehab if (!pdata) { 1338ad85094bSMauro Carvalho Chehab ret = -EINVAL; 1339ad85094bSMauro Carvalho Chehab goto out_free; 1340ad85094bSMauro Carvalho Chehab } 1341ad85094bSMauro Carvalho Chehab 1342ad85094bSMauro Carvalho Chehab ret = gc0310_s_config(&dev->sd, client->irq, pdata); 1343ad85094bSMauro Carvalho Chehab if (ret) 1344ad85094bSMauro Carvalho Chehab goto out_free; 1345ad85094bSMauro Carvalho Chehab 1346ad85094bSMauro Carvalho Chehab ret = atomisp_register_i2c_module(&dev->sd, pdata, RAW_CAMERA); 1347ad85094bSMauro Carvalho Chehab if (ret) 1348ad85094bSMauro Carvalho Chehab goto out_free; 1349ad85094bSMauro Carvalho Chehab 1350ad85094bSMauro Carvalho Chehab dev->sd.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE; 1351ad85094bSMauro Carvalho Chehab dev->pad.flags = MEDIA_PAD_FL_SOURCE; 1352ad85094bSMauro Carvalho Chehab dev->format.code = MEDIA_BUS_FMT_SGRBG8_1X8; 1353ad85094bSMauro Carvalho Chehab dev->sd.entity.function = MEDIA_ENT_F_CAM_SENSOR; 1354ad85094bSMauro Carvalho Chehab ret = 1355ad85094bSMauro Carvalho Chehab v4l2_ctrl_handler_init(&dev->ctrl_handler, 1356ad85094bSMauro Carvalho Chehab ARRAY_SIZE(gc0310_controls)); 1357ad85094bSMauro Carvalho Chehab if (ret) { 1358ad85094bSMauro Carvalho Chehab gc0310_remove(client); 1359ad85094bSMauro Carvalho Chehab return ret; 1360ad85094bSMauro Carvalho Chehab } 1361ad85094bSMauro Carvalho Chehab 1362ad85094bSMauro Carvalho Chehab for (i = 0; i < ARRAY_SIZE(gc0310_controls); i++) 1363ad85094bSMauro Carvalho Chehab v4l2_ctrl_new_custom(&dev->ctrl_handler, &gc0310_controls[i], 1364ad85094bSMauro Carvalho Chehab NULL); 1365ad85094bSMauro Carvalho Chehab 1366ad85094bSMauro Carvalho Chehab if (dev->ctrl_handler.error) { 1367ad85094bSMauro Carvalho Chehab gc0310_remove(client); 1368ad85094bSMauro Carvalho Chehab return dev->ctrl_handler.error; 1369ad85094bSMauro Carvalho Chehab } 1370ad85094bSMauro Carvalho Chehab 1371ad85094bSMauro Carvalho Chehab /* Use same lock for controls as for everything else. */ 1372ad85094bSMauro Carvalho Chehab dev->ctrl_handler.lock = &dev->input_lock; 1373ad85094bSMauro Carvalho Chehab dev->sd.ctrl_handler = &dev->ctrl_handler; 1374ad85094bSMauro Carvalho Chehab 1375ad85094bSMauro Carvalho Chehab ret = media_entity_pads_init(&dev->sd.entity, 1, &dev->pad); 1376ad85094bSMauro Carvalho Chehab if (ret) 1377ad85094bSMauro Carvalho Chehab gc0310_remove(client); 1378ad85094bSMauro Carvalho Chehab 1379ad85094bSMauro Carvalho Chehab pr_info("%s E\n", __func__); 1380ad85094bSMauro Carvalho Chehab return ret; 1381ad85094bSMauro Carvalho Chehab out_free: 1382ad85094bSMauro Carvalho Chehab v4l2_device_unregister_subdev(&dev->sd); 1383ad85094bSMauro Carvalho Chehab kfree(dev); 1384ad85094bSMauro Carvalho Chehab return ret; 1385ad85094bSMauro Carvalho Chehab } 1386ad85094bSMauro Carvalho Chehab 1387ad85094bSMauro Carvalho Chehab static const struct acpi_device_id gc0310_acpi_match[] = { 1388ad85094bSMauro Carvalho Chehab {"XXGC0310"}, 1389ad85094bSMauro Carvalho Chehab {"INT0310"}, 1390ad85094bSMauro Carvalho Chehab {}, 1391ad85094bSMauro Carvalho Chehab }; 1392ad85094bSMauro Carvalho Chehab MODULE_DEVICE_TABLE(acpi, gc0310_acpi_match); 1393ad85094bSMauro Carvalho Chehab 1394ad85094bSMauro Carvalho Chehab static struct i2c_driver gc0310_driver = { 1395ad85094bSMauro Carvalho Chehab .driver = { 1396ad85094bSMauro Carvalho Chehab .name = "gc0310", 1397ad85094bSMauro Carvalho Chehab .acpi_match_table = gc0310_acpi_match, 1398ad85094bSMauro Carvalho Chehab }, 1399ad85094bSMauro Carvalho Chehab .probe_new = gc0310_probe, 1400ad85094bSMauro Carvalho Chehab .remove = gc0310_remove, 1401ad85094bSMauro Carvalho Chehab }; 1402ad85094bSMauro Carvalho Chehab module_i2c_driver(gc0310_driver); 1403ad85094bSMauro Carvalho Chehab 1404ad85094bSMauro Carvalho Chehab MODULE_AUTHOR("Lai, Angie <angie.lai@intel.com>"); 1405ad85094bSMauro Carvalho Chehab MODULE_DESCRIPTION("A low-level driver for GalaxyCore GC0310 sensors"); 1406ad85094bSMauro Carvalho Chehab MODULE_LICENSE("GPL"); 1407