18b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee/* 28b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee * Driver for Samsung S5K4ECGX 1/4" 5Mp CMOS Image Sensor SoC 38b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee * with an Embedded Image Signal Processor. 48b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee * 58b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee * Copyright (C) 2012, Linaro, Sangwook Lee <sangwook.lee@linaro.org> 68b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee * Copyright (C) 2012, Insignal Co,. Ltd, Homin Lee <suapapa@insignal.co.kr> 78b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee * 88b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee * Based on s5k6aa and noon010pc30 driver 98b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee * Copyright (C) 2011, Samsung Electronics Co., Ltd. 108b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee * 118b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee * This program is free software; you can redistribute it and/or modify 128b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee * it under the terms of the GNU General Public License as published by 138b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee * the Free Software Foundation; either version 2 of the License, or 148b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee * (at your option) any later version. 158b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee */ 168b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 178b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#include <linux/clk.h> 188b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#include <linux/crc32.h> 198b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#include <linux/ctype.h> 208b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#include <linux/delay.h> 218b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#include <linux/firmware.h> 228b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#include <linux/gpio.h> 238b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#include <linux/i2c.h> 248b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#include <linux/module.h> 258b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#include <linux/regulator/consumer.h> 268b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#include <linux/slab.h> 278b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#include <asm/unaligned.h> 288b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 298b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#include <media/media-entity.h> 308b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#include <media/s5k4ecgx.h> 318b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#include <media/v4l2-ctrls.h> 328b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#include <media/v4l2-device.h> 338b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#include <media/v4l2-mediabus.h> 348b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#include <media/v4l2-subdev.h> 358b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 368b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestatic int debug; 378b99312b7214f1976ebb54071b01968536af53c9Sangwook Leemodule_param(debug, int, 0644); 388b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 398b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define S5K4ECGX_DRIVER_NAME "s5k4ecgx" 408b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define S5K4ECGX_FIRMWARE "s5k4ecgx.bin" 418b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 428b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee/* Firmware revision information */ 438b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define REG_FW_REVISION 0x700001a6 448b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define REG_FW_VERSION 0x700001a4 458b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define S5K4ECGX_REVISION_1_1 0x11 468b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define S5K4ECGX_FW_VERSION 0x4ec0 478b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 488b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee/* General purpose parameters */ 498b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define REG_USER_BRIGHTNESS 0x7000022c 508b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define REG_USER_CONTRAST 0x7000022e 518b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define REG_USER_SATURATION 0x70000230 528b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 538b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define REG_G_ENABLE_PREV 0x7000023e 548b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define REG_G_ENABLE_PREV_CHG 0x70000240 558b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define REG_G_NEW_CFG_SYNC 0x7000024a 568b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define REG_G_PREV_IN_WIDTH 0x70000250 578b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define REG_G_PREV_IN_HEIGHT 0x70000252 588b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define REG_G_PREV_IN_XOFFS 0x70000254 598b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define REG_G_PREV_IN_YOFFS 0x70000256 608b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define REG_G_CAP_IN_WIDTH 0x70000258 618b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define REG_G_CAP_IN_HEIGHT 0x7000025a 628b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define REG_G_CAP_IN_XOFFS 0x7000025c 638b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define REG_G_CAP_IN_YOFFS 0x7000025e 648b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define REG_G_INPUTS_CHANGE_REQ 0x70000262 658b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define REG_G_ACTIVE_PREV_CFG 0x70000266 668b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define REG_G_PREV_CFG_CHG 0x70000268 678b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define REG_G_PREV_OPEN_AFTER_CH 0x7000026a 688b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 698b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee/* Preview context register sets. n = 0...4. */ 708b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define PREG(n, x) ((n) * 0x30 + (x)) 718b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define REG_P_OUT_WIDTH(n) PREG(n, 0x700002a6) 728b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define REG_P_OUT_HEIGHT(n) PREG(n, 0x700002a8) 738b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define REG_P_FMT(n) PREG(n, 0x700002aa) 748b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define REG_P_PVI_MASK(n) PREG(n, 0x700002b4) 758b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define REG_P_FR_TIME_TYPE(n) PREG(n, 0x700002be) 768b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define FR_TIME_DYNAMIC 0 778b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define FR_TIME_FIXED 1 788b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define FR_TIME_FIXED_ACCURATE 2 798b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define REG_P_FR_TIME_Q_TYPE(n) PREG(n, 0x700002c0) 808b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define FR_TIME_Q_DYNAMIC 0 818b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define FR_TIME_Q_BEST_FRRATE 1 828b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define FR_TIME_Q_BEST_QUALITY 2 838b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 848b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee/* Frame period in 0.1 ms units */ 858b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define REG_P_MAX_FR_TIME(n) PREG(n, 0x700002c2) 868b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define REG_P_MIN_FR_TIME(n) PREG(n, 0x700002c4) 878b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define US_TO_FR_TIME(__t) ((__t) / 100) 888b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define REG_P_PREV_MIRROR(n) PREG(n, 0x700002d0) 898b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define REG_P_CAP_MIRROR(n) PREG(n, 0x700002d2) 908b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 918b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define REG_G_PREVZOOM_IN_WIDTH 0x70000494 928b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define REG_G_PREVZOOM_IN_HEIGHT 0x70000496 938b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define REG_G_PREVZOOM_IN_XOFFS 0x70000498 948b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define REG_G_PREVZOOM_IN_YOFFS 0x7000049a 958b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define REG_G_CAPZOOM_IN_WIDTH 0x7000049c 968b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define REG_G_CAPZOOM_IN_HEIGHT 0x7000049e 978b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define REG_G_CAPZOOM_IN_XOFFS 0x700004a0 988b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define REG_G_CAPZOOM_IN_YOFFS 0x700004a2 998b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 1008b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee/* n = 0...4 */ 1018b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define REG_USER_SHARPNESS(n) (0x70000a28 + (n) * 0xb6) 1028b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 1038b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee/* Reduce sharpness range for user space API */ 1048b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define SHARPNESS_DIV 8208 1058b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define TOK_TERM 0xffffffff 1068b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 1078b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee/* 1088b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee * FIXME: This is copied from s5k6aa, because of no information 1098b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee * in the S5K4ECGX datasheet. 1108b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee * H/W register Interface (0xd0000000 - 0xd0000fff) 1118b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee */ 1128b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define AHB_MSB_ADDR_PTR 0xfcfc 1138b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define GEN_REG_OFFSH 0xd000 1148b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define REG_CMDWR_ADDRH 0x0028 1158b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define REG_CMDWR_ADDRL 0x002a 1168b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define REG_CMDRD_ADDRH 0x002c 1178b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define REG_CMDRD_ADDRL 0x002e 1188b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define REG_CMDBUF0_ADDR 0x0f12 1198b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 1208b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestruct s5k4ecgx_frmsize { 1218b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee struct v4l2_frmsize_discrete size; 1228b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee /* Fixed sensor matrix crop rectangle */ 1238b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee struct v4l2_rect input_window; 1248b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee}; 1258b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 1268b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestruct regval_list { 1278b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee u32 addr; 1288b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee u16 val; 1298b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee}; 1308b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 1318b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee/* 1328b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee * TODO: currently only preview is supported and snapshot (capture) 1338b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee * is not implemented yet 1348b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee */ 1358b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestatic const struct s5k4ecgx_frmsize s5k4ecgx_prev_sizes[] = { 1368b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee { 1378b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee .size = { 176, 144 }, 1388b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee .input_window = { 0x00, 0x00, 0x928, 0x780 }, 1398b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee }, { 1408b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee .size = { 352, 288 }, 1418b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee .input_window = { 0x00, 0x00, 0x928, 0x780 }, 1428b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee }, { 1438b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee .size = { 640, 480 }, 1448b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee .input_window = { 0x00, 0x00, 0xa00, 0x780 }, 1458b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee }, { 1468b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee .size = { 720, 480 }, 1478b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee .input_window = { 0x00, 0x00, 0xa00, 0x6a8 }, 1488b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee } 1498b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee}; 1508b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 1518b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define S5K4ECGX_NUM_PREV ARRAY_SIZE(s5k4ecgx_prev_sizes) 1528b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 1538b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestruct s5k4ecgx_pixfmt { 1548b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee enum v4l2_mbus_pixelcode code; 1558b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee u32 colorspace; 1568b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee /* REG_TC_PCFG_Format register value */ 1578b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee u16 reg_p_format; 1588b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee}; 1598b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 1608b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee/* By default value, output from sensor will be YUV422 0-255 */ 1618b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestatic const struct s5k4ecgx_pixfmt s5k4ecgx_formats[] = { 1628b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee { V4L2_MBUS_FMT_YUYV8_2X8, V4L2_COLORSPACE_JPEG, 5 }, 1638b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee}; 1648b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 1658b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestatic const char * const s5k4ecgx_supply_names[] = { 1668b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee /* 1678b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee * Usually 2.8V is used for analog power (vdda) 1688b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee * and digital IO (vddio, vdddcore) 1698b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee */ 1708b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee "vdda", 1718b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee "vddio", 1728b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee "vddcore", 1738b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee "vddreg", /* The internal s5k4ecgx regulator's supply (1.8V) */ 1748b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee}; 1758b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 1768b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define S5K4ECGX_NUM_SUPPLIES ARRAY_SIZE(s5k4ecgx_supply_names) 1778b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 1788b99312b7214f1976ebb54071b01968536af53c9Sangwook Leeenum s5k4ecgx_gpio_id { 1798b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee STBY, 1808b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee RST, 1818b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee GPIO_NUM, 1828b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee}; 1838b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 1848b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestruct s5k4ecgx { 1858b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee struct v4l2_subdev sd; 1868b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee struct media_pad pad; 1878b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee struct v4l2_ctrl_handler handler; 1888b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 1898b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee struct s5k4ecgx_platform_data *pdata; 1908b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee const struct s5k4ecgx_pixfmt *curr_pixfmt; 1918b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee const struct s5k4ecgx_frmsize *curr_frmsize; 1928b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee struct mutex lock; 1938b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee u8 streaming; 1948b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee u8 set_params; 1958b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 1968b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee struct regulator_bulk_data supplies[S5K4ECGX_NUM_SUPPLIES]; 1978b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee struct s5k4ecgx_gpio gpio[GPIO_NUM]; 1988b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee}; 1998b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 2008b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestatic inline struct s5k4ecgx *to_s5k4ecgx(struct v4l2_subdev *sd) 2018b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee{ 2028b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return container_of(sd, struct s5k4ecgx, sd); 2038b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee} 2048b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 2058b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestatic int s5k4ecgx_i2c_read(struct i2c_client *client, u16 addr, u16 *val) 2068b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee{ 2078b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee u8 wbuf[2] = { addr >> 8, addr & 0xff }; 2088b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee struct i2c_msg msg[2]; 2098b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee u8 rbuf[2]; 2108b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee int ret; 2118b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 2128b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee msg[0].addr = client->addr; 2138b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee msg[0].flags = 0; 2148b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee msg[0].len = 2; 2158b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee msg[0].buf = wbuf; 2168b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 2178b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee msg[1].addr = client->addr; 2188b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee msg[1].flags = I2C_M_RD; 2198b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee msg[1].len = 2; 2208b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee msg[1].buf = rbuf; 2218b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 2228b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = i2c_transfer(client->adapter, msg, 2); 2238b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee *val = be16_to_cpu(*((u16 *)rbuf)); 2248b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 2258b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee v4l2_dbg(4, debug, client, "i2c_read: 0x%04X : 0x%04x\n", addr, *val); 2268b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 2278b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return ret == 2 ? 0 : ret; 2288b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee} 2298b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 2308b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestatic int s5k4ecgx_i2c_write(struct i2c_client *client, u16 addr, u16 val) 2318b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee{ 2328b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee u8 buf[4] = { addr >> 8, addr & 0xff, val >> 8, val & 0xff }; 2338b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 2348b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee int ret = i2c_master_send(client, buf, 4); 2358b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee v4l2_dbg(4, debug, client, "i2c_write: 0x%04x : 0x%04x\n", addr, val); 2368b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 2378b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return ret == 4 ? 0 : ret; 2388b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee} 2398b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 2408b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestatic int s5k4ecgx_write(struct i2c_client *client, u32 addr, u16 val) 2418b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee{ 2428b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee u16 high = addr >> 16, low = addr & 0xffff; 2438b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee int ret; 2448b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 2458b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee v4l2_dbg(3, debug, client, "write: 0x%08x : 0x%04x\n", addr, val); 2468b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 2478b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_i2c_write(client, REG_CMDWR_ADDRH, high); 2488b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (!ret) 2498b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_i2c_write(client, REG_CMDWR_ADDRL, low); 2508b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (!ret) 2518b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_i2c_write(client, REG_CMDBUF0_ADDR, val); 2528b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 2538b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return ret; 2548b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee} 2558b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 2568b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestatic int s5k4ecgx_read(struct i2c_client *client, u32 addr, u16 *val) 2578b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee{ 2588b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee u16 high = addr >> 16, low = addr & 0xffff; 2598b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee int ret; 2608b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 2618b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_i2c_write(client, REG_CMDRD_ADDRH, high); 2628b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (!ret) 2638b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_i2c_write(client, REG_CMDRD_ADDRL, low); 2648b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (!ret) 2658b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_i2c_read(client, REG_CMDBUF0_ADDR, val); 2668b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (!ret) 2678b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee dev_err(&client->dev, "Failed to execute read command\n"); 2688b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 2698b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return ret; 2708b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee} 2718b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 2728b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestatic int s5k4ecgx_read_fw_ver(struct v4l2_subdev *sd) 2738b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee{ 2748b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee struct i2c_client *client = v4l2_get_subdevdata(sd); 2758b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee u16 hw_rev, fw_ver = 0; 2768b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee int ret; 2778b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 2788b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_read(client, REG_FW_VERSION, &fw_ver); 2798b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (ret < 0 || fw_ver != S5K4ECGX_FW_VERSION) { 2808b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee v4l2_err(sd, "FW version check failed!\n"); 2818b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return -ENODEV; 2828b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee } 2838b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 2848b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_read(client, REG_FW_REVISION, &hw_rev); 2858b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (ret < 0) 2868b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return ret; 2878b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 2888b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee v4l2_info(sd, "chip found FW ver: 0x%x, HW rev: 0x%x\n", 2898b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee fw_ver, hw_rev); 2908b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return 0; 2918b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee} 2928b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 2938b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestatic int s5k4ecgx_set_ahb_address(struct v4l2_subdev *sd) 2948b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee{ 2958b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee struct i2c_client *client = v4l2_get_subdevdata(sd); 2968b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee int ret; 2978b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 2988b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee /* Set APB peripherals start address */ 2998b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_i2c_write(client, AHB_MSB_ADDR_PTR, GEN_REG_OFFSH); 3008b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (ret < 0) 3018b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return ret; 3028b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee /* 3038b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee * FIXME: This is copied from s5k6aa, because of no information 3048b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee * in s5k4ecgx's datasheet. 3058b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee * sw_reset is activated to put device into idle status 3068b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee */ 3078b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_i2c_write(client, 0x0010, 0x0001); 3088b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (ret < 0) 3098b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return ret; 3108b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 3118b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_i2c_write(client, 0x1030, 0x0000); 3128b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (ret < 0) 3138b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return ret; 3148b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee /* Halt ARM CPU */ 3158b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return s5k4ecgx_i2c_write(client, 0x0014, 0x0001); 3168b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee} 3178b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 3188b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define FW_CRC_SIZE 4 3198b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee/* Register address, value are 4, 2 bytes */ 3208b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee#define FW_RECORD_SIZE 6 3218b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee/* 3228b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee * The firmware has following format: 3238b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee * < total number of records (4 bytes + 2 bytes padding) N >, 3248b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee * < record 0 >, ..., < record N - 1 >, < CRC32-CCITT (4-bytes) >, 3258b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee * where "record" is a 4-byte register address followed by 2-byte 3268b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee * register value (little endian). 3278b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee * The firmware generator can be found in following git repository: 3288b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee * git://git.linaro.org/people/sangwook/fimc-v4l2-app.git 3298b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee */ 3308b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestatic int s5k4ecgx_load_firmware(struct v4l2_subdev *sd) 3318b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee{ 3328b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee struct i2c_client *client = v4l2_get_subdevdata(sd); 3338b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee const struct firmware *fw; 3348b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee const u8 *ptr; 3358b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee int err, i, regs_num; 3368b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee u32 addr, crc, crc_file, addr_inc = 0; 3378b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee u16 val; 3388b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 3398b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee err = request_firmware(&fw, S5K4ECGX_FIRMWARE, sd->v4l2_dev->dev); 3408b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (err) { 3418b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee v4l2_err(sd, "Failed to read firmware %s\n", S5K4ECGX_FIRMWARE); 3428b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return err; 3438b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee } 3448b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee regs_num = le32_to_cpu(get_unaligned_le32(fw->data)); 3458b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 346107376ba4ef1ecd4249427a9f9c1922fc1d66bb4Randy Dunlap v4l2_dbg(3, debug, sd, "FW: %s size %zu register sets %d\n", 3478b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee S5K4ECGX_FIRMWARE, fw->size, regs_num); 3488b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 3498b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee regs_num++; /* Add header */ 3508b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (fw->size != regs_num * FW_RECORD_SIZE + FW_CRC_SIZE) { 3518b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee err = -EINVAL; 3528b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee goto fw_out; 3538b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee } 3548b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee crc_file = le32_to_cpu(get_unaligned_le32(fw->data + 3558b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee regs_num * FW_RECORD_SIZE)); 3568b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee crc = crc32_le(~0, fw->data, regs_num * FW_RECORD_SIZE); 3578b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (crc != crc_file) { 3588b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee v4l2_err(sd, "FW: invalid crc (%#x:%#x)\n", crc, crc_file); 3598b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee err = -EINVAL; 3608b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee goto fw_out; 3618b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee } 3628b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ptr = fw->data + FW_RECORD_SIZE; 3638b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee for (i = 1; i < regs_num; i++) { 3648b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee addr = le32_to_cpu(get_unaligned_le32(ptr)); 3658b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ptr += sizeof(u32); 3668b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee val = le16_to_cpu(get_unaligned_le16(ptr)); 3678b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ptr += sizeof(u16); 3688b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (addr - addr_inc != 2) 3698b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee err = s5k4ecgx_write(client, addr, val); 3708b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee else 3718b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee err = s5k4ecgx_i2c_write(client, REG_CMDBUF0_ADDR, val); 3728b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (err) 3738b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee break; 3748b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee addr_inc = addr; 3758b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee } 3768b99312b7214f1976ebb54071b01968536af53c9Sangwook Leefw_out: 3778b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee release_firmware(fw); 3788b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return err; 3798b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee} 3808b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 3818b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee/* Set preview and capture input window */ 3828b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestatic int s5k4ecgx_set_input_window(struct i2c_client *c, 3838b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee const struct v4l2_rect *r) 3848b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee{ 3858b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee int ret; 3868b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 3878b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_write(c, REG_G_PREV_IN_WIDTH, r->width); 3888b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (!ret) 3898b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_write(c, REG_G_PREV_IN_HEIGHT, r->height); 3908b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (!ret) 3918b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_write(c, REG_G_PREV_IN_XOFFS, r->left); 3928b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (!ret) 3938b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_write(c, REG_G_PREV_IN_YOFFS, r->top); 3948b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (!ret) 3958b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_write(c, REG_G_CAP_IN_WIDTH, r->width); 3968b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (!ret) 3978b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_write(c, REG_G_CAP_IN_HEIGHT, r->height); 3988b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (!ret) 3998b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_write(c, REG_G_CAP_IN_XOFFS, r->left); 4008b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (!ret) 4018b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_write(c, REG_G_CAP_IN_YOFFS, r->top); 4028b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 4038b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return ret; 4048b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee} 4058b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 4068b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee/* Set preview and capture zoom input window */ 4078b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestatic int s5k4ecgx_set_zoom_window(struct i2c_client *c, 4088b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee const struct v4l2_rect *r) 4098b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee{ 4108b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee int ret; 4118b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 4128b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_write(c, REG_G_PREVZOOM_IN_WIDTH, r->width); 4138b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (!ret) 4148b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_write(c, REG_G_PREVZOOM_IN_HEIGHT, r->height); 4158b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (!ret) 4168b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_write(c, REG_G_PREVZOOM_IN_XOFFS, r->left); 4178b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (!ret) 4188b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_write(c, REG_G_PREVZOOM_IN_YOFFS, r->top); 4198b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (!ret) 4208b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_write(c, REG_G_CAPZOOM_IN_WIDTH, r->width); 4218b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (!ret) 4228b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_write(c, REG_G_CAPZOOM_IN_HEIGHT, r->height); 4238b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (!ret) 4248b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_write(c, REG_G_CAPZOOM_IN_XOFFS, r->left); 4258b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (!ret) 4268b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_write(c, REG_G_CAPZOOM_IN_YOFFS, r->top); 4278b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 4288b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return ret; 4298b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee} 4308b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 4318b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestatic int s5k4ecgx_set_output_framefmt(struct s5k4ecgx *priv) 4328b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee{ 4338b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee struct i2c_client *client = v4l2_get_subdevdata(&priv->sd); 4348b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee int ret; 4358b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 4368b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_write(client, REG_P_OUT_WIDTH(0), 4378b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee priv->curr_frmsize->size.width); 4388b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (!ret) 4398b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_write(client, REG_P_OUT_HEIGHT(0), 4408b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee priv->curr_frmsize->size.height); 4418b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (!ret) 4428b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_write(client, REG_P_FMT(0), 4438b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee priv->curr_pixfmt->reg_p_format); 4448b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return ret; 4458b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee} 4468b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 4478b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestatic int s5k4ecgx_init_sensor(struct v4l2_subdev *sd) 4488b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee{ 4498b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee int ret; 4508b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 4518b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_set_ahb_address(sd); 4528b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 4538b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee /* The delay is from manufacturer's settings */ 4548b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee msleep(100); 4558b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 4568b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (!ret) 4578b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_load_firmware(sd); 4588b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (ret) 4598b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee v4l2_err(sd, "Failed to write initial settings\n"); 4608b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 4618b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return ret; 4628b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee} 4638b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 4648b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestatic int s5k4ecgx_gpio_set_value(struct s5k4ecgx *priv, int id, u32 val) 4658b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee{ 4668b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (!gpio_is_valid(priv->gpio[id].gpio)) 4678b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return 0; 4688b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee gpio_set_value(priv->gpio[id].gpio, val); 4698b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 4708b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return 1; 4718b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee} 4728b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 4738b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestatic int __s5k4ecgx_power_on(struct s5k4ecgx *priv) 4748b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee{ 4758b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee int ret; 4768b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 4778b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = regulator_bulk_enable(S5K4ECGX_NUM_SUPPLIES, priv->supplies); 4788b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (ret) 4798b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return ret; 4808b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee usleep_range(30, 50); 4818b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 4828b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee /* The polarity of STBY is controlled by TSP */ 4838b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (s5k4ecgx_gpio_set_value(priv, STBY, priv->gpio[STBY].level)) 4848b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee usleep_range(30, 50); 4858b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 4868b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (s5k4ecgx_gpio_set_value(priv, RST, priv->gpio[RST].level)) 4878b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee usleep_range(30, 50); 4888b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 4898b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return 0; 4908b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee} 4918b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 4928b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestatic int __s5k4ecgx_power_off(struct s5k4ecgx *priv) 4938b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee{ 4948b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (s5k4ecgx_gpio_set_value(priv, RST, !priv->gpio[RST].level)) 4958b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee usleep_range(30, 50); 4968b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 4978b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (s5k4ecgx_gpio_set_value(priv, STBY, !priv->gpio[STBY].level)) 4988b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee usleep_range(30, 50); 4998b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 5008b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee priv->streaming = 0; 5018b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 5028b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return regulator_bulk_disable(S5K4ECGX_NUM_SUPPLIES, priv->supplies); 5038b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee} 5048b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 5058b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee/* Find nearest matching image pixel size. */ 5068b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestatic int s5k4ecgx_try_frame_size(struct v4l2_mbus_framefmt *mf, 5078b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee const struct s5k4ecgx_frmsize **size) 5088b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee{ 5098b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee unsigned int min_err = ~0; 5108b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee int i = ARRAY_SIZE(s5k4ecgx_prev_sizes); 5118b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee const struct s5k4ecgx_frmsize *fsize = &s5k4ecgx_prev_sizes[0], 5128b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee *match = NULL; 5138b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 5148b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee while (i--) { 5158b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee int err = abs(fsize->size.width - mf->width) 5168b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee + abs(fsize->size.height - mf->height); 5178b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (err < min_err) { 5188b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee min_err = err; 5198b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee match = fsize; 5208b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee } 5218b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee fsize++; 5228b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee } 5238b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (match) { 5248b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee mf->width = match->size.width; 5258b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee mf->height = match->size.height; 5268b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (size) 5278b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee *size = match; 5288b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return 0; 5298b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee } 5308b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 5318b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return -EINVAL; 5328b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee} 5338b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 5348b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestatic int s5k4ecgx_enum_mbus_code(struct v4l2_subdev *sd, 5358b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee struct v4l2_subdev_fh *fh, 5368b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee struct v4l2_subdev_mbus_code_enum *code) 5378b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee{ 5388b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (code->index >= ARRAY_SIZE(s5k4ecgx_formats)) 5398b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return -EINVAL; 5408b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee code->code = s5k4ecgx_formats[code->index].code; 5418b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 5428b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return 0; 5438b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee} 5448b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 5458b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestatic int s5k4ecgx_get_fmt(struct v4l2_subdev *sd, struct v4l2_subdev_fh *fh, 5468b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee struct v4l2_subdev_format *fmt) 5478b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee{ 5488b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee struct s5k4ecgx *priv = to_s5k4ecgx(sd); 5498b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee struct v4l2_mbus_framefmt *mf; 5508b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 5518b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (fmt->which == V4L2_SUBDEV_FORMAT_TRY) { 5528b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (fh) { 5538b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee mf = v4l2_subdev_get_try_format(fh, 0); 5548b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee fmt->format = *mf; 5558b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee } 5568b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return 0; 5578b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee } 5588b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 5598b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee mf = &fmt->format; 5608b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 5618b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee mutex_lock(&priv->lock); 5628b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee mf->width = priv->curr_frmsize->size.width; 5638b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee mf->height = priv->curr_frmsize->size.height; 5648b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee mf->code = priv->curr_pixfmt->code; 5658b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee mf->colorspace = priv->curr_pixfmt->colorspace; 5668b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee mf->field = V4L2_FIELD_NONE; 5678b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee mutex_unlock(&priv->lock); 5688b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 5698b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return 0; 5708b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee} 5718b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 5728b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestatic const struct s5k4ecgx_pixfmt *s5k4ecgx_try_fmt(struct v4l2_subdev *sd, 5738b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee struct v4l2_mbus_framefmt *mf) 5748b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee{ 5758b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee int i = ARRAY_SIZE(s5k4ecgx_formats); 5768b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 5778b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee while (--i) 5788b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (mf->code == s5k4ecgx_formats[i].code) 5798b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee break; 5808b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee mf->code = s5k4ecgx_formats[i].code; 5818b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 5828b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return &s5k4ecgx_formats[i]; 5838b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee} 5848b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 5858b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestatic int s5k4ecgx_set_fmt(struct v4l2_subdev *sd, struct v4l2_subdev_fh *fh, 5868b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee struct v4l2_subdev_format *fmt) 5878b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee{ 5888b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee struct s5k4ecgx *priv = to_s5k4ecgx(sd); 5898b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee const struct s5k4ecgx_frmsize *fsize = NULL; 5908b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee const struct s5k4ecgx_pixfmt *pf; 5918b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee struct v4l2_mbus_framefmt *mf; 5928b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee int ret = 0; 5938b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 5948b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee pf = s5k4ecgx_try_fmt(sd, &fmt->format); 5958b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee s5k4ecgx_try_frame_size(&fmt->format, &fsize); 5968b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee fmt->format.colorspace = V4L2_COLORSPACE_JPEG; 597776a347df61780111574ee8875e5f7d756817de8Laurent Pinchart fmt->format.field = V4L2_FIELD_NONE; 5988b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 5998b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (fmt->which == V4L2_SUBDEV_FORMAT_TRY) { 6008b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (fh) { 6018b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee mf = v4l2_subdev_get_try_format(fh, 0); 6028b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee *mf = fmt->format; 6038b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee } 6048b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return 0; 6058b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee } 6068b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 6078b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee mutex_lock(&priv->lock); 6088b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (!priv->streaming) { 6098b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee priv->curr_frmsize = fsize; 6108b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee priv->curr_pixfmt = pf; 6118b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee priv->set_params = 1; 6128b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee } else { 6138b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = -EBUSY; 6148b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee } 6158b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee mutex_unlock(&priv->lock); 6168b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 6178b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return ret; 6188b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee} 6198b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 6208b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestatic const struct v4l2_subdev_pad_ops s5k4ecgx_pad_ops = { 6218b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee .enum_mbus_code = s5k4ecgx_enum_mbus_code, 6228b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee .get_fmt = s5k4ecgx_get_fmt, 6238b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee .set_fmt = s5k4ecgx_set_fmt, 6248b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee}; 6258b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 6268b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee/* 6278b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee * V4L2 subdev controls 6288b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee */ 6298b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestatic int s5k4ecgx_s_ctrl(struct v4l2_ctrl *ctrl) 6308b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee{ 6318b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee struct v4l2_subdev *sd = &container_of(ctrl->handler, struct s5k4ecgx, 6328b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee handler)->sd; 6338b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee struct i2c_client *client = v4l2_get_subdevdata(sd); 6348b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee struct s5k4ecgx *priv = to_s5k4ecgx(sd); 6358b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee unsigned int i; 6368b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee int err = 0; 6378b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 6388b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee v4l2_dbg(1, debug, sd, "ctrl: 0x%x, value: %d\n", ctrl->id, ctrl->val); 6398b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 6408b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee mutex_lock(&priv->lock); 6418b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee switch (ctrl->id) { 6428b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee case V4L2_CID_CONTRAST: 6438b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee err = s5k4ecgx_write(client, REG_USER_CONTRAST, ctrl->val); 6448b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee break; 6458b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 6468b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee case V4L2_CID_SATURATION: 6478b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee err = s5k4ecgx_write(client, REG_USER_SATURATION, ctrl->val); 6488b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee break; 6498b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 6508b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee case V4L2_CID_SHARPNESS: 6518b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee /* TODO: Revisit, is this setting for all presets ? */ 6528b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee for (i = 0; i < 4 && !err; i++) 6538b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee err = s5k4ecgx_write(client, REG_USER_SHARPNESS(i), 6548b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ctrl->val * SHARPNESS_DIV); 6558b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee break; 6568b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 6578b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee case V4L2_CID_BRIGHTNESS: 6588b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee err = s5k4ecgx_write(client, REG_USER_BRIGHTNESS, ctrl->val); 6598b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee break; 6608b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee } 6618b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee mutex_unlock(&priv->lock); 6628b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (err < 0) 6638b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee v4l2_err(sd, "Failed to write s_ctrl err %d\n", err); 6648b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 6658b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return err; 6668b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee} 6678b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 6688b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestatic const struct v4l2_ctrl_ops s5k4ecgx_ctrl_ops = { 6698b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee .s_ctrl = s5k4ecgx_s_ctrl, 6708b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee}; 6718b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 6728b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee/* 6738b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee * Reading s5k4ecgx version information 6748b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee */ 6758b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestatic int s5k4ecgx_registered(struct v4l2_subdev *sd) 6768b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee{ 6778b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee int ret; 6788b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee struct s5k4ecgx *priv = to_s5k4ecgx(sd); 6798b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 6808b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee mutex_lock(&priv->lock); 6818b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = __s5k4ecgx_power_on(priv); 6828b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (!ret) { 6838b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_read_fw_ver(sd); 6848b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee __s5k4ecgx_power_off(priv); 6858b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee } 6868b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee mutex_unlock(&priv->lock); 6878b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 6888b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return ret; 6898b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee} 6908b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 6918b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee/* 6928b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee * V4L2 subdev internal operations 6938b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee */ 6948b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestatic int s5k4ecgx_open(struct v4l2_subdev *sd, struct v4l2_subdev_fh *fh) 6958b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee{ 6968b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee struct v4l2_mbus_framefmt *mf = v4l2_subdev_get_try_format(fh, 0); 6978b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 6988b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee mf->width = s5k4ecgx_prev_sizes[0].size.width; 6998b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee mf->height = s5k4ecgx_prev_sizes[0].size.height; 7008b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee mf->code = s5k4ecgx_formats[0].code; 7018b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee mf->colorspace = V4L2_COLORSPACE_JPEG; 7028b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee mf->field = V4L2_FIELD_NONE; 7038b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 7048b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return 0; 7058b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee} 7068b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 7078b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestatic const struct v4l2_subdev_internal_ops s5k4ecgx_subdev_internal_ops = { 7088b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee .registered = s5k4ecgx_registered, 7098b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee .open = s5k4ecgx_open, 7108b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee}; 7118b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 7128b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestatic int s5k4ecgx_s_power(struct v4l2_subdev *sd, int on) 7138b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee{ 7148b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee struct s5k4ecgx *priv = to_s5k4ecgx(sd); 7158b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee int ret; 7168b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 7178b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee v4l2_dbg(1, debug, sd, "Switching %s\n", on ? "on" : "off"); 7188b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 7198b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (on) { 7208b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = __s5k4ecgx_power_on(priv); 7218b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (ret < 0) 7228b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return ret; 7238b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee /* Time to stabilize sensor */ 7248b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee msleep(100); 7258b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_init_sensor(sd); 7268b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (ret < 0) 7278b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee __s5k4ecgx_power_off(priv); 7288b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee else 7298b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee priv->set_params = 1; 7308b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee } else { 7318b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = __s5k4ecgx_power_off(priv); 7328b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee } 7338b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 7348b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return ret; 7358b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee} 7368b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 7378b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestatic int s5k4ecgx_log_status(struct v4l2_subdev *sd) 7388b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee{ 7398b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee v4l2_ctrl_handler_log_status(sd->ctrl_handler, sd->name); 7408b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 7418b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return 0; 7428b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee} 7438b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 7448b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestatic const struct v4l2_subdev_core_ops s5k4ecgx_core_ops = { 7458b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee .s_power = s5k4ecgx_s_power, 7468b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee .log_status = s5k4ecgx_log_status, 7478b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee}; 7488b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 7498b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestatic int __s5k4ecgx_s_params(struct s5k4ecgx *priv) 7508b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee{ 7518b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee struct i2c_client *client = v4l2_get_subdevdata(&priv->sd); 7528b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee const struct v4l2_rect *crop_rect = &priv->curr_frmsize->input_window; 7538b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee int ret; 7548b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 7558b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_set_input_window(client, crop_rect); 7568b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (!ret) 7578b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_set_zoom_window(client, crop_rect); 7588b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (!ret) 7598b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_write(client, REG_G_INPUTS_CHANGE_REQ, 1); 7608b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (!ret) 7618b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_write(client, 0x70000a1e, 0x28); 7628b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (!ret) 7638b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_write(client, 0x70000ad4, 0x3c); 7648b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (!ret) 7658b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_set_output_framefmt(priv); 7668b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (!ret) 7678b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_write(client, REG_P_PVI_MASK(0), 0x52); 7688b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (!ret) 7698b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_write(client, REG_P_FR_TIME_TYPE(0), 7708b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee FR_TIME_DYNAMIC); 7718b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (!ret) 7728b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_write(client, REG_P_FR_TIME_Q_TYPE(0), 7738b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee FR_TIME_Q_BEST_FRRATE); 7748b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (!ret) 7758b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_write(client, REG_P_MIN_FR_TIME(0), 7768b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee US_TO_FR_TIME(33300)); 7778b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (!ret) 7788b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_write(client, REG_P_MAX_FR_TIME(0), 7798b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee US_TO_FR_TIME(66600)); 7808b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (!ret) 7818b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_write(client, REG_P_PREV_MIRROR(0), 0); 7828b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (!ret) 7838b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_write(client, REG_P_CAP_MIRROR(0), 0); 7848b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (!ret) 7858b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_write(client, REG_G_ACTIVE_PREV_CFG, 0); 7868b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (!ret) 7878b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_write(client, REG_G_PREV_OPEN_AFTER_CH, 1); 7888b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (!ret) 7898b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_write(client, REG_G_NEW_CFG_SYNC, 1); 7908b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (!ret) 7918b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_write(client, REG_G_PREV_CFG_CHG, 1); 7928b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 7938b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return ret; 7948b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee} 7958b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 7968b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestatic int __s5k4ecgx_s_stream(struct s5k4ecgx *priv, int on) 7978b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee{ 7988b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee struct i2c_client *client = v4l2_get_subdevdata(&priv->sd); 7998b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee int ret; 8008b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 8018b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (on && priv->set_params) { 8028b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = __s5k4ecgx_s_params(priv); 8038b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (ret < 0) 8048b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return ret; 8058b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee priv->set_params = 0; 8068b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee } 8078b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee /* 8088b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee * This enables/disables preview stream only. Capture requests 8098b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee * are not supported yet. 8108b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee */ 8118b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_write(client, REG_G_ENABLE_PREV, on); 8128b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (ret < 0) 8138b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return ret; 8148b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return s5k4ecgx_write(client, REG_G_ENABLE_PREV_CHG, 1); 8158b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee} 8168b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 8178b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestatic int s5k4ecgx_s_stream(struct v4l2_subdev *sd, int on) 8188b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee{ 8198b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee struct s5k4ecgx *priv = to_s5k4ecgx(sd); 8208b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee int ret = 0; 8218b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 8228b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee v4l2_dbg(1, debug, sd, "Turn streaming %s\n", on ? "on" : "off"); 8238b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 8248b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee mutex_lock(&priv->lock); 8258b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 8268b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (priv->streaming == !on) { 8278b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = __s5k4ecgx_s_stream(priv, on); 8288b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (!ret) 8298b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee priv->streaming = on & 1; 8308b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee } 8318b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 8328b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee mutex_unlock(&priv->lock); 8338b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return ret; 8348b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee} 8358b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 8368b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestatic const struct v4l2_subdev_video_ops s5k4ecgx_video_ops = { 8378b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee .s_stream = s5k4ecgx_s_stream, 8388b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee}; 8398b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 8408b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestatic const struct v4l2_subdev_ops s5k4ecgx_ops = { 8418b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee .core = &s5k4ecgx_core_ops, 8428b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee .pad = &s5k4ecgx_pad_ops, 8438b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee .video = &s5k4ecgx_video_ops, 8448b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee}; 8458b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 8468b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee/* 8478b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee * GPIO setup 8488b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee */ 8498b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestatic int s5k4ecgx_config_gpio(int nr, int val, const char *name) 8508b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee{ 8518b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee unsigned long flags = val ? GPIOF_OUT_INIT_HIGH : GPIOF_OUT_INIT_LOW; 8528b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee int ret; 8538b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 8548b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (!gpio_is_valid(nr)) 8558b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return 0; 8568b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = gpio_request_one(nr, flags, name); 8578b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (!ret) 8588b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee gpio_export(nr, 0); 8598b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 8608b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return ret; 8618b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee} 8628b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 8638b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestatic void s5k4ecgx_free_gpios(struct s5k4ecgx *priv) 8648b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee{ 8658b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee int i; 8668b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 8678b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee for (i = 0; i < ARRAY_SIZE(priv->gpio); i++) { 8688b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (!gpio_is_valid(priv->gpio[i].gpio)) 8698b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee continue; 8708b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee gpio_free(priv->gpio[i].gpio); 8718b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee priv->gpio[i].gpio = -EINVAL; 8728b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee } 8738b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee} 8748b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 8758b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestatic int s5k4ecgx_config_gpios(struct s5k4ecgx *priv, 8768b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee const struct s5k4ecgx_platform_data *pdata) 8778b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee{ 8788b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee const struct s5k4ecgx_gpio *gpio = &pdata->gpio_stby; 8798b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee int ret; 8808b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 8818b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee priv->gpio[STBY].gpio = -EINVAL; 8828b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee priv->gpio[RST].gpio = -EINVAL; 8838b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 8848b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_config_gpio(gpio->gpio, gpio->level, "S5K4ECGX_STBY"); 8858b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 8868b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (ret) { 8878b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee s5k4ecgx_free_gpios(priv); 8888b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return ret; 8898b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee } 8908b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee priv->gpio[STBY] = *gpio; 8918b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (gpio_is_valid(gpio->gpio)) 8928b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee gpio_set_value(gpio->gpio, 0); 8938b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 8948b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee gpio = &pdata->gpio_reset; 8958b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 8968b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_config_gpio(gpio->gpio, gpio->level, "S5K4ECGX_RST"); 8978b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (ret) { 8988b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee s5k4ecgx_free_gpios(priv); 8998b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return ret; 9008b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee } 9018b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee priv->gpio[RST] = *gpio; 9028b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (gpio_is_valid(gpio->gpio)) 9038b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee gpio_set_value(gpio->gpio, 0); 9048b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 9058b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return 0; 9068b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee} 9078b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 9088b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestatic int s5k4ecgx_init_v4l2_ctrls(struct s5k4ecgx *priv) 9098b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee{ 9108b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee const struct v4l2_ctrl_ops *ops = &s5k4ecgx_ctrl_ops; 9118b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee struct v4l2_ctrl_handler *hdl = &priv->handler; 9128b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee int ret; 9138b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 9148b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = v4l2_ctrl_handler_init(hdl, 4); 9158b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (ret) 9168b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return ret; 9178b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 9188b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee v4l2_ctrl_new_std(hdl, ops, V4L2_CID_BRIGHTNESS, -208, 127, 1, 0); 9198b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee v4l2_ctrl_new_std(hdl, ops, V4L2_CID_CONTRAST, -127, 127, 1, 0); 9208b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee v4l2_ctrl_new_std(hdl, ops, V4L2_CID_SATURATION, -127, 127, 1, 0); 9218b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 9228b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee /* Sharpness default is 24612, and then (24612/SHARPNESS_DIV) = 2 */ 9238b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee v4l2_ctrl_new_std(hdl, ops, V4L2_CID_SHARPNESS, -32704/SHARPNESS_DIV, 9248b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 24612/SHARPNESS_DIV, 1, 2); 9258b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (hdl->error) { 9268b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = hdl->error; 9278b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee v4l2_ctrl_handler_free(hdl); 9288b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return ret; 9298b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee } 9308b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee priv->sd.ctrl_handler = hdl; 9318b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 9328b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return 0; 9338b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee}; 9348b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 9358b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestatic int s5k4ecgx_probe(struct i2c_client *client, 9368b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee const struct i2c_device_id *id) 9378b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee{ 9388b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee struct s5k4ecgx_platform_data *pdata = client->dev.platform_data; 9398b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee struct v4l2_subdev *sd; 9408b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee struct s5k4ecgx *priv; 9418b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee int ret, i; 9428b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 9438b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (pdata == NULL) { 9448b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee dev_err(&client->dev, "platform data is missing!\n"); 9458b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return -EINVAL; 9468b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee } 9478b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 9488b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee priv = devm_kzalloc(&client->dev, sizeof(struct s5k4ecgx), GFP_KERNEL); 9498b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (!priv) 9508b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return -ENOMEM; 9518b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 9528b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee mutex_init(&priv->lock); 9538b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee priv->streaming = 0; 9548b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 9558b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee sd = &priv->sd; 9568b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee /* Registering subdev */ 9578b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee v4l2_i2c_subdev_init(sd, client, &s5k4ecgx_ops); 9588b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee strlcpy(sd->name, S5K4ECGX_DRIVER_NAME, sizeof(sd->name)); 9598b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 9608b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee sd->internal_ops = &s5k4ecgx_subdev_internal_ops; 9618b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee /* Support v4l2 sub-device user space API */ 9628b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee sd->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE; 9638b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 9648b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee priv->pad.flags = MEDIA_PAD_FL_SOURCE; 9658b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee sd->entity.type = MEDIA_ENT_T_V4L2_SUBDEV_SENSOR; 9668b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = media_entity_init(&sd->entity, 1, &priv->pad, 0); 9678b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (ret) 9688b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return ret; 9698b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 9708b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_config_gpios(priv, pdata); 9718b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (ret) { 9728b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee dev_err(&client->dev, "Failed to set gpios\n"); 9738b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee goto out_err1; 9748b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee } 9758b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee for (i = 0; i < S5K4ECGX_NUM_SUPPLIES; i++) 9768b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee priv->supplies[i].supply = s5k4ecgx_supply_names[i]; 9778b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 9788b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = devm_regulator_bulk_get(&client->dev, S5K4ECGX_NUM_SUPPLIES, 9798b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee priv->supplies); 9808b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (ret) { 9818b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee dev_err(&client->dev, "Failed to get regulators\n"); 9828b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee goto out_err2; 9838b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee } 9848b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee ret = s5k4ecgx_init_v4l2_ctrls(priv); 9858b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee if (ret) 9868b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee goto out_err2; 9878b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 9888b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee priv->curr_pixfmt = &s5k4ecgx_formats[0]; 9898b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee priv->curr_frmsize = &s5k4ecgx_prev_sizes[0]; 9908b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 9918b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return 0; 9928b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 9938b99312b7214f1976ebb54071b01968536af53c9Sangwook Leeout_err2: 9948b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee s5k4ecgx_free_gpios(priv); 9958b99312b7214f1976ebb54071b01968536af53c9Sangwook Leeout_err1: 9968b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee media_entity_cleanup(&priv->sd.entity); 9978b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 9988b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return ret; 9998b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee} 10008b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 10018b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestatic int s5k4ecgx_remove(struct i2c_client *client) 10028b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee{ 10038b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee struct v4l2_subdev *sd = i2c_get_clientdata(client); 10048b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee struct s5k4ecgx *priv = to_s5k4ecgx(sd); 10058b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 10068b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee mutex_destroy(&priv->lock); 10078b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee s5k4ecgx_free_gpios(priv); 10088b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee v4l2_device_unregister_subdev(sd); 10098b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee v4l2_ctrl_handler_free(&priv->handler); 10108b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee media_entity_cleanup(&sd->entity); 10118b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 10128b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee return 0; 10138b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee} 10148b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 10158b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestatic const struct i2c_device_id s5k4ecgx_id[] = { 10168b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee { S5K4ECGX_DRIVER_NAME, 0 }, 10178b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee {} 10188b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee}; 10198b99312b7214f1976ebb54071b01968536af53c9Sangwook LeeMODULE_DEVICE_TABLE(i2c, s5k4ecgx_id); 10208b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 10218b99312b7214f1976ebb54071b01968536af53c9Sangwook Leestatic struct i2c_driver v4l2_i2c_driver = { 10228b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee .driver = { 10238b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee .owner = THIS_MODULE, 10248b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee .name = S5K4ECGX_DRIVER_NAME, 10258b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee }, 10268b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee .probe = s5k4ecgx_probe, 10278b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee .remove = s5k4ecgx_remove, 10288b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee .id_table = s5k4ecgx_id, 10298b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee}; 10308b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 10318b99312b7214f1976ebb54071b01968536af53c9Sangwook Leemodule_i2c_driver(v4l2_i2c_driver); 10328b99312b7214f1976ebb54071b01968536af53c9Sangwook Lee 10338b99312b7214f1976ebb54071b01968536af53c9Sangwook LeeMODULE_DESCRIPTION("Samsung S5K4ECGX 5MP SOC camera"); 10348b99312b7214f1976ebb54071b01968536af53c9Sangwook LeeMODULE_AUTHOR("Sangwook Lee <sangwook.lee@linaro.org>"); 10358b99312b7214f1976ebb54071b01968536af53c9Sangwook LeeMODULE_AUTHOR("Seok-Young Jang <quartz.jang@samsung.com>"); 10368b99312b7214f1976ebb54071b01968536af53c9Sangwook LeeMODULE_LICENSE("GPL"); 10378b99312b7214f1976ebb54071b01968536af53c9Sangwook LeeMODULE_FIRMWARE(S5K4ECGX_FIRMWARE); 1038