/* * imx135.c - imx135 sensor driver * * Copyright (c) 2013-2014, NVIDIA CORPORATION. All rights reserved. * * This program is free software; you can redistribute it and/or modify it * under the terms and conditions of the GNU General Public License, * version 2, as published by the Free Software Foundation. * * This program is distributed in the hope it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * * You should have received a copy of the GNU General Public License * along with this program. If not, see . */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #define CAM_RSTN 219 /* TEGRA_GPIO_PBB3 */ #define CAM1_PWDN 221 /* TEGRA_GPIO_PBB5 */ #define CAM_AF_PWDN 223 /* TEGRA_GPIO_PBB7 */ static struct tegra_io_dpd csia_io = { .name = "CSIA", .io_dpd_reg_index = 0, .io_dpd_bit = 0, }; static struct tegra_io_dpd csib_io = { .name = "CSIB", .io_dpd_reg_index = 0, .io_dpd_bit = 1, }; struct imx135_reg { u16 addr; u8 val; }; struct imx135_datafmt { enum v4l2_mbus_pixelcode code; enum v4l2_colorspace colorspace; }; struct imx135 { struct v4l2_subdev subdev; const struct imx135_datafmt *fmt; int mode; struct imx135_power_rail power; struct imx135_sensordata sensor_data; struct i2c_client *i2c_client; struct imx135_platform_data *pdata; struct clk *mclk; struct mutex imx135_camera_lock; struct dentry *debugdir; }; static const struct imx135_datafmt imx135_colour_fmts[] = { {V4L2_MBUS_FMT_SRGGB10_1X10, V4L2_COLORSPACE_SRGB}, {V4L2_MBUS_FMT_SRGGB8_1X8, V4L2_COLORSPACE_SRGB}, }; static inline struct imx135 *to_imx135(const struct i2c_client *client) { return container_of(i2c_get_clientdata(client), struct imx135, subdev); } #define IMX135_TABLE_WAIT_MS 0 #define IMX135_TABLE_END 1 #define IMX135_MAX_RETRIES 3 #define IMX135_WAIT_MS 3 #define IMX135_4208x3120_HDR #define MAX_BUFFER_SIZE 32 #define IMX135_FRAME_LENGTH_ADDR_MSB 0x0340 #define IMX135_FRAME_LENGTH_ADDR_LSB 0x0341 #define IMX135_COARSE_TIME_ADDR_MSB 0x0202 #define IMX135_COARSE_TIME_ADDR_LSB 0x0203 #define IMX135_COARSE_TIME_SHORT_ADDR_MSB 0x0230 #define IMX135_COARSE_TIME_SHORT_ADDR_LSB 0x0231 #define IMX135_GAIN_ADDR 0x0205 #define IMX135_GAIN_SHORT_ADDR 0x0233 #ifdef IMX135_4208x3120_HDR /* HDR */ static struct imx135_reg mode_4208x3120[] = { /* software reset */ {0x0103, 0x01}, /* global settings */ {0x0101, 0x00}, {0x0105, 0x01}, {0x0110, 0x00}, {0x0220, 0x01}, {0x3302, 0x11}, {0x3833, 0x20}, {0x3873, 0x03}, {0x3893, 0x00}, {0x3906, 0x08}, {0x3907, 0x01}, {0x391B, 0x00}, {0x3C09, 0x01}, {0x600A, 0x00}, {0x3008, 0xB0}, {0x320A, 0x01}, {0x320D, 0x10}, {0x3216, 0x2E}, {0x322C, 0x02}, {0x3409, 0x0C}, {0x340C, 0x2D}, {0x3411, 0x39}, {0x3414, 0x1E}, {0x3427, 0x04}, {0x3480, 0x1E}, {0x3484, 0x1E}, {0x3488, 0x1E}, {0x348C, 0x1E}, {0x3490, 0x1E}, {0x3494, 0x1E}, {0x3511, 0x8F}, {0x364F, 0x2D}, /* Clock Setting */ {0x011E, 0x18}, {0x011F, 0x00}, {0x0301, 0x05}, {0x0303, 0x01}, {0x0305, 0x0C}, {0x0309, 0x05}, {0x030B, 0x01}, {0x030C, 0x01}, {0x030D, 0xC2}, {0x030E, 0x01}, {0x3A06, 0x11}, /* Mode Settings */ {0x0108, 0x03}, {0x0112, 0x0A}, {0x0113, 0x0A}, {0x0381, 0x01}, {0x0383, 0x01}, {0x0385, 0x01}, {0x0387, 0x01}, {0x0390, 0x00}, {0x0391, 0x11}, {0x0392, 0x00}, {0x0401, 0x00}, {0x0404, 0x00}, {0x0405, 0x10}, {0x4082, 0x01}, {0x4083, 0x01}, {0x7006, 0x04}, /* Optinal/Function settings */ {0x0700, 0x00}, {0x3A63, 0x00}, {0x4100, 0xF8}, {0x4203, 0xFF}, {0x4344, 0x00}, {0x441C, 0x01}, /* Size Setting */ {0x0340, 0x0C}, {0x0341, 0xD0}, {0x0342, 0x11}, {0x0343, 0xDC}, {0x0344, 0x00}, {0x0345, 0x00}, {0x0346, 0x00}, {0x0347, 0x00}, {0x0348, 0x10}, {0x0349, 0x6F}, {0x034A, 0x0C}, {0x034B, 0x2F}, {0x034C, 0x10}, {0x034D, 0x70}, {0x034E, 0x0C}, {0x034F, 0x30}, {0x0350, 0x00}, {0x0351, 0x00}, {0x0352, 0x00}, {0x0353, 0x00}, {0x0354, 0x10}, {0x0355, 0x70}, {0x0356, 0x0C}, {0x0357, 0x30}, {0x301D, 0x30}, {0x3310, 0x10}, {0x3311, 0x70}, {0x3312, 0x0C}, {0x3313, 0x30}, {0x331C, 0x01}, {0x331D, 0x68}, {0x4084, 0x00}, {0x4085, 0x00}, {0x4086, 0x00}, {0x4087, 0x00}, {0x4400, 0x00}, /* Global Timing Setting */ {0x0830, 0x87}, {0x0831, 0x3F}, {0x0832, 0x67}, {0x0833, 0x3F}, {0x0834, 0x3F}, {0x0835, 0x4F}, {0x0836, 0xDF}, {0x0837, 0x47}, {0x0839, 0x1F}, {0x083A, 0x17}, {0x083B, 0x02}, /* Integration Time Setting */ {0x0202, 0x0C}, {0x0203, 0xCC}, /* Gain Setting */ {0x0205, 0x00}, {0x020E, 0x01}, {0x020F, 0x00}, {0x0210, 0x01}, {0x0211, 0x00}, {0x0212, 0x01}, {0x0213, 0x00}, {0x0214, 0x01}, {0x0215, 0x00}, /* HDR Setting */ {0x0230, 0x00}, {0x0231, 0x00}, {0x0233, 0x00}, {0x0234, 0x00}, {0x0235, 0x40}, {0x0238, 0x01}, {0x0239, 0x04}, {0x023B, 0x00}, {0x023C, 0x01}, {0x33B0, 0x10}, {0x33B1, 0x70}, {0x33B3, 0x01}, {0x33B4, 0x01}, {0x3800, 0x00}, {0x3A43, 0x01}, /* stream on */ {0x0100, 0x01}, {IMX135_TABLE_WAIT_MS, IMX135_WAIT_MS}, {IMX135_TABLE_END, 0x00} }; #else /* standard */ static struct imx135_reg mode_4208x3120[] = { /* software reset */ {0x0103, 0x01}, /* global settings */ {0x0101, 0x00}, {0x0105, 0x01}, {0x0110, 0x00}, {0x0220, 0x01}, {0x3302, 0x11}, {0x3833, 0x20}, {0x3893, 0x00}, {0x3906, 0x08}, {0x3907, 0x01}, {0x391B, 0x01}, {0x3C09, 0x01}, {0x600A, 0x00}, {0x3008, 0xB0}, {0x320A, 0x01}, {0x320D, 0x10}, {0x3216, 0x2E}, {0x322C, 0x02}, {0x3409, 0x0C}, {0x340C, 0x2D}, {0x3411, 0x39}, {0x3414, 0x1E}, {0x3427, 0x04}, {0x3480, 0x1E}, {0x3484, 0x1E}, {0x3488, 0x1E}, {0x348C, 0x1E}, {0x3490, 0x1E}, {0x3494, 0x1E}, {0x3511, 0x8F}, {0x364F, 0x2D}, /* Clock Setting */ {0x011E, 0x18}, {0x011F, 0x00}, {0x0301, 0x05}, {0x0303, 0x01}, {0x0305, 0x0C}, {0x0309, 0x05}, {0x030B, 0x01}, {0x030C, 0x01}, {0x030D, 0xC2}, {0x030E, 0x01}, {0x3A06, 0x11}, /* Mode Settings */ {0x0108, 0x03}, {0x0112, 0x0A}, {0x0113, 0x0A}, {0x0381, 0x01}, {0x0383, 0x01}, {0x0385, 0x01}, {0x0387, 0x01}, {0x0390, 0x00}, {0x0391, 0x11}, {0x0392, 0x00}, {0x0401, 0x00}, {0x0404, 0x00}, {0x0405, 0x10}, {0x4082, 0x01}, {0x4083, 0x01}, {0x7006, 0x04}, /* Optinal/Function settings */ {0x0700, 0x00}, {0x3A63, 0x00}, {0x4100, 0xF8}, {0x4203, 0xFF}, {0x4344, 0x00}, {0x441C, 0x01}, /* Size Setting */ {0x0340, 0x0C}, {0x0341, 0xD0}, {0x0342, 0x11}, {0x0343, 0xDC}, {0x0344, 0x00}, {0x0345, 0x00}, {0x0346, 0x00}, {0x0347, 0x00}, {0x0348, 0x10}, {0x0349, 0x6F}, {0x034A, 0x0C}, {0x034B, 0x2F}, {0x034C, 0x10}, {0x034D, 0x70}, {0x034E, 0x0C}, {0x034F, 0x30}, {0x0350, 0x00}, {0x0351, 0x00}, {0x0352, 0x00}, {0x0353, 0x00}, {0x0354, 0x10}, {0x0355, 0x70}, {0x0356, 0x0C}, {0x0357, 0x30}, {0x301D, 0x30}, {0x3310, 0x10}, {0x3311, 0x70}, {0x3312, 0x0C}, {0x3313, 0x30}, {0x331C, 0x01}, {0x331D, 0x68}, {0x4084, 0x00}, {0x4085, 0x00}, {0x4086, 0x00}, {0x4087, 0x00}, {0x4400, 0x00}, /* Global Timing Setting */ {0x0830, 0x87}, {0x0831, 0x3F}, {0x0832, 0x67}, {0x0833, 0x3F}, {0x0834, 0x3F}, {0x0835, 0x4F}, {0x0836, 0xDF}, {0x0837, 0x47}, {0x0839, 0x1F}, {0x083A, 0x17}, {0x083B, 0x02}, /* Integration Time Setting */ {0x0202, 0x0C}, {0x0203, 0xCC}, /* Gain Setting */ {0x0205, 0x04}, {0x020E, 0x01}, {0x020F, 0x00}, {0x0210, 0x01}, {0x0211, 0x00}, {0x0212, 0x01}, {0x0213, 0x00}, {0x0214, 0x01}, {0x0215, 0x00}, /* HDR Setting */ {0x0230, 0x00}, {0x0231, 0x00}, {0x0233, 0x00}, {0x0234, 0x00}, {0x0235, 0x40}, {0x0238, 0x01}, {0x0239, 0x04}, {0x023B, 0x00}, {0x023C, 0x01}, {0x33B0, 0x04}, {0x33B1, 0x00}, {0x33B3, 0x00}, {0x33B4, 0x01}, {0x3800, 0x00}, {0x3A43, 0x01}, /* stream on */ {0x0100, 0x01}, {IMX135_TABLE_WAIT_MS, IMX135_WAIT_MS}, {IMX135_TABLE_END, 0x00} }; #endif static struct imx135_reg mode_1920x1080[] = { /* software reset */ {0x0103, 0x01}, /* global settings */ {0x0101, 0x00}, {0x0105, 0x01}, {0x0110, 0x00}, {0x0220, 0x01}, {0x3302, 0x11}, {0x3833, 0x20}, {0x3893, 0x00}, {0x3906, 0x08}, {0x3907, 0x01}, {0x391B, 0x01}, {0x3C09, 0x01}, {0x600A, 0x00}, {0x3008, 0xB0}, {0x320A, 0x01}, {0x320D, 0x10}, {0x3216, 0x2E}, {0x322C, 0x02}, {0x3409, 0x0C}, {0x340C, 0x2D}, {0x3411, 0x39}, {0x3414, 0x1E}, {0x3427, 0x04}, {0x3480, 0x1E}, {0x3484, 0x1E}, {0x3488, 0x1E}, {0x348C, 0x1E}, {0x3490, 0x1E}, {0x3494, 0x1E}, {0x3511, 0x8F}, {0x364F, 0x2D}, /* Clock Setting */ {0x011E, 0x18}, {0x011F, 0x00}, {0x0301, 0x05}, {0x0303, 0x01}, {0x0305, 0x0C}, {0x0309, 0x05}, {0x030B, 0x02}, {0x030C, 0x00}, {0x030D, 0xC9}, {0x030E, 0x01}, {0x3A06, 0x12}, /* Mode Settings */ {0x0108, 0x03}, {0x0112, 0x0A}, {0x0113, 0x0A}, {0x0381, 0x01}, {0x0383, 0x01}, {0x0385, 0x01}, {0x0387, 0x01}, {0x0390, 0x01}, {0x0391, 0x22}, {0x0392, 0x00}, {0x0401, 0x02}, {0x0404, 0x00}, {0x0405, 0x11}, {0x4082, 0x00}, {0x4083, 0x00}, {0x7006, 0x04}, /* Optinal/Function settings */ {0x0700, 0x00}, {0x3A63, 0x00}, {0x4100, 0xF8}, {0x4203, 0xFF}, {0x4344, 0x00}, {0x441C, 0x01}, /* Size Setting */ {0x0340, 0x04}, {0x0341, 0x92}, {0x0342, 0x11}, {0x0343, 0xDC}, {0x0344, 0x00}, {0x0345, 0x40}, {0x0346, 0x01}, {0x0347, 0x9C}, {0x0348, 0x10}, {0x0349, 0x2F}, {0x034A, 0x0A}, {0x034B, 0x93}, {0x034C, 0x07}, {0x034D, 0x80}, {0x034E, 0x04}, {0x034F, 0x38}, {0x0350, 0x00}, {0x0351, 0x00}, {0x0352, 0x00}, {0x0353, 0x00}, {0x0354, 0x07}, {0x0355, 0xF8}, {0x0356, 0x04}, {0x0357, 0x7C}, {0x301D, 0x30}, {0x3310, 0x07}, {0x3311, 0x80}, {0x3312, 0x04}, {0x3313, 0x38}, {0x331C, 0x00}, {0x331D, 0xD2}, {0x4084, 0x07}, {0x4085, 0x80}, {0x4086, 0x04}, {0x4087, 0x38}, {0x4400, 0x00}, /* Global Timing Setting */ {0x0830, 0x57}, {0x0831, 0x0F}, {0x0832, 0x2F}, {0x0833, 0x17}, {0x0834, 0x0F}, {0x0835, 0x0F}, {0x0836, 0x47}, {0x0837, 0x27}, {0x0839, 0x1F}, {0x083A, 0x17}, {0x083B, 0x02}, /* Integration Time Setting */ {0x0202, 0x04}, {0x0203, 0x8E}, /* Gain Setting */ {0x0205, 0x00}, {0x020E, 0x01}, {0x020F, 0x00}, {0x0210, 0x01}, {0x0211, 0x00}, {0x0212, 0x01}, {0x0213, 0x00}, {0x0214, 0x01}, {0x0215, 0x00}, /* HDR Setting */ {0x0230, 0x00}, {0x0231, 0x00}, {0x0233, 0x00}, {0x0234, 0x00}, {0x0235, 0x40}, {0x0238, 0x00}, {0x0239, 0x04}, {0x023B, 0x00}, {0x023C, 0x01}, {0x33B0, 0x04}, {0x33B1, 0x00}, {0x33B3, 0x00}, {0x33B4, 0x01}, {0x3800, 0x00}, {0x3A43, 0x01}, /* stream on */ {0x0100, 0x01}, {IMX135_TABLE_WAIT_MS, IMX135_WAIT_MS}, {IMX135_TABLE_END, 0x00} }; #ifdef IMX135_1280x720_90_FPS /* 720p 90fps */ static struct imx135_reg mode_1280x720[] = { /* software reset */ {0x0103, 0x01}, /* global settings */ {0x0101, 0x00}, {0x0105, 0x01}, {0x0110, 0x00}, {0x0220, 0x01}, {0x3302, 0x11}, {0x3833, 0x20}, {0x3893, 0x00}, {0x3906, 0x08}, {0x3907, 0x01}, {0x391B, 0x01}, {0x3C09, 0x01}, {0x600A, 0x00}, {0x3008, 0xB0}, {0x320A, 0x01}, {0x320D, 0x10}, {0x3216, 0x2E}, {0x322C, 0x02}, {0x3409, 0x0C}, {0x340C, 0x2D}, {0x3411, 0x39}, {0x3414, 0x1E}, {0x3427, 0x04}, {0x3480, 0x1E}, {0x3484, 0x1E}, {0x3488, 0x1E}, {0x348C, 0x1E}, {0x3490, 0x1E}, {0x3494, 0x1E}, {0x3511, 0x8F}, {0x364F, 0x2D}, /* Clock Setting */ {0x011E, 0x18}, {0x011F, 0x00}, {0x0301, 0x05}, {0x0303, 0x01}, {0x0305, 0x0C}, {0x0309, 0x05}, {0x030B, 0x02}, {0x030C, 0x01}, {0x030D, 0xC2}, {0x030E, 0x01}, {0x3A06, 0x12}, /* Mode Settings */ {0x0108, 0x03}, {0x0112, 0x0A}, {0x0113, 0x0A}, {0x0381, 0x01}, {0x0383, 0x01}, {0x0385, 0x01}, {0x0387, 0x01}, {0x0390, 0x01}, {0x0391, 0x22}, {0x0392, 0x00}, {0x0401, 0x00}, {0x0404, 0x00}, {0x0405, 0x10}, {0x4082, 0x01}, {0x4083, 0x01}, {0x7006, 0x04}, /* Optinal/Function settings */ {0x0700, 0x00}, {0x3A63, 0x00}, {0x4100, 0xF8}, {0x4203, 0xFF}, {0x4344, 0x00}, {0x441C, 0x01}, /* Size Setting */ {0x0340, 0x03}, {0x0341, 0x6A}, {0x0342, 0x11}, {0x0343, 0xDC}, {0x0344, 0x03}, {0x0345, 0x38}, {0x0346, 0x03}, {0x0347, 0x48}, {0x0348, 0x0D}, {0x0349, 0x37}, {0x034A, 0x08}, {0x034B, 0xE7}, {0x034C, 0x05}, {0x034D, 0x00}, {0x034E, 0x02}, {0x034F, 0xD0}, {0x0350, 0x00}, {0x0351, 0x00}, {0x0352, 0x00}, {0x0353, 0x00}, {0x0354, 0x05}, {0x0355, 0x00}, {0x0356, 0x02}, {0x0357, 0xD0}, {0x301D, 0x30}, {0x3310, 0x05}, {0x3311, 0x00}, {0x3312, 0x02}, {0x3313, 0xD0}, {0x331C, 0x00}, {0x331D, 0x10}, {0x4084, 0x00}, {0x4085, 0x00}, {0x4086, 0x00}, {0x4087, 0x00}, {0x4400, 0x00}, /* Global Timing Setting */ {0x0830, 0x67}, {0x0831, 0x27}, {0x0832, 0x47}, {0x0833, 0x27}, {0x0834, 0x27}, {0x0835, 0x1F}, {0x0836, 0x87}, {0x0837, 0x2F}, {0x0839, 0x1F}, {0x083A, 0x17}, {0x083B, 0x02}, /* Integration Time Setting */ {0x0202, 0x03}, {0x0203, 0x66}, /* Gain Setting */ {0x0205, 0x00}, {0x020E, 0x01}, {0x020F, 0x00}, {0x0210, 0x01}, {0x0211, 0x00}, {0x0212, 0x01}, {0x0213, 0x00}, {0x0214, 0x01}, {0x0215, 0x00}, /* HDR Setting */ {0x0230, 0x00}, {0x0231, 0x00}, {0x0233, 0x00}, {0x0234, 0x00}, {0x0235, 0x40}, {0x0238, 0x01}, {0x0239, 0x04}, {0x023B, 0x00}, {0x023C, 0x01}, {0x33B0, 0x04}, {0x33B1, 0x00}, {0x33B3, 0x00}, {0x33B4, 0x01}, {0x3800, 0x00}, {0x3A43, 0x01}, /* stream on */ {0x0100, 0x01}, {IMX135_TABLE_WAIT_MS, IMX135_WAIT_MS}, {IMX135_TABLE_END, 0x00} }; #else /* 720p 30fps */ static struct imx135_reg mode_1280x720[] = { /* software reset */ {0x0103, 0x01}, /* global settings */ {0x0101, 0x00}, {0x0105, 0x01}, {0x0110, 0x00}, {0x0220, 0x01}, {0x3302, 0x11}, {0x3833, 0x20}, {0x3893, 0x00}, {0x3906, 0x08}, {0x3907, 0x01}, {0x391B, 0x01}, {0x3C09, 0x01}, {0x600A, 0x00}, {0x3008, 0xB0}, {0x320A, 0x01}, {0x320D, 0x10}, {0x3216, 0x2E}, {0x322C, 0x02}, {0x3409, 0x0C}, {0x340C, 0x2D}, {0x3411, 0x39}, {0x3414, 0x1E}, {0x3427, 0x04}, {0x3480, 0x1E}, {0x3484, 0x1E}, {0x3488, 0x1E}, {0x348C, 0x1E}, {0x3490, 0x1E}, {0x3494, 0x1E}, {0x3511, 0x8F}, {0x364F, 0x2D}, /* Clock Setting */ {0x011E, 0x18}, {0x011F, 0x00}, {0x0301, 0x05}, {0x0303, 0x01}, {0x0305, 0x0C}, {0x0309, 0x05}, {0x030B, 0x02}, {0x030C, 0x01}, {0x030D, 0xC2}, {0x030E, 0x01}, {0x3A06, 0x12}, /* Mode Settings */ {0x0108, 0x03}, {0x0112, 0x0A}, {0x0113, 0x0A}, {0x0381, 0x01}, {0x0383, 0x01}, {0x0385, 0x01}, {0x0387, 0x01}, {0x0390, 0x01}, {0x0391, 0x22}, {0x0392, 0x00}, {0x0401, 0x02}, {0x0404, 0x00}, {0x0405, 0x1A}, {0x4082, 0x00}, {0x4083, 0x00}, {0x7006, 0x04}, /* Optinal/Function settings */ {0x0700, 0x00}, {0x3A63, 0x00}, {0x4100, 0xF8}, {0x4203, 0xFF}, {0x4344, 0x00}, {0x441C, 0x01}, /* Size Setting */ {0x0340, 0x0A}, {0x0341, 0x40}, {0x0342, 0x11}, {0x0343, 0xDC}, {0x0344, 0x00}, {0x0345, 0x18}, {0x0346, 0x01}, {0x0347, 0x88}, {0x0348, 0x10}, {0x0349, 0x57}, {0x034A, 0x0A}, {0x034B, 0xAB}, {0x034C, 0x05}, {0x034D, 0x00}, {0x034E, 0x02}, {0x034F, 0xD0}, {0x0350, 0x00}, {0x0351, 0x00}, {0x0352, 0x00}, {0x0353, 0x00}, {0x0354, 0x08}, {0x0355, 0x20}, {0x0356, 0x04}, {0x0357, 0x92}, {0x301D, 0x30}, {0x3310, 0x05}, {0x3311, 0x00}, {0x3312, 0x02}, {0x3313, 0xD0}, {0x331C, 0x02}, {0x331D, 0x18}, {0x4084, 0x05}, {0x4085, 0x00}, {0x4086, 0x02}, {0x4087, 0xD0}, {0x4400, 0x00}, /* Global Timing Setting */ {0x0830, 0x67}, {0x0831, 0x27}, {0x0832, 0x47}, {0x0833, 0x27}, {0x0834, 0x27}, {0x0835, 0x1F}, {0x0836, 0x87}, {0x0837, 0x2F}, {0x0839, 0x1F}, {0x083A, 0x17}, {0x083B, 0x02}, /* Integration Time Setting */ {0x0202, 0x0A}, {0x0203, 0x3C}, /* Gain Setting */ {0x0205, 0x00}, {0x020E, 0x01}, {0x020F, 0x00}, {0x0210, 0x01}, {0x0211, 0x00}, {0x0212, 0x01}, {0x0213, 0x00}, {0x0214, 0x01}, {0x0215, 0x00}, /* HDR Setting */ {0x0230, 0x00}, {0x0231, 0x00}, {0x0233, 0x00}, {0x0234, 0x00}, {0x0235, 0x40}, {0x0238, 0x01}, {0x0239, 0x04}, {0x023B, 0x00}, {0x023C, 0x01}, {0x33B0, 0x04}, {0x33B1, 0x00}, {0x33B3, 0x00}, {0x33B4, 0x01}, {0x3800, 0x00}, {0x3A43, 0x01}, /* stream on */ {0x0100, 0x01}, {IMX135_TABLE_WAIT_MS, IMX135_WAIT_MS}, {IMX135_TABLE_END, 0x00} }; #endif static struct imx135_reg mode_2616x1472[] = { /* software reset */ {0x0103, 0x01}, /* global settings */ {0x0101, 0x00}, {0x0105, 0x01}, {0x0110, 0x00}, {0x0220, 0x01}, {0x3302, 0x11}, {0x3833, 0x20}, {0x3873, 0x03}, {0x3893, 0x00}, {0x3906, 0x08}, {0x3907, 0x01}, {0x391B, 0x00}, {0x3C09, 0x01}, {0x600A, 0x00}, {0x3008, 0xB0}, {0x320A, 0x01}, {0x320D, 0x10}, {0x3216, 0x2E}, {0x322C, 0x02}, {0x3409, 0x0C}, {0x340C, 0x2D}, {0x3411, 0x39}, {0x3414, 0x1E}, {0x3427, 0x04}, {0x3480, 0x1E}, {0x3484, 0x1E}, {0x3488, 0x1E}, {0x348C, 0x1E}, {0x3490, 0x1E}, {0x3494, 0x1E}, {0x3511, 0x8F}, {0x364F, 0x2D}, /* Clock Setting */ {0x011E, 0x18}, {0x011F, 0x00}, {0x0301, 0x05}, {0x0303, 0x01}, {0x0305, 0x0C}, {0x0309, 0x05}, {0x030B, 0x01}, {0x030C, 0x01}, {0x030D, 0xC2}, {0x030E, 0x01}, {0x3A06, 0x11}, /* Mode Settings */ {0x0108, 0x03}, {0x0112, 0x0A}, {0x0113, 0x0A}, {0x0381, 0x01}, {0x0383, 0x01}, {0x0385, 0x01}, {0x0387, 0x01}, {0x0390, 0x00}, {0x0391, 0x11}, {0x0392, 0x00}, {0x0401, 0x00}, {0x0404, 0x00}, {0x0405, 0x10}, {0x4082, 0x01}, {0x4083, 0x01}, {0x7006, 0x04}, /* Optinal/Function settings */ {0x0700, 0x00}, {0x3A63, 0x00}, {0x4100, 0xF8}, {0x4203, 0xFF}, {0x4344, 0x00}, {0x441C, 0x01}, /* Size Setting */ {0x0340, 0x0A}, {0x0341, 0x40}, {0x0342, 0x11}, {0x0343, 0xDC}, {0x0344, 0x03}, {0x0345, 0x1C}, {0x0346, 0x03}, {0x0347, 0x38}, {0x0348, 0x0D}, {0x0349, 0x53}, {0x034A, 0x08}, {0x034B, 0xF7}, {0x034C, 0x0A}, {0x034D, 0x38}, {0x034E, 0x05}, {0x034F, 0xC0}, {0x0350, 0x00}, {0x0351, 0x00}, {0x0352, 0x00}, {0x0353, 0x00}, {0x0354, 0x0A}, {0x0355, 0x38}, {0x0356, 0x05}, {0x0357, 0xC0}, {0x301D, 0x30}, {0x3310, 0x0A}, {0x3311, 0x38}, {0x3312, 0x05}, {0x3313, 0xC0}, {0x331C, 0x08}, {0x331D, 0xD4}, {0x4084, 0x00}, {0x4085, 0x00}, {0x4086, 0x00}, {0x4087, 0x00}, {0x4400, 0x00}, /* Global Timing Setting */ {0x0830, 0x87}, {0x0831, 0x3F}, {0x0832, 0x67}, {0x0833, 0x3F}, {0x0834, 0x3F}, {0x0835, 0x4F}, {0x0836, 0xDF}, {0x0837, 0x47}, {0x0839, 0x1F}, {0x083A, 0x17}, {0x083B, 0x02}, /* Integration Time Setting */ {0x0202, 0x0A}, {0x0203, 0x3C}, /* Gain Setting */ {0x0205, 0x00}, {0x020E, 0x01}, {0x020F, 0x00}, {0x0210, 0x01}, {0x0211, 0x00}, {0x0212, 0x01}, {0x0213, 0x00}, {0x0214, 0x01}, {0x0215, 0x00}, /* HDR Setting */ {0x0230, 0x00}, {0x0231, 0x00}, {0x0233, 0x00}, {0x0234, 0x00}, {0x0235, 0x40}, {0x0238, 0x01}, {0x0239, 0x04}, {0x023B, 0x00}, {0x023C, 0x01}, {0x33B0, 0x0A}, {0x33B1, 0x38}, {0x33B3, 0x01}, {0x33B4, 0x01}, {0x3800, 0x00}, {0x3A43, 0x01}, /* stream on */ {0x0100, 0x01}, {IMX135_TABLE_WAIT_MS, IMX135_WAIT_MS}, {IMX135_TABLE_END, 0x00} }; static struct imx135_reg mode_3896x2192[] = { /* software reset */ {0x0103, 0x01}, /* global settings */ {0x0101, 0x00}, {0x0105, 0x01}, {0x0110, 0x00}, {0x0220, 0x01}, {0x3302, 0x11}, {0x3833, 0x20}, {0x3873, 0x03}, {0x3893, 0x00}, {0x3906, 0x08}, {0x3907, 0x01}, {0x391B, 0x00}, {0x3C09, 0x01}, {0x600A, 0x00}, {0x3008, 0xB0}, {0x320A, 0x01}, {0x320D, 0x10}, {0x3216, 0x2E}, {0x322C, 0x02}, {0x3409, 0x0C}, {0x340C, 0x2D}, {0x3411, 0x39}, {0x3414, 0x1E}, {0x3427, 0x04}, {0x3480, 0x1E}, {0x3484, 0x1E}, {0x3488, 0x1E}, {0x348C, 0x1E}, {0x3490, 0x1E}, {0x3494, 0x1E}, {0x3511, 0x8F}, {0x364F, 0x2D}, /* Clock Setting */ {0x011E, 0x18}, {0x011F, 0x00}, {0x0301, 0x05}, {0x0303, 0x01}, {0x0305, 0x0C}, {0x0309, 0x05}, {0x030B, 0x01}, {0x030C, 0x01}, {0x030D, 0xC2}, {0x030E, 0x01}, {0x3A06, 0x11}, /* Mode Settings */ {0x0108, 0x03}, {0x0112, 0x0A}, {0x0113, 0x0A}, {0x0381, 0x01}, {0x0383, 0x01}, {0x0385, 0x01}, {0x0387, 0x01}, {0x0390, 0x00}, {0x0391, 0x11}, {0x0392, 0x00}, {0x0401, 0x00}, {0x0404, 0x00}, {0x0405, 0x10}, {0x4082, 0x01}, {0x4083, 0x01}, {0x7006, 0x04}, /* Optinal/Function settings */ {0x0700, 0x00}, {0x3A63, 0x00}, {0x4100, 0xF8}, {0x4203, 0xFF}, {0x4344, 0x00}, {0x441C, 0x01}, /* Size Setting */ {0x0340, 0x0A}, {0x0341, 0x40}, {0x0342, 0x11}, {0x0343, 0xDC}, {0x0344, 0x00}, {0x0345, 0x9C}, {0x0346, 0x01}, {0x0347, 0xD0}, {0x0348, 0x0F}, {0x0349, 0xD3}, {0x034A, 0x0A}, {0x034B, 0x5F}, {0x034C, 0x0F}, {0x034D, 0x38}, {0x034E, 0x08}, {0x034F, 0x90}, {0x0350, 0x00}, {0x0351, 0x00}, {0x0352, 0x00}, {0x0353, 0x00}, {0x0354, 0x0F}, {0x0355, 0x38}, {0x0356, 0x08}, {0x0357, 0x90}, {0x301D, 0x30}, {0x3310, 0x0F}, {0x3311, 0x38}, {0x3312, 0x08}, {0x3313, 0x90}, {0x331C, 0x0F}, {0x331D, 0x32}, {0x4084, 0x00}, {0x4085, 0x00}, {0x4086, 0x00}, {0x4087, 0x00}, {0x4400, 0x00}, /* Global Timing Setting */ {0x0830, 0x87}, {0x0831, 0x3F}, {0x0832, 0x67}, {0x0833, 0x3F}, {0x0834, 0x3F}, {0x0835, 0x4F}, {0x0836, 0xDF}, {0x0837, 0x47}, {0x0839, 0x1F}, {0x083A, 0x17}, {0x083B, 0x02}, /* Integration Time Setting */ {0x0202, 0x0A}, {0x0203, 0x3C}, /* Gain Setting */ {0x0205, 0x00}, {0x020E, 0x01}, {0x020F, 0x00}, {0x0210, 0x01}, {0x0211, 0x00}, {0x0212, 0x01}, {0x0213, 0x00}, {0x0214, 0x01}, {0x0215, 0x00}, /* HDR Setting */ {0x0230, 0x00}, {0x0231, 0x00}, {0x0233, 0x00}, {0x0234, 0x00}, {0x0235, 0x40}, {0x0238, 0x01}, {0x0239, 0x04}, {0x023B, 0x00}, {0x023C, 0x01}, {0x33B0, 0x0F}, {0x33B1, 0x38}, {0x33B3, 0x01}, {0x33B4, 0x01}, {0x3800, 0x00}, {0x3A43, 0x01}, /* stream on */ {0x0100, 0x01}, {IMX135_TABLE_WAIT_MS, IMX135_WAIT_MS}, {IMX135_TABLE_END, 0x00} }; static struct imx135_reg mode_2104x1560[] = { /* software reset */ {0x0103, 0x01}, /* global settings */ {0x0101, 0x00}, {0x0105, 0x01}, {0x0110, 0x00}, {0x0220, 0x01}, {0x3302, 0x11}, {0x3833, 0x20}, {0x3873, 0x03}, {0x3893, 0x00}, {0x3906, 0x08}, {0x3907, 0x01}, {0x391B, 0x00}, {0x3C09, 0x01}, {0x600A, 0x00}, {0x3008, 0xB0}, {0x320A, 0x01}, {0x320D, 0x10}, {0x3216, 0x2E}, {0x322C, 0x02}, {0x3409, 0x0C}, {0x340C, 0x2D}, {0x3411, 0x39}, {0x3414, 0x1E}, {0x3427, 0x04}, {0x3480, 0x1E}, {0x3484, 0x1E}, {0x3488, 0x1E}, {0x348C, 0x1E}, {0x3490, 0x1E}, {0x3494, 0x1E}, {0x3511, 0x8F}, {0x364F, 0x2D}, /* Clock Setting */ {0x011E, 0x18}, {0x011F, 0x00}, {0x0301, 0x05}, {0x0303, 0x01}, {0x0305, 0x0C}, {0x0309, 0x05}, {0x030B, 0x02}, {0x030C, 0x01}, {0x030D, 0x10}, {0x030E, 0x01}, {0x3A06, 0x12}, /* Mode Settings */ {0x0108, 0x03}, {0x0112, 0x0A}, {0x0113, 0x0A}, {0x0381, 0x01}, {0x0383, 0x01}, {0x0385, 0x01}, {0x0387, 0x01}, {0x0390, 0x01}, {0x0391, 0x21}, {0x0392, 0x00}, {0x0401, 0x00}, {0x0404, 0x00}, {0x0405, 0x10}, {0x4082, 0x01}, {0x4083, 0x01}, {0x7006, 0x04}, /* Optinal/Function settings */ {0x0700, 0x00}, {0x3A63, 0x00}, {0x4100, 0xF8}, {0x4203, 0xFF}, {0x4344, 0x00}, {0x441C, 0x01}, /* Size Setting */ {0x0340, 0x06}, {0x0341, 0x30}, {0x0342, 0x11}, {0x0343, 0xDC}, {0x0344, 0x00}, {0x0345, 0x00}, {0x0346, 0x00}, {0x0347, 0x00}, {0x0348, 0x10}, {0x0349, 0x6F}, {0x034A, 0x0C}, {0x034B, 0x2F}, {0x034C, 0x08}, {0x034D, 0x38}, {0x034E, 0x06}, {0x034F, 0x18}, {0x0350, 0x00}, {0x0351, 0x00}, {0x0352, 0x00}, {0x0353, 0x00}, {0x0354, 0x08}, {0x0355, 0x38}, {0x0356, 0x06}, {0x0357, 0x18}, {0x301D, 0x30}, {0x3310, 0x08}, {0x3311, 0x38}, {0x3312, 0x06}, {0x3313, 0x18}, {0x331C, 0x00}, {0x331D, 0x52}, {0x4084, 0x00}, {0x4085, 0x00}, {0x4086, 0x00}, {0x4087, 0x00}, {0x4400, 0x00}, /* Global Timing Setting */ {0x0830, 0x5F}, {0x0831, 0x17}, {0x0832, 0x37}, {0x0833, 0x17}, {0x0834, 0x17}, {0x0835, 0x17}, {0x0836, 0x57}, {0x0837, 0x27}, {0x0839, 0x1F}, {0x083A, 0x17}, {0x083B, 0x02}, /* Integration Time Setting */ {0x0202, 0x06}, {0x0203, 0x2C}, /* Gain Setting */ {0x0205, 0x00}, {0x020E, 0x01}, {0x020F, 0x00}, {0x0210, 0x01}, {0x0211, 0x00}, {0x0212, 0x01}, {0x0213, 0x00}, {0x0214, 0x01}, {0x0215, 0x00}, /* HDR Setting */ {0x0230, 0x00}, {0x0231, 0x00}, {0x0233, 0x00}, {0x0234, 0x00}, {0x0235, 0x40}, {0x0238, 0x01}, {0x0239, 0x04}, {0x023B, 0x00}, {0x023C, 0x01}, {0x33B0, 0x08}, {0x33B1, 0x38}, {0x33B3, 0x01}, {0x33B4, 0x01}, {0x3800, 0x00}, {0x3024, 0xE0}, {0x302B, 0x01}, {0x302A, 0x01}, {0x3029, 0x01}, {0x3028, 0x05}, {0x3025, 0x00}, {0x300C, 0x9C}, /* stream on */ {0x0100, 0x01}, {IMX135_TABLE_WAIT_MS, IMX135_WAIT_MS}, {IMX135_TABLE_END, 0x00} }; static struct imx135_reg mode_quality[] = { /* defect correction */ {0x380A, 0x00}, {0x380B, 0x00}, {0x4103, 0x00}, /* color artifact */ {0x4243, 0x9A}, {0x4330, 0x01}, {0x4331, 0x90}, {0x4332, 0x02}, {0x4333, 0x58}, {0x4334, 0x03}, {0x4335, 0x20}, {0x4336, 0x03}, {0x4337, 0x84}, {0x433C, 0x01}, {0x4340, 0x02}, {0x4341, 0x58}, {0x4342, 0x03}, {0x4343, 0x52}, /* moire reduction */ {0x4364, 0x0B}, {0x4368, 0x00}, {0x4369, 0x0F}, {0x436A, 0x03}, {0x436B, 0xA8}, {0x436C, 0x00}, {0x436D, 0x00}, {0x436E, 0x00}, {0x436F, 0x06}, /* CNR parameter */ {0x4281, 0x21}, {0x4282, 0x18}, {0x4283, 0x04}, {0x4284, 0x08}, {0x4287, 0x7F}, {0x4288, 0x08}, {0x428B, 0x7F}, {0x428C, 0x08}, {0x428F, 0x7F}, {0x4297, 0x00}, {0x4298, 0x7E}, {0x4299, 0x7E}, {0x429A, 0x7E}, {0x42A4, 0xFB}, {0x42A5, 0x7E}, {0x42A6, 0xDF}, {0x42A7, 0xB7}, {0x42AF, 0x03}, /* ARNR Parameter Settings */ {0x4207, 0x03}, {0x4216, 0x08}, {0x4217, 0x08}, /* DLC parameter */ {0x4218, 0x00}, {0x421B, 0x20}, {0x421F, 0x04}, {0x4222, 0x02}, {0x4223, 0x22}, {0x422E, 0x54}, {0x422F, 0xFB}, {0x4230, 0xFF}, {0x4231, 0xFE}, {0x4232, 0xFF}, {0x4235, 0x58}, {0x4236, 0xF7}, {0x4237, 0xFD}, {0x4239, 0x4E}, {0x423A, 0xFC}, {0x423B, 0xFD}, /* HDR Setting */ {0x4300, 0x00}, {0x4316, 0x12}, {0x4317, 0x22}, {0x4318, 0x00}, {0x4319, 0x00}, {0x431A, 0x00}, {0x4324, 0x03}, {0x4325, 0x20}, {0x4326, 0x03}, {0x4327, 0x84}, {0x4328, 0x03}, {0x4329, 0x20}, {0x432A, 0x03}, {0x432B, 0x20}, {0x432C, 0x01}, {0x432D, 0x01}, {0x4338, 0x02}, {0x4339, 0x00}, {0x433A, 0x00}, {0x433B, 0x02}, {0x435A, 0x03}, {0x435B, 0x84}, {0x435E, 0x01}, {0x435F, 0xFF}, {0x4360, 0x01}, {0x4361, 0xF4}, {0x4362, 0x03}, {0x4363, 0x84}, {0x437B, 0x01}, {0x4401, 0x3F}, {0x4402, 0xFF}, {0x4404, 0x13}, {0x4405, 0x26}, {0x4406, 0x07}, {0x4408, 0x20}, {0x4409, 0xE5}, {0x440A, 0xFB}, {0x440C, 0xF6}, {0x440D, 0xEA}, {0x440E, 0x20}, {0x4410, 0x00}, {0x4411, 0x00}, {0x4412, 0x3F}, {0x4413, 0xFF}, {0x4414, 0x1F}, {0x4415, 0xFF}, {0x4416, 0x20}, {0x4417, 0x00}, {0x4418, 0x1F}, {0x4419, 0xFF}, {0x441A, 0x20}, {0x441B, 0x00}, {0x441D, 0x40}, {0x441E, 0x1E}, {0x441F, 0x38}, {0x4420, 0x01}, {0x4444, 0x00}, {0x4445, 0x00}, {0x4446, 0x1D}, {0x4447, 0xF9}, {0x4452, 0x00}, {0x4453, 0xA0}, {0x4454, 0x08}, {0x4455, 0x00}, {0x4456, 0x0F}, {0x4457, 0xFF}, {0x4458, 0x18}, {0x4459, 0x18}, {0x445A, 0x3F}, {0x445B, 0x3A}, {0x445C, 0x00}, {0x445D, 0x28}, {0x445E, 0x01}, {0x445F, 0x90}, {0x4460, 0x00}, {0x4461, 0x60}, {0x4462, 0x00}, {0x4463, 0x00}, {0x4464, 0x00}, {0x4465, 0x00}, {0x446C, 0x01}, {0x446D, 0x00}, {0x446E, 0x00}, /* LSC setting */ {0x452A, 0x02}, /* White balance */ {0x0712, 0x01}, {0x0713, 0x00}, {0x0714, 0x01}, {0x0715, 0x00}, {0x0716, 0x01}, {0x0717, 0x00}, {0x0718, 0x01}, {0x0719, 0x00}, /* Shading */ {0x4500, 0x1F}, {IMX135_TABLE_WAIT_MS, IMX135_WAIT_MS}, {IMX135_TABLE_END, 0x00} }; static struct imx135_reg tp_colorbars[] = { {0x0600, 0x00}, {0x0601, 0x02}, {IMX135_TABLE_WAIT_MS, IMX135_WAIT_MS}, {IMX135_TABLE_END, 0x00} }; enum { IMX135_MODE_4208X3120, IMX135_MODE_1920X1080, IMX135_MODE_1280X720, IMX135_MODE_2616X1472, IMX135_MODE_3896X2192, IMX135_MODE_2104X1560, IMX135_MODE_INVALID }; static struct imx135_reg *mode_table[] = { [IMX135_MODE_4208X3120] = mode_4208x3120, [IMX135_MODE_1920X1080] = mode_1920x1080, [IMX135_MODE_1280X720] = mode_1280x720, [IMX135_MODE_2616X1472] = mode_2616x1472, [IMX135_MODE_3896X2192] = mode_3896x2192, [IMX135_MODE_2104X1560] = mode_2104x1560, }; static int test_mode; module_param(test_mode, int, 0644); static const struct v4l2_frmsize_discrete imx135_frmsizes[] = { {4208, 3120}, {1920, 1080}, {1280, 720}, {2616, 1472}, {3896, 2192}, {2104, 1560}, }; /* Find a data format by a pixel code in an array */ static const struct imx135_datafmt *imx135_find_datafmt( enum v4l2_mbus_pixelcode code) { int i; for (i = 0; i < ARRAY_SIZE(imx135_colour_fmts); i++) if (imx135_colour_fmts[i].code == code) return imx135_colour_fmts + i; return NULL; } #define IMX135_MODE IMX135_MODE_4208X3120 #define IMX135_WIDTH 4208 #define IMX135_HEIGHT 3120 static int imx135_find_mode(struct v4l2_subdev *sd, u32 width, u32 height) { int i; for (i = 0; i < ARRAY_SIZE(imx135_frmsizes); i++) { if (width == imx135_frmsizes[i].width && height == imx135_frmsizes[i].height) return i; } dev_err(sd->v4l2_dev->dev, "%dx%d is not supported\n", width, height); return IMX135_MODE_4208X3120; } static inline void msleep_range(unsigned int delay_base) { usleep_range(delay_base*1000, delay_base*1000+500); } static int imx135_read_reg(struct i2c_client *client, u16 addr, u8 *val) { int err; struct i2c_msg msg[2]; unsigned char data[3]; if (!client->adapter) return -ENODEV; msg[0].addr = client->addr; msg[0].flags = 0; msg[0].len = 2; msg[0].buf = data; /* high byte goes out first */ data[0] = (u8) (addr >> 8); data[1] = (u8) (addr & 0xff); msg[1].addr = client->addr; msg[1].flags = I2C_M_RD; msg[1].len = 1; msg[1].buf = data + 2; err = i2c_transfer(client->adapter, msg, 2); if (err != 2) return -EINVAL; *val = data[2]; return 0; } static int imx135_write_reg(struct i2c_client *client, u16 addr, u8 val) { int err; struct i2c_msg msg; unsigned char data[3]; if (!client->adapter) return -ENODEV; data[0] = (u8) (addr >> 8); data[1] = (u8) (addr & 0xff); data[2] = (u8) (val & 0xff); msg.addr = client->addr; msg.flags = 0; msg.len = 3; msg.buf = data; err = i2c_transfer(client->adapter, &msg, 1); if (err == 1) return 0; pr_err("%s:i2c write failed, %x = %x\n", __func__, addr, val); return err; } static int imx135_write_table(struct i2c_client *client, const struct imx135_reg table[]) { int err; const struct imx135_reg *next; u16 val; for (next = table; next->addr != IMX135_TABLE_END; next++) { if (next->addr == IMX135_TABLE_WAIT_MS) { msleep_range(next->val); continue; } val = next->val; err = imx135_write_reg(client, next->addr, val); if (err) { pr_err("%s:imx135_write_table:%d", __func__, err); return err; } } return 0; } static void imx135_mclk_disable(struct imx135 *priv) { return; dev_dbg(&priv->i2c_client->dev, "%s: disable MCLK\n", __func__); clk_disable_unprepare(priv->mclk); } static int imx135_mclk_enable(struct imx135 *priv) { int err; unsigned long mclk_init_rate = 24000000; dev_dbg(&priv->i2c_client->dev, "%s: enable MCLK with %lu Hz\n", __func__, mclk_init_rate); err = clk_set_rate(priv->mclk, mclk_init_rate); if (!err) err = clk_prepare_enable(priv->mclk); return err; } static int imx135_debugfs_show(struct seq_file *s, void *unused) { struct imx135 *dev = s->private; dev_dbg(&dev->i2c_client->dev, "%s: ++\n", __func__); mutex_lock(&dev->imx135_camera_lock); mutex_unlock(&dev->imx135_camera_lock); return 0; } static ssize_t imx135_debugfs_write( struct file *file, char const __user *buf, size_t count, loff_t *offset) { struct imx135 *dev = ((struct seq_file *)file->private_data)->private; struct i2c_client *i2c_client = dev->i2c_client; int ret = 0; char buffer[MAX_BUFFER_SIZE]; u32 address; u32 data; u8 readback; dev_dbg(&i2c_client->dev, "%s: ++\n", __func__); if (copy_from_user(&buffer, buf, sizeof(buffer))) goto debugfs_write_fail; if (sscanf(buf, "0x%x 0x%x", &address, &data) == 2) goto set_attr; if (sscanf(buf, "0X%x 0X%x", &address, &data) == 2) goto set_attr; if (sscanf(buf, "%d %d", &address, &data) == 2) goto set_attr; if (sscanf(buf, "0x%x 0x%x", &address, &data) == 1) goto read; if (sscanf(buf, "0X%x 0X%x", &address, &data) == 1) goto read; if (sscanf(buf, "%d %d", &address, &data) == 1) goto read; dev_err(&i2c_client->dev, "SYNTAX ERROR: %s\n", buf); return -EFAULT; set_attr: dev_info(&i2c_client->dev, "new address = %x, data = %x\n", address, data); ret |= imx135_write_reg(i2c_client, address, data); read: ret |= imx135_read_reg(i2c_client, address, &readback); dev_info(&i2c_client->dev, "wrote to address 0x%x with value 0x%x\n", address, readback); if (ret) goto debugfs_write_fail; return count; debugfs_write_fail: dev_err(&i2c_client->dev, "%s: test pattern write failed\n", __func__); return -EFAULT; } static int imx135_debugfs_open(struct inode *inode, struct file *file) { struct imx135 *dev = inode->i_private; struct i2c_client *i2c_client = dev->i2c_client; dev_dbg(&i2c_client->dev, "%s: ++\n", __func__); return single_open(file, imx135_debugfs_show, inode->i_private); } static const struct file_operations imx135_debugfs_fops = { .open = imx135_debugfs_open, .read = seq_read, .write = imx135_debugfs_write, .llseek = seq_lseek, .release = single_release, }; static void imx135_remove_debugfs(struct imx135 *dev) { struct i2c_client *i2c_client = dev->i2c_client; dev_dbg(&i2c_client->dev, "%s: ++\n", __func__); debugfs_remove_recursive(dev->debugdir); dev->debugdir = NULL; } static void imx135_create_debugfs(struct imx135 *dev) { struct dentry *ret; struct i2c_client *i2c_client = dev->i2c_client; dev_dbg(&i2c_client->dev, "%s\n", __func__); dev->debugdir = debugfs_create_dir("imx135", NULL); if (!dev->debugdir) goto remove_debugfs; ret = debugfs_create_file("d", S_IWUSR | S_IRUGO, dev->debugdir, dev, &imx135_debugfs_fops); if (!ret) goto remove_debugfs; return; remove_debugfs: dev_err(&i2c_client->dev, "couldn't create debugfs\n"); imx135_remove_debugfs(dev); } static int imx135_get_extra_regulators(struct imx135_power_rail *pw) { struct imx135 *priv = container_of(pw, struct imx135, power); struct i2c_client *client = priv->i2c_client; if (!pw->ext_reg1) { pw->ext_reg1 = devm_regulator_get(&client->dev, "imx135_reg1"); if (IS_ERR(pw->ext_reg1)) { dev_err(&client->dev, "%s: can't get regulator imx135_reg1: %ld\n", __func__, PTR_ERR(pw->ext_reg1)); pw->ext_reg1 = NULL; return PTR_ERR(pw->ext_reg1); } } if (!pw->ext_reg2) { pw->ext_reg2 = devm_regulator_get(&client->dev, "imx135_reg2"); if (IS_ERR(pw->ext_reg2)) { dev_err(&client->dev, "%s: can't get regulator imx135_reg2: %ld\n", __func__, PTR_ERR(pw->ext_reg2)); pw->ext_reg2 = NULL; return PTR_ERR(pw->ext_reg2); } } return 0; } static int imx135_power_on(struct imx135_power_rail *pw) { int err; struct imx135 *priv = container_of(pw, struct imx135, power); if (unlikely(WARN_ON(!pw || !pw->iovdd || !pw->avdd || !pw->dvdd))) return -EFAULT; /* disable CSIA/B IOs DPD mode to turn on camera for ardbeg */ tegra_io_dpd_disable(&csia_io); tegra_io_dpd_disable(&csib_io); if (imx135_get_extra_regulators(pw)) goto imx135_poweron_fail; err = regulator_enable(pw->ext_reg1); if (unlikely(err)) goto imx135_ext_reg1_fail; err = regulator_enable(pw->ext_reg2); if (unlikely(err)) goto imx135_ext_reg2_fail; gpio_set_value(CAM_RSTN, 0); usleep_range(10, 20); gpio_set_value(CAM_AF_PWDN, 1); gpio_set_value(CAM1_PWDN, 1); usleep_range(10, 20); err = regulator_enable(pw->avdd); if (err) goto imx135_avdd_fail; err = regulator_enable(pw->iovdd); if (err) goto imx135_iovdd_fail; usleep_range(1, 2); gpio_set_value(CAM_RSTN, 1); usleep_range(300, 310); return 1; imx135_iovdd_fail: regulator_disable(pw->avdd); imx135_avdd_fail: if (pw->ext_reg2) regulator_disable(pw->ext_reg2); imx135_ext_reg2_fail: if (pw->ext_reg1) regulator_disable(pw->ext_reg1); gpio_set_value(priv->pdata->af_gpio, 0); imx135_ext_reg1_fail: imx135_poweron_fail: tegra_io_dpd_enable(&csia_io); tegra_io_dpd_enable(&csib_io); pr_err("%s failed.\n", __func__); return -ENODEV; } static int imx135_power_off(struct imx135_power_rail *pw) { return 0; if (unlikely(WARN_ON(!pw || !pw->iovdd || !pw->avdd))) { tegra_io_dpd_enable(&csia_io); tegra_io_dpd_enable(&csib_io); return -EFAULT; } regulator_disable(pw->iovdd); regulator_disable(pw->avdd); regulator_disable(pw->ext_reg1); regulator_disable(pw->ext_reg2); /* put CSIA/B IOs into DPD mode to save additional power for ardbeg */ tegra_io_dpd_enable(&csia_io); tegra_io_dpd_enable(&csib_io); return 0; } static int imx135_power_put(struct imx135_power_rail *pw) { if (unlikely(!pw)) return -EFAULT; pw->avdd = NULL; pw->iovdd = NULL; pw->dvdd = NULL; pw->ext_reg1 = NULL; pw->ext_reg2 = NULL; return 0; } static int imx135_power_get(struct imx135 *priv) { struct imx135_power_rail *pw = &priv->power; int err; /* ananlog 2.7v */ pw->avdd = devm_regulator_get(&priv->i2c_client->dev, "vana"); if (IS_ERR(pw->avdd)) { err = PTR_ERR(pw->avdd); pw->avdd = NULL; dev_err(&priv->i2c_client->dev, "Failed to get regulator vana\n"); return err; } /* digital 1.2v */ pw->dvdd = devm_regulator_get(&priv->i2c_client->dev, "vdig"); if (IS_ERR(pw->dvdd)) { err = PTR_ERR(pw->dvdd); pw->dvdd = NULL; dev_err(&priv->i2c_client->dev, "Failed to get regulator vdig\n"); return err; } /* IO 1.8v */ pw->iovdd = devm_regulator_get(&priv->i2c_client->dev, "vif"); if (IS_ERR(pw->iovdd)) { err = PTR_ERR(pw->iovdd); pw->iovdd = NULL; dev_err(&priv->i2c_client->dev, "Failed to get regulator vif\n"); return err; } return 0; } static int imx135_try_fmt(struct v4l2_subdev *sd, struct v4l2_mbus_framefmt *mf) { struct i2c_client *client = v4l2_get_subdevdata(sd); struct imx135 *priv = to_imx135(client); int mode = imx135_find_mode(sd, mf->width, mf->height); mf->width = imx135_frmsizes[mode].width; mf->height = imx135_frmsizes[mode].height; if (mf->code != V4L2_MBUS_FMT_SRGGB8_1X8 && mf->code != V4L2_MBUS_FMT_SRGGB10_1X10) mf->code = V4L2_MBUS_FMT_SRGGB10_1X10; mf->field = V4L2_FIELD_NONE; mf->colorspace = V4L2_COLORSPACE_SRGB; priv->mode = mode; return 0; } static int imx135_s_fmt(struct v4l2_subdev *sd, struct v4l2_mbus_framefmt *mf) { struct i2c_client *client = v4l2_get_subdevdata(sd); struct imx135 *priv = to_imx135(client); dev_dbg(sd->v4l2_dev->dev, "%s(%u)\n", __func__, mf->code); /* MIPI CSI could have changed the format, double-check */ if (!imx135_find_datafmt(mf->code)) return -EINVAL; imx135_try_fmt(sd, mf); priv->fmt = imx135_find_datafmt(mf->code); return 0; } static int imx135_g_fmt(struct v4l2_subdev *sd, struct v4l2_mbus_framefmt *mf) { struct i2c_client *client = v4l2_get_subdevdata(sd); struct imx135 *priv = to_imx135(client); const struct imx135_datafmt *fmt = priv->fmt; mf->code = fmt->code; mf->colorspace = fmt->colorspace; mf->width = IMX135_WIDTH; mf->height = IMX135_HEIGHT; mf->field = V4L2_FIELD_NONE; return 0; } static int imx135_g_crop(struct v4l2_subdev *sd, struct v4l2_crop *a) { struct v4l2_rect *rect = &a->c; a->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; rect->top = 0; rect->left = 0; rect->width = IMX135_WIDTH; rect->height = IMX135_HEIGHT; return 0; } static int imx135_cropcap(struct v4l2_subdev *sd, struct v4l2_cropcap *a) { a->bounds.left = 0; a->bounds.top = 0; a->bounds.width = IMX135_WIDTH; a->bounds.height = IMX135_HEIGHT; a->defrect = a->bounds; a->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; a->pixelaspect.numerator = 1; a->pixelaspect.denominator = 1; return 0; } static int imx135_enum_fmt(struct v4l2_subdev *sd, unsigned int index, enum v4l2_mbus_pixelcode *code) { if ((unsigned int)index >= ARRAY_SIZE(imx135_colour_fmts)) return -EINVAL; *code = imx135_colour_fmts[index].code; return 0; } static int imx135_s_stream(struct v4l2_subdev *sd, int enable) { struct i2c_client *client = v4l2_get_subdevdata(sd); struct imx135 *priv = to_imx135(client); int err = 0; if (!enable) return 0; err = imx135_write_table(priv->i2c_client, mode_table[priv->mode]); if (err) return err; if (test_mode) imx135_write_table(priv->i2c_client, tp_colorbars); err = imx135_write_table(priv->i2c_client, mode_quality); if (err) return err; return err; } static int imx135_g_chip_ident(struct v4l2_subdev *sd, struct v4l2_dbg_chip_ident *id) { struct i2c_client *client = v4l2_get_subdevdata(sd); if (id->match.type != V4L2_CHIP_MATCH_I2C_ADDR) return -EINVAL; if (id->match.addr != client->addr) return -ENODEV; id->ident = V4L2_IDENT_IMX135; id->revision = 0; return 0; } static int imx135_s_power(struct v4l2_subdev *sd, int on) { struct i2c_client *client = v4l2_get_subdevdata(sd); struct imx135 *priv = to_imx135(client); int err; if (on) { err = imx135_mclk_enable(priv); if (!err) err = imx135_power_on(&priv->power); if (err < 0) imx135_mclk_disable(priv); return err; } else if (!on) { imx135_power_off(&priv->power); imx135_mclk_disable(priv); return 0; } else return -EINVAL; } static int imx135_g_mbus_config(struct v4l2_subdev *sd, struct v4l2_mbus_config *cfg) { cfg->type = V4L2_MBUS_CSI2; cfg->flags = V4L2_MBUS_CSI2_4_LANE | V4L2_MBUS_CSI2_CHANNEL_0 | V4L2_MBUS_CSI2_CONTINUOUS_CLOCK; return 0; } static struct v4l2_subdev_video_ops imx135_subdev_video_ops = { .s_stream = imx135_s_stream, .s_mbus_fmt = imx135_s_fmt, .g_mbus_fmt = imx135_g_fmt, .try_mbus_fmt = imx135_try_fmt, .enum_mbus_fmt = imx135_enum_fmt, .g_crop = imx135_g_crop, .cropcap = imx135_cropcap, .g_mbus_config = imx135_g_mbus_config, }; static struct v4l2_subdev_core_ops imx135_subdev_core_ops = { .g_chip_ident = imx135_g_chip_ident, .s_power = imx135_s_power, }; static struct v4l2_subdev_ops imx135_subdev_ops = { .core = &imx135_subdev_core_ops, .video = &imx135_subdev_video_ops, }; static struct of_device_id imx135_of_match[] = { { .compatible = "nvidia,imx135", }, { }, }; MODULE_DEVICE_TABLE(of, imx135_of_match); static struct imx135_platform_data *imx135_parse_dt(struct i2c_client *client) { struct device_node *np = client->dev.of_node; struct imx135_platform_data *board_priv_pdata; const struct of_device_id *match; match = of_match_device(imx135_of_match, &client->dev); if (!match) { dev_err(&client->dev, "Failed to find matching dt id\n"); return NULL; } board_priv_pdata = devm_kzalloc(&client->dev, sizeof(*board_priv_pdata), GFP_KERNEL); if (!board_priv_pdata) { dev_err(&client->dev, "Failed to allocate pdata\n"); return NULL; } board_priv_pdata->cam1_gpio = of_get_named_gpio(np, "cam1-gpios", 0); board_priv_pdata->reset_gpio = of_get_named_gpio(np, "reset-gpios", 0); board_priv_pdata->af_gpio = of_get_named_gpio(np, "af-gpios", 0); board_priv_pdata->ext_reg = of_property_read_bool(np, "nvidia,ext_reg"); board_priv_pdata->power_on = imx135_power_on; board_priv_pdata->power_off = imx135_power_off; return board_priv_pdata; } static int imx135_get_sensor_id(struct imx135 *priv) { int i; u8 bak = 0, fuse_id[16]; imx135_mclk_enable(priv); imx135_power_on(&priv->power); imx135_write_reg(priv->i2c_client, 0x3B02, 0x00); imx135_write_reg(priv->i2c_client, 0x3B00, 0x01); for (i = 0; i < 9; i++) { imx135_read_reg(priv->i2c_client, 0x3B24 + i, &bak); fuse_id[i] = bak; } imx135_power_off(&priv->power); imx135_mclk_disable(priv); return 0; } static int imx135_probe(struct i2c_client *client, const struct i2c_device_id *id) { struct imx135 *priv; const char *mclk_name; int err; priv = devm_kzalloc(&client->dev, sizeof(struct imx135), GFP_KERNEL); if (!priv) { dev_err(&client->dev, "unable to allocate memory!\n"); return -ENOMEM; } if (client->dev.of_node) priv->pdata = imx135_parse_dt(client); else priv->pdata = client->dev.platform_data; if (!priv->pdata) { dev_err(&client->dev, "unable to get platform data\n"); return -EFAULT; } priv->i2c_client = client; priv->mode = IMX135_MODE; priv->fmt = &imx135_colour_fmts[0]; mclk_name = priv->pdata->mclk_name ? priv->pdata->mclk_name : "default_mclk"; priv->mclk = devm_clk_get(&client->dev, mclk_name); if (IS_ERR(priv->mclk)) { dev_err(&client->dev, "unable to get clock %s\n", mclk_name); return PTR_ERR(priv->mclk); } err = imx135_power_get(priv); if (err) return err; i2c_set_clientdata(client, priv); imx135_get_sensor_id(priv); imx135_create_debugfs(priv); v4l2_i2c_subdev_init(&priv->subdev, client, &imx135_subdev_ops); return 0; } static int imx135_remove(struct i2c_client *client) { struct soc_camera_subdev_desc *ssdd; struct imx135 *priv; ssdd = soc_camera_i2c_to_desc(client); if (ssdd->free_bus) ssdd->free_bus(ssdd); priv = i2c_get_clientdata(client); imx135_power_put(&priv->power); imx135_remove_debugfs(priv); return 0; } static const struct i2c_device_id imx135_id[] = { { "imx135_v4l2", 0 }, { } }; MODULE_DEVICE_TABLE(i2c, imx135_id); static struct i2c_driver imx135_i2c_driver = { .driver = { .name = "imx135_v4l2", .owner = THIS_MODULE, }, .probe = imx135_probe, .remove = imx135_remove, .id_table = imx135_id, }; module_i2c_driver(imx135_i2c_driver); MODULE_DESCRIPTION("SoC Camera driver for Sony IMX135"); MODULE_AUTHOR("Bryan Wu "); MODULE_LICENSE("GPL v2");