124169a5aSJacopo Mondi // SPDX-License-Identifier: GPL-2.0 23c2472a3SRamiro Oliveira /* 33c2472a3SRamiro Oliveira * A V4L2 driver for OmniVision OV5647 cameras. 43c2472a3SRamiro Oliveira * 53c2472a3SRamiro Oliveira * Based on Samsung S5K6AAFX SXGA 1/6" 1.3M CMOS Image Sensor driver 63c2472a3SRamiro Oliveira * Copyright (C) 2011 Sylwester Nawrocki <s.nawrocki@samsung.com> 73c2472a3SRamiro Oliveira * 83c2472a3SRamiro Oliveira * Based on Omnivision OV7670 Camera Driver 93c2472a3SRamiro Oliveira * Copyright (C) 2006-7 Jonathan Corbet <corbet@lwn.net> 103c2472a3SRamiro Oliveira * 113c2472a3SRamiro Oliveira * Copyright (C) 2016, Synopsys, Inc. 123c2472a3SRamiro Oliveira */ 133c2472a3SRamiro Oliveira 143c2472a3SRamiro Oliveira #include <linux/clk.h> 153c2472a3SRamiro Oliveira #include <linux/delay.h> 16b050791dSDave Stevenson #include <linux/gpio/consumer.h> 173c2472a3SRamiro Oliveira #include <linux/i2c.h> 183c2472a3SRamiro Oliveira #include <linux/init.h> 193c2472a3SRamiro Oliveira #include <linux/io.h> 203c2472a3SRamiro Oliveira #include <linux/module.h> 21859969b3SSakari Ailus #include <linux/of_graph.h> 223c2472a3SRamiro Oliveira #include <linux/slab.h> 233c2472a3SRamiro Oliveira #include <linux/videodev2.h> 244974c2f1SDavid Plowman #include <media/v4l2-ctrls.h> 253c2472a3SRamiro Oliveira #include <media/v4l2-device.h> 26859969b3SSakari Ailus #include <media/v4l2-fwnode.h> 273c2472a3SRamiro Oliveira #include <media/v4l2-image-sizes.h> 283c2472a3SRamiro Oliveira #include <media/v4l2-mediabus.h> 293c2472a3SRamiro Oliveira 30b050791dSDave Stevenson /* 31b050791dSDave Stevenson * From the datasheet, "20ms after PWDN goes low or 20ms after RESETB goes 32b050791dSDave Stevenson * high if reset is inserted after PWDN goes high, host can access sensor's 33b050791dSDave Stevenson * SCCB to initialize sensor." 34b050791dSDave Stevenson */ 35b050791dSDave Stevenson #define PWDN_ACTIVE_DELAY_MS 20 36b050791dSDave Stevenson 37cef66734SJacob Chen #define MIPI_CTRL00_CLOCK_LANE_GATE BIT(5) 38dea4fcfeSDave Stevenson #define MIPI_CTRL00_LINE_SYNC_ENABLE BIT(4) 39cef66734SJacob Chen #define MIPI_CTRL00_BUS_IDLE BIT(2) 40cef66734SJacob Chen #define MIPI_CTRL00_CLOCK_LANE_DISABLE BIT(0) 41cef66734SJacob Chen 42cef66734SJacob Chen #define OV5647_SW_STANDBY 0x0100 433c2472a3SRamiro Oliveira #define OV5647_SW_RESET 0x0103 44c9a05cecSJacopo Mondi #define OV5647_REG_CHIPID_H 0x300a 45c9a05cecSJacopo Mondi #define OV5647_REG_CHIPID_L 0x300b 46c9a05cecSJacopo Mondi #define OV5640_REG_PAD_OUT 0x300d 474974c2f1SDavid Plowman #define OV5647_REG_EXP_HI 0x3500 484974c2f1SDavid Plowman #define OV5647_REG_EXP_MID 0x3501 494974c2f1SDavid Plowman #define OV5647_REG_EXP_LO 0x3502 504974c2f1SDavid Plowman #define OV5647_REG_AEC_AGC 0x3503 514974c2f1SDavid Plowman #define OV5647_REG_GAIN_HI 0x350a 524974c2f1SDavid Plowman #define OV5647_REG_GAIN_LO 0x350b 53cef66734SJacob Chen #define OV5647_REG_FRAME_OFF_NUMBER 0x4202 54cef66734SJacob Chen #define OV5647_REG_MIPI_CTRL00 0x4800 55cef66734SJacob Chen #define OV5647_REG_MIPI_CTRL14 0x4814 564974c2f1SDavid Plowman #define OV5647_REG_AWB 0x5001 573c2472a3SRamiro Oliveira 583c2472a3SRamiro Oliveira #define REG_TERM 0xfffe 593c2472a3SRamiro Oliveira #define VAL_TERM 0xfe 603c2472a3SRamiro Oliveira #define REG_DLY 0xffff 613c2472a3SRamiro Oliveira 6214f70a32SDave Stevenson /* OV5647 native and active pixel array size */ 6314f70a32SDave Stevenson #define OV5647_NATIVE_WIDTH 2624U 6414f70a32SDave Stevenson #define OV5647_NATIVE_HEIGHT 1956U 653c2472a3SRamiro Oliveira 6614f70a32SDave Stevenson #define OV5647_PIXEL_ARRAY_LEFT 16U 6714f70a32SDave Stevenson #define OV5647_PIXEL_ARRAY_TOP 16U 6814f70a32SDave Stevenson #define OV5647_PIXEL_ARRAY_WIDTH 2592U 6914f70a32SDave Stevenson #define OV5647_PIXEL_ARRAY_HEIGHT 1944U 703c2472a3SRamiro Oliveira 713c2472a3SRamiro Oliveira struct regval_list { 723c2472a3SRamiro Oliveira u16 addr; 733c2472a3SRamiro Oliveira u8 data; 743c2472a3SRamiro Oliveira }; 753c2472a3SRamiro Oliveira 76d7d6074eSJacopo Mondi struct ov5647_mode { 77d7d6074eSJacopo Mondi struct v4l2_mbus_framefmt format; 7814f70a32SDave Stevenson struct v4l2_rect crop; 79911f4516SDave Stevenson u64 pixel_rate; 80*c6da1ae4SJacopo Mondi int hts; 81d7d6074eSJacopo Mondi const struct regval_list *reg_list; 82d7d6074eSJacopo Mondi unsigned int num_regs; 83d7d6074eSJacopo Mondi }; 84d7d6074eSJacopo Mondi 85d7d6074eSJacopo Mondi struct ov5647_format_list { 86d7d6074eSJacopo Mondi unsigned int mbus_code; 87d7d6074eSJacopo Mondi const struct ov5647_mode *modes; 88d7d6074eSJacopo Mondi unsigned int num_modes; 89d7d6074eSJacopo Mondi }; 90d7d6074eSJacopo Mondi 913c2472a3SRamiro Oliveira struct ov5647 { 923c2472a3SRamiro Oliveira struct v4l2_subdev sd; 933c2472a3SRamiro Oliveira struct media_pad pad; 943c2472a3SRamiro Oliveira struct mutex lock; 953c2472a3SRamiro Oliveira int power_count; 963c2472a3SRamiro Oliveira struct clk *xclk; 97b050791dSDave Stevenson struct gpio_desc *pwdn; 98dea4fcfeSDave Stevenson bool clock_ncont; 994974c2f1SDavid Plowman struct v4l2_ctrl_handler ctrls; 100d7d6074eSJacopo Mondi const struct ov5647_mode *mode; 101911f4516SDave Stevenson struct v4l2_ctrl *pixel_rate; 102*c6da1ae4SJacopo Mondi struct v4l2_ctrl *hblank; 1033c2472a3SRamiro Oliveira }; 1043c2472a3SRamiro Oliveira 1055bc5ca71SJacopo Mondi static inline struct ov5647 *to_sensor(struct v4l2_subdev *sd) 1063c2472a3SRamiro Oliveira { 1073c2472a3SRamiro Oliveira return container_of(sd, struct ov5647, sd); 1083c2472a3SRamiro Oliveira } 1093c2472a3SRamiro Oliveira 1103c2472a3SRamiro Oliveira static struct regval_list sensor_oe_disable_regs[] = { 1113c2472a3SRamiro Oliveira {0x3000, 0x00}, 1123c2472a3SRamiro Oliveira {0x3001, 0x00}, 1133c2472a3SRamiro Oliveira {0x3002, 0x00}, 1143c2472a3SRamiro Oliveira }; 1153c2472a3SRamiro Oliveira 1163c2472a3SRamiro Oliveira static struct regval_list sensor_oe_enable_regs[] = { 1173c2472a3SRamiro Oliveira {0x3000, 0x0f}, 1183c2472a3SRamiro Oliveira {0x3001, 0xff}, 1193c2472a3SRamiro Oliveira {0x3002, 0xe4}, 1203c2472a3SRamiro Oliveira }; 1213c2472a3SRamiro Oliveira 122e907bd66SJacopo Mondi static const struct regval_list ov5647_640x480_8bpp[] = { 1233c2472a3SRamiro Oliveira {0x0100, 0x00}, 1243c2472a3SRamiro Oliveira {0x0103, 0x01}, 1253c2472a3SRamiro Oliveira {0x3034, 0x08}, 1263c2472a3SRamiro Oliveira {0x3035, 0x21}, 1273c2472a3SRamiro Oliveira {0x3036, 0x46}, 1283c2472a3SRamiro Oliveira {0x303c, 0x11}, 1293c2472a3SRamiro Oliveira {0x3106, 0xf5}, 1303c2472a3SRamiro Oliveira {0x3821, 0x07}, 1313c2472a3SRamiro Oliveira {0x3820, 0x41}, 1323c2472a3SRamiro Oliveira {0x3827, 0xec}, 1333c2472a3SRamiro Oliveira {0x370c, 0x0f}, 1343c2472a3SRamiro Oliveira {0x3612, 0x59}, 1353c2472a3SRamiro Oliveira {0x3618, 0x00}, 1363c2472a3SRamiro Oliveira {0x5000, 0x06}, 1373c2472a3SRamiro Oliveira {0x5002, 0x41}, 1383c2472a3SRamiro Oliveira {0x5003, 0x08}, 1393c2472a3SRamiro Oliveira {0x5a00, 0x08}, 1403c2472a3SRamiro Oliveira {0x3000, 0x00}, 1413c2472a3SRamiro Oliveira {0x3001, 0x00}, 1423c2472a3SRamiro Oliveira {0x3002, 0x00}, 1433c2472a3SRamiro Oliveira {0x3016, 0x08}, 1443c2472a3SRamiro Oliveira {0x3017, 0xe0}, 1453c2472a3SRamiro Oliveira {0x3018, 0x44}, 1463c2472a3SRamiro Oliveira {0x301c, 0xf8}, 1473c2472a3SRamiro Oliveira {0x301d, 0xf0}, 1483c2472a3SRamiro Oliveira {0x3a18, 0x00}, 1493c2472a3SRamiro Oliveira {0x3a19, 0xf8}, 1503c2472a3SRamiro Oliveira {0x3c01, 0x80}, 1513c2472a3SRamiro Oliveira {0x3b07, 0x0c}, 1523c2472a3SRamiro Oliveira {0x380c, 0x07}, 1533c2472a3SRamiro Oliveira {0x380d, 0x68}, 1543c2472a3SRamiro Oliveira {0x380e, 0x03}, 1553c2472a3SRamiro Oliveira {0x380f, 0xd8}, 1563c2472a3SRamiro Oliveira {0x3814, 0x31}, 1573c2472a3SRamiro Oliveira {0x3815, 0x31}, 1583c2472a3SRamiro Oliveira {0x3708, 0x64}, 1593c2472a3SRamiro Oliveira {0x3709, 0x52}, 1603c2472a3SRamiro Oliveira {0x3808, 0x02}, 1613c2472a3SRamiro Oliveira {0x3809, 0x80}, 1623c2472a3SRamiro Oliveira {0x380a, 0x01}, 163c9a05cecSJacopo Mondi {0x380b, 0xe0}, 1643c2472a3SRamiro Oliveira {0x3801, 0x00}, 1653c2472a3SRamiro Oliveira {0x3802, 0x00}, 1663c2472a3SRamiro Oliveira {0x3803, 0x00}, 1673c2472a3SRamiro Oliveira {0x3804, 0x0a}, 1683c2472a3SRamiro Oliveira {0x3805, 0x3f}, 1693c2472a3SRamiro Oliveira {0x3806, 0x07}, 1703c2472a3SRamiro Oliveira {0x3807, 0xa1}, 1713c2472a3SRamiro Oliveira {0x3811, 0x08}, 1723c2472a3SRamiro Oliveira {0x3813, 0x02}, 1733c2472a3SRamiro Oliveira {0x3630, 0x2e}, 1743c2472a3SRamiro Oliveira {0x3632, 0xe2}, 1753c2472a3SRamiro Oliveira {0x3633, 0x23}, 1763c2472a3SRamiro Oliveira {0x3634, 0x44}, 1773c2472a3SRamiro Oliveira {0x3636, 0x06}, 1783c2472a3SRamiro Oliveira {0x3620, 0x64}, 1793c2472a3SRamiro Oliveira {0x3621, 0xe0}, 1803c2472a3SRamiro Oliveira {0x3600, 0x37}, 1813c2472a3SRamiro Oliveira {0x3704, 0xa0}, 1823c2472a3SRamiro Oliveira {0x3703, 0x5a}, 1833c2472a3SRamiro Oliveira {0x3715, 0x78}, 1843c2472a3SRamiro Oliveira {0x3717, 0x01}, 1853c2472a3SRamiro Oliveira {0x3731, 0x02}, 1863c2472a3SRamiro Oliveira {0x370b, 0x60}, 1873c2472a3SRamiro Oliveira {0x3705, 0x1a}, 1883c2472a3SRamiro Oliveira {0x3f05, 0x02}, 1893c2472a3SRamiro Oliveira {0x3f06, 0x10}, 1903c2472a3SRamiro Oliveira {0x3f01, 0x0a}, 1913c2472a3SRamiro Oliveira {0x3a08, 0x01}, 1923c2472a3SRamiro Oliveira {0x3a09, 0x27}, 1933c2472a3SRamiro Oliveira {0x3a0a, 0x00}, 1943c2472a3SRamiro Oliveira {0x3a0b, 0xf6}, 1953c2472a3SRamiro Oliveira {0x3a0d, 0x04}, 1963c2472a3SRamiro Oliveira {0x3a0e, 0x03}, 1973c2472a3SRamiro Oliveira {0x3a0f, 0x58}, 1983c2472a3SRamiro Oliveira {0x3a10, 0x50}, 1993c2472a3SRamiro Oliveira {0x3a1b, 0x58}, 2003c2472a3SRamiro Oliveira {0x3a1e, 0x50}, 2013c2472a3SRamiro Oliveira {0x3a11, 0x60}, 2023c2472a3SRamiro Oliveira {0x3a1f, 0x28}, 2033c2472a3SRamiro Oliveira {0x4001, 0x02}, 2043c2472a3SRamiro Oliveira {0x4004, 0x02}, 2053c2472a3SRamiro Oliveira {0x4000, 0x09}, 2063c2472a3SRamiro Oliveira {0x4837, 0x24}, 2073c2472a3SRamiro Oliveira {0x4050, 0x6e}, 2083c2472a3SRamiro Oliveira {0x4051, 0x8f}, 2093c2472a3SRamiro Oliveira {0x0100, 0x01}, 2103c2472a3SRamiro Oliveira }; 2113c2472a3SRamiro Oliveira 212a8df5af6SJacopo Mondi static struct regval_list ov5647_2592x1944_10bpp[] = { 213a8df5af6SJacopo Mondi {0x0100, 0x00}, 214a8df5af6SJacopo Mondi {0x0103, 0x01}, 215a8df5af6SJacopo Mondi {0x3034, 0x1a}, 216a8df5af6SJacopo Mondi {0x3035, 0x21}, 217a8df5af6SJacopo Mondi {0x3036, 0x69}, 218a8df5af6SJacopo Mondi {0x303c, 0x11}, 219a8df5af6SJacopo Mondi {0x3106, 0xf5}, 220a8df5af6SJacopo Mondi {0x3821, 0x06}, 221a8df5af6SJacopo Mondi {0x3820, 0x00}, 222a8df5af6SJacopo Mondi {0x3827, 0xec}, 223a8df5af6SJacopo Mondi {0x370c, 0x03}, 224a8df5af6SJacopo Mondi {0x3612, 0x5b}, 225a8df5af6SJacopo Mondi {0x3618, 0x04}, 226a8df5af6SJacopo Mondi {0x5000, 0x06}, 227a8df5af6SJacopo Mondi {0x5002, 0x41}, 228a8df5af6SJacopo Mondi {0x5003, 0x08}, 229a8df5af6SJacopo Mondi {0x5a00, 0x08}, 230a8df5af6SJacopo Mondi {0x3000, 0x00}, 231a8df5af6SJacopo Mondi {0x3001, 0x00}, 232a8df5af6SJacopo Mondi {0x3002, 0x00}, 233a8df5af6SJacopo Mondi {0x3016, 0x08}, 234a8df5af6SJacopo Mondi {0x3017, 0xe0}, 235a8df5af6SJacopo Mondi {0x3018, 0x44}, 236a8df5af6SJacopo Mondi {0x301c, 0xf8}, 237a8df5af6SJacopo Mondi {0x301d, 0xf0}, 238a8df5af6SJacopo Mondi {0x3a18, 0x00}, 239a8df5af6SJacopo Mondi {0x3a19, 0xf8}, 240a8df5af6SJacopo Mondi {0x3c01, 0x80}, 241a8df5af6SJacopo Mondi {0x3b07, 0x0c}, 242a8df5af6SJacopo Mondi {0x380c, 0x0b}, 243a8df5af6SJacopo Mondi {0x380d, 0x1c}, 244a8df5af6SJacopo Mondi {0x3814, 0x11}, 245a8df5af6SJacopo Mondi {0x3815, 0x11}, 246a8df5af6SJacopo Mondi {0x3708, 0x64}, 247a8df5af6SJacopo Mondi {0x3709, 0x12}, 248a8df5af6SJacopo Mondi {0x3808, 0x0a}, 249a8df5af6SJacopo Mondi {0x3809, 0x20}, 250a8df5af6SJacopo Mondi {0x380a, 0x07}, 251a8df5af6SJacopo Mondi {0x380b, 0x98}, 252a8df5af6SJacopo Mondi {0x3800, 0x00}, 253a8df5af6SJacopo Mondi {0x3801, 0x00}, 254a8df5af6SJacopo Mondi {0x3802, 0x00}, 255a8df5af6SJacopo Mondi {0x3803, 0x00}, 256a8df5af6SJacopo Mondi {0x3804, 0x0a}, 257a8df5af6SJacopo Mondi {0x3805, 0x3f}, 258a8df5af6SJacopo Mondi {0x3806, 0x07}, 259a8df5af6SJacopo Mondi {0x3807, 0xa3}, 260a8df5af6SJacopo Mondi {0x3811, 0x10}, 261a8df5af6SJacopo Mondi {0x3813, 0x06}, 262a8df5af6SJacopo Mondi {0x3630, 0x2e}, 263a8df5af6SJacopo Mondi {0x3632, 0xe2}, 264a8df5af6SJacopo Mondi {0x3633, 0x23}, 265a8df5af6SJacopo Mondi {0x3634, 0x44}, 266a8df5af6SJacopo Mondi {0x3636, 0x06}, 267a8df5af6SJacopo Mondi {0x3620, 0x64}, 268a8df5af6SJacopo Mondi {0x3621, 0xe0}, 269a8df5af6SJacopo Mondi {0x3600, 0x37}, 270a8df5af6SJacopo Mondi {0x3704, 0xa0}, 271a8df5af6SJacopo Mondi {0x3703, 0x5a}, 272a8df5af6SJacopo Mondi {0x3715, 0x78}, 273a8df5af6SJacopo Mondi {0x3717, 0x01}, 274a8df5af6SJacopo Mondi {0x3731, 0x02}, 275a8df5af6SJacopo Mondi {0x370b, 0x60}, 276a8df5af6SJacopo Mondi {0x3705, 0x1a}, 277a8df5af6SJacopo Mondi {0x3f05, 0x02}, 278a8df5af6SJacopo Mondi {0x3f06, 0x10}, 279a8df5af6SJacopo Mondi {0x3f01, 0x0a}, 280a8df5af6SJacopo Mondi {0x3a08, 0x01}, 281a8df5af6SJacopo Mondi {0x3a09, 0x28}, 282a8df5af6SJacopo Mondi {0x3a0a, 0x00}, 283a8df5af6SJacopo Mondi {0x3a0b, 0xf6}, 284a8df5af6SJacopo Mondi {0x3a0d, 0x08}, 285a8df5af6SJacopo Mondi {0x3a0e, 0x06}, 286a8df5af6SJacopo Mondi {0x3a0f, 0x58}, 287a8df5af6SJacopo Mondi {0x3a10, 0x50}, 288a8df5af6SJacopo Mondi {0x3a1b, 0x58}, 289a8df5af6SJacopo Mondi {0x3a1e, 0x50}, 290a8df5af6SJacopo Mondi {0x3a11, 0x60}, 291a8df5af6SJacopo Mondi {0x3a1f, 0x28}, 292a8df5af6SJacopo Mondi {0x4001, 0x02}, 293a8df5af6SJacopo Mondi {0x4004, 0x04}, 294a8df5af6SJacopo Mondi {0x4000, 0x09}, 295a8df5af6SJacopo Mondi {0x4837, 0x19}, 296a8df5af6SJacopo Mondi {0x4800, 0x24}, 297a8df5af6SJacopo Mondi {0x3503, 0x03}, 298a8df5af6SJacopo Mondi {0x0100, 0x01}, 299a8df5af6SJacopo Mondi }; 300a8df5af6SJacopo Mondi 301a8df5af6SJacopo Mondi static struct regval_list ov5647_1080p30_10bpp[] = { 302a8df5af6SJacopo Mondi {0x0100, 0x00}, 303a8df5af6SJacopo Mondi {0x0103, 0x01}, 304a8df5af6SJacopo Mondi {0x3034, 0x1a}, 305a8df5af6SJacopo Mondi {0x3035, 0x21}, 306a8df5af6SJacopo Mondi {0x3036, 0x62}, 307a8df5af6SJacopo Mondi {0x303c, 0x11}, 308a8df5af6SJacopo Mondi {0x3106, 0xf5}, 309a8df5af6SJacopo Mondi {0x3821, 0x06}, 310a8df5af6SJacopo Mondi {0x3820, 0x00}, 311a8df5af6SJacopo Mondi {0x3827, 0xec}, 312a8df5af6SJacopo Mondi {0x370c, 0x03}, 313a8df5af6SJacopo Mondi {0x3612, 0x5b}, 314a8df5af6SJacopo Mondi {0x3618, 0x04}, 315a8df5af6SJacopo Mondi {0x5000, 0x06}, 316a8df5af6SJacopo Mondi {0x5002, 0x41}, 317a8df5af6SJacopo Mondi {0x5003, 0x08}, 318a8df5af6SJacopo Mondi {0x5a00, 0x08}, 319a8df5af6SJacopo Mondi {0x3000, 0x00}, 320a8df5af6SJacopo Mondi {0x3001, 0x00}, 321a8df5af6SJacopo Mondi {0x3002, 0x00}, 322a8df5af6SJacopo Mondi {0x3016, 0x08}, 323a8df5af6SJacopo Mondi {0x3017, 0xe0}, 324a8df5af6SJacopo Mondi {0x3018, 0x44}, 325a8df5af6SJacopo Mondi {0x301c, 0xf8}, 326a8df5af6SJacopo Mondi {0x301d, 0xf0}, 327a8df5af6SJacopo Mondi {0x3a18, 0x00}, 328a8df5af6SJacopo Mondi {0x3a19, 0xf8}, 329a8df5af6SJacopo Mondi {0x3c01, 0x80}, 330a8df5af6SJacopo Mondi {0x3b07, 0x0c}, 331a8df5af6SJacopo Mondi {0x380c, 0x09}, 332a8df5af6SJacopo Mondi {0x380d, 0x70}, 333a8df5af6SJacopo Mondi {0x3814, 0x11}, 334a8df5af6SJacopo Mondi {0x3815, 0x11}, 335a8df5af6SJacopo Mondi {0x3708, 0x64}, 336a8df5af6SJacopo Mondi {0x3709, 0x12}, 337a8df5af6SJacopo Mondi {0x3808, 0x07}, 338a8df5af6SJacopo Mondi {0x3809, 0x80}, 339a8df5af6SJacopo Mondi {0x380a, 0x04}, 340a8df5af6SJacopo Mondi {0x380b, 0x38}, 341a8df5af6SJacopo Mondi {0x3800, 0x01}, 342a8df5af6SJacopo Mondi {0x3801, 0x5c}, 343a8df5af6SJacopo Mondi {0x3802, 0x01}, 344a8df5af6SJacopo Mondi {0x3803, 0xb2}, 345a8df5af6SJacopo Mondi {0x3804, 0x08}, 346a8df5af6SJacopo Mondi {0x3805, 0xe3}, 347a8df5af6SJacopo Mondi {0x3806, 0x05}, 348a8df5af6SJacopo Mondi {0x3807, 0xf1}, 349a8df5af6SJacopo Mondi {0x3811, 0x04}, 350a8df5af6SJacopo Mondi {0x3813, 0x02}, 351a8df5af6SJacopo Mondi {0x3630, 0x2e}, 352a8df5af6SJacopo Mondi {0x3632, 0xe2}, 353a8df5af6SJacopo Mondi {0x3633, 0x23}, 354a8df5af6SJacopo Mondi {0x3634, 0x44}, 355a8df5af6SJacopo Mondi {0x3636, 0x06}, 356a8df5af6SJacopo Mondi {0x3620, 0x64}, 357a8df5af6SJacopo Mondi {0x3621, 0xe0}, 358a8df5af6SJacopo Mondi {0x3600, 0x37}, 359a8df5af6SJacopo Mondi {0x3704, 0xa0}, 360a8df5af6SJacopo Mondi {0x3703, 0x5a}, 361a8df5af6SJacopo Mondi {0x3715, 0x78}, 362a8df5af6SJacopo Mondi {0x3717, 0x01}, 363a8df5af6SJacopo Mondi {0x3731, 0x02}, 364a8df5af6SJacopo Mondi {0x370b, 0x60}, 365a8df5af6SJacopo Mondi {0x3705, 0x1a}, 366a8df5af6SJacopo Mondi {0x3f05, 0x02}, 367a8df5af6SJacopo Mondi {0x3f06, 0x10}, 368a8df5af6SJacopo Mondi {0x3f01, 0x0a}, 369a8df5af6SJacopo Mondi {0x3a08, 0x01}, 370a8df5af6SJacopo Mondi {0x3a09, 0x4b}, 371a8df5af6SJacopo Mondi {0x3a0a, 0x01}, 372a8df5af6SJacopo Mondi {0x3a0b, 0x13}, 373a8df5af6SJacopo Mondi {0x3a0d, 0x04}, 374a8df5af6SJacopo Mondi {0x3a0e, 0x03}, 375a8df5af6SJacopo Mondi {0x3a0f, 0x58}, 376a8df5af6SJacopo Mondi {0x3a10, 0x50}, 377a8df5af6SJacopo Mondi {0x3a1b, 0x58}, 378a8df5af6SJacopo Mondi {0x3a1e, 0x50}, 379a8df5af6SJacopo Mondi {0x3a11, 0x60}, 380a8df5af6SJacopo Mondi {0x3a1f, 0x28}, 381a8df5af6SJacopo Mondi {0x4001, 0x02}, 382a8df5af6SJacopo Mondi {0x4004, 0x04}, 383a8df5af6SJacopo Mondi {0x4000, 0x09}, 384a8df5af6SJacopo Mondi {0x4837, 0x19}, 385a8df5af6SJacopo Mondi {0x4800, 0x34}, 386a8df5af6SJacopo Mondi {0x3503, 0x03}, 387a8df5af6SJacopo Mondi {0x0100, 0x01}, 388a8df5af6SJacopo Mondi }; 389a8df5af6SJacopo Mondi 390a8df5af6SJacopo Mondi static struct regval_list ov5647_2x2binned_10bpp[] = { 391a8df5af6SJacopo Mondi {0x0100, 0x00}, 392a8df5af6SJacopo Mondi {0x0103, 0x01}, 393a8df5af6SJacopo Mondi {0x3034, 0x1a}, 394a8df5af6SJacopo Mondi {0x3035, 0x21}, 395a8df5af6SJacopo Mondi {0x3036, 0x62}, 396a8df5af6SJacopo Mondi {0x303c, 0x11}, 397a8df5af6SJacopo Mondi {0x3106, 0xf5}, 398a8df5af6SJacopo Mondi {0x3827, 0xec}, 399a8df5af6SJacopo Mondi {0x370c, 0x03}, 400a8df5af6SJacopo Mondi {0x3612, 0x59}, 401a8df5af6SJacopo Mondi {0x3618, 0x00}, 402a8df5af6SJacopo Mondi {0x5000, 0x06}, 403a8df5af6SJacopo Mondi {0x5002, 0x41}, 404a8df5af6SJacopo Mondi {0x5003, 0x08}, 405a8df5af6SJacopo Mondi {0x5a00, 0x08}, 406a8df5af6SJacopo Mondi {0x3000, 0x00}, 407a8df5af6SJacopo Mondi {0x3001, 0x00}, 408a8df5af6SJacopo Mondi {0x3002, 0x00}, 409a8df5af6SJacopo Mondi {0x3016, 0x08}, 410a8df5af6SJacopo Mondi {0x3017, 0xe0}, 411a8df5af6SJacopo Mondi {0x3018, 0x44}, 412a8df5af6SJacopo Mondi {0x301c, 0xf8}, 413a8df5af6SJacopo Mondi {0x301d, 0xf0}, 414a8df5af6SJacopo Mondi {0x3a18, 0x00}, 415a8df5af6SJacopo Mondi {0x3a19, 0xf8}, 416a8df5af6SJacopo Mondi {0x3c01, 0x80}, 417a8df5af6SJacopo Mondi {0x3b07, 0x0c}, 418a8df5af6SJacopo Mondi {0x3800, 0x00}, 419a8df5af6SJacopo Mondi {0x3801, 0x00}, 420a8df5af6SJacopo Mondi {0x3802, 0x00}, 421a8df5af6SJacopo Mondi {0x3803, 0x00}, 422a8df5af6SJacopo Mondi {0x3804, 0x0a}, 423a8df5af6SJacopo Mondi {0x3805, 0x3f}, 424a8df5af6SJacopo Mondi {0x3806, 0x07}, 425a8df5af6SJacopo Mondi {0x3807, 0xa3}, 426a8df5af6SJacopo Mondi {0x3808, 0x05}, 427a8df5af6SJacopo Mondi {0x3809, 0x10}, 428a8df5af6SJacopo Mondi {0x380a, 0x03}, 429a8df5af6SJacopo Mondi {0x380b, 0xcc}, 430a8df5af6SJacopo Mondi {0x380c, 0x07}, 431a8df5af6SJacopo Mondi {0x380d, 0x68}, 432a8df5af6SJacopo Mondi {0x3811, 0x0c}, 433a8df5af6SJacopo Mondi {0x3813, 0x06}, 434a8df5af6SJacopo Mondi {0x3814, 0x31}, 435a8df5af6SJacopo Mondi {0x3815, 0x31}, 436a8df5af6SJacopo Mondi {0x3630, 0x2e}, 437a8df5af6SJacopo Mondi {0x3632, 0xe2}, 438a8df5af6SJacopo Mondi {0x3633, 0x23}, 439a8df5af6SJacopo Mondi {0x3634, 0x44}, 440a8df5af6SJacopo Mondi {0x3636, 0x06}, 441a8df5af6SJacopo Mondi {0x3620, 0x64}, 442a8df5af6SJacopo Mondi {0x3621, 0xe0}, 443a8df5af6SJacopo Mondi {0x3600, 0x37}, 444a8df5af6SJacopo Mondi {0x3704, 0xa0}, 445a8df5af6SJacopo Mondi {0x3703, 0x5a}, 446a8df5af6SJacopo Mondi {0x3715, 0x78}, 447a8df5af6SJacopo Mondi {0x3717, 0x01}, 448a8df5af6SJacopo Mondi {0x3731, 0x02}, 449a8df5af6SJacopo Mondi {0x370b, 0x60}, 450a8df5af6SJacopo Mondi {0x3705, 0x1a}, 451a8df5af6SJacopo Mondi {0x3f05, 0x02}, 452a8df5af6SJacopo Mondi {0x3f06, 0x10}, 453a8df5af6SJacopo Mondi {0x3f01, 0x0a}, 454a8df5af6SJacopo Mondi {0x3a08, 0x01}, 455a8df5af6SJacopo Mondi {0x3a09, 0x28}, 456a8df5af6SJacopo Mondi {0x3a0a, 0x00}, 457a8df5af6SJacopo Mondi {0x3a0b, 0xf6}, 458a8df5af6SJacopo Mondi {0x3a0d, 0x08}, 459a8df5af6SJacopo Mondi {0x3a0e, 0x06}, 460a8df5af6SJacopo Mondi {0x3a0f, 0x58}, 461a8df5af6SJacopo Mondi {0x3a10, 0x50}, 462a8df5af6SJacopo Mondi {0x3a1b, 0x58}, 463a8df5af6SJacopo Mondi {0x3a1e, 0x50}, 464a8df5af6SJacopo Mondi {0x3a11, 0x60}, 465a8df5af6SJacopo Mondi {0x3a1f, 0x28}, 466a8df5af6SJacopo Mondi {0x4001, 0x02}, 467a8df5af6SJacopo Mondi {0x4004, 0x04}, 468a8df5af6SJacopo Mondi {0x4000, 0x09}, 469a8df5af6SJacopo Mondi {0x4837, 0x16}, 470a8df5af6SJacopo Mondi {0x4800, 0x24}, 471a8df5af6SJacopo Mondi {0x3503, 0x03}, 472a8df5af6SJacopo Mondi {0x3820, 0x41}, 473a8df5af6SJacopo Mondi {0x3821, 0x07}, 474a8df5af6SJacopo Mondi {0x350a, 0x00}, 475a8df5af6SJacopo Mondi {0x350b, 0x10}, 476a8df5af6SJacopo Mondi {0x3500, 0x00}, 477a8df5af6SJacopo Mondi {0x3501, 0x1a}, 478a8df5af6SJacopo Mondi {0x3502, 0xf0}, 479a8df5af6SJacopo Mondi {0x3212, 0xa0}, 480a8df5af6SJacopo Mondi {0x0100, 0x01}, 481a8df5af6SJacopo Mondi }; 482a8df5af6SJacopo Mondi 483a8df5af6SJacopo Mondi static struct regval_list ov5647_640x480_10bpp[] = { 484a8df5af6SJacopo Mondi {0x0100, 0x00}, 485a8df5af6SJacopo Mondi {0x0103, 0x01}, 486a8df5af6SJacopo Mondi {0x3035, 0x11}, 487a8df5af6SJacopo Mondi {0x3036, 0x46}, 488a8df5af6SJacopo Mondi {0x303c, 0x11}, 489a8df5af6SJacopo Mondi {0x3821, 0x07}, 490a8df5af6SJacopo Mondi {0x3820, 0x41}, 491a8df5af6SJacopo Mondi {0x370c, 0x03}, 492a8df5af6SJacopo Mondi {0x3612, 0x59}, 493a8df5af6SJacopo Mondi {0x3618, 0x00}, 494a8df5af6SJacopo Mondi {0x5000, 0x06}, 495a8df5af6SJacopo Mondi {0x5003, 0x08}, 496a8df5af6SJacopo Mondi {0x5a00, 0x08}, 497a8df5af6SJacopo Mondi {0x3000, 0xff}, 498a8df5af6SJacopo Mondi {0x3001, 0xff}, 499a8df5af6SJacopo Mondi {0x3002, 0xff}, 500a8df5af6SJacopo Mondi {0x301d, 0xf0}, 501a8df5af6SJacopo Mondi {0x3a18, 0x00}, 502a8df5af6SJacopo Mondi {0x3a19, 0xf8}, 503a8df5af6SJacopo Mondi {0x3c01, 0x80}, 504a8df5af6SJacopo Mondi {0x3b07, 0x0c}, 505a8df5af6SJacopo Mondi {0x380c, 0x07}, 506a8df5af6SJacopo Mondi {0x380d, 0x3c}, 507a8df5af6SJacopo Mondi {0x3814, 0x35}, 508a8df5af6SJacopo Mondi {0x3815, 0x35}, 509a8df5af6SJacopo Mondi {0x3708, 0x64}, 510a8df5af6SJacopo Mondi {0x3709, 0x52}, 511a8df5af6SJacopo Mondi {0x3808, 0x02}, 512a8df5af6SJacopo Mondi {0x3809, 0x80}, 513a8df5af6SJacopo Mondi {0x380a, 0x01}, 514a8df5af6SJacopo Mondi {0x380b, 0xe0}, 515a8df5af6SJacopo Mondi {0x3800, 0x00}, 516a8df5af6SJacopo Mondi {0x3801, 0x10}, 517a8df5af6SJacopo Mondi {0x3802, 0x00}, 518a8df5af6SJacopo Mondi {0x3803, 0x00}, 519a8df5af6SJacopo Mondi {0x3804, 0x0a}, 520a8df5af6SJacopo Mondi {0x3805, 0x2f}, 521a8df5af6SJacopo Mondi {0x3806, 0x07}, 522a8df5af6SJacopo Mondi {0x3807, 0x9f}, 523a8df5af6SJacopo Mondi {0x3630, 0x2e}, 524a8df5af6SJacopo Mondi {0x3632, 0xe2}, 525a8df5af6SJacopo Mondi {0x3633, 0x23}, 526a8df5af6SJacopo Mondi {0x3634, 0x44}, 527a8df5af6SJacopo Mondi {0x3620, 0x64}, 528a8df5af6SJacopo Mondi {0x3621, 0xe0}, 529a8df5af6SJacopo Mondi {0x3600, 0x37}, 530a8df5af6SJacopo Mondi {0x3704, 0xa0}, 531a8df5af6SJacopo Mondi {0x3703, 0x5a}, 532a8df5af6SJacopo Mondi {0x3715, 0x78}, 533a8df5af6SJacopo Mondi {0x3717, 0x01}, 534a8df5af6SJacopo Mondi {0x3731, 0x02}, 535a8df5af6SJacopo Mondi {0x370b, 0x60}, 536a8df5af6SJacopo Mondi {0x3705, 0x1a}, 537a8df5af6SJacopo Mondi {0x3f05, 0x02}, 538a8df5af6SJacopo Mondi {0x3f06, 0x10}, 539a8df5af6SJacopo Mondi {0x3f01, 0x0a}, 540a8df5af6SJacopo Mondi {0x3a08, 0x01}, 541a8df5af6SJacopo Mondi {0x3a09, 0x2e}, 542a8df5af6SJacopo Mondi {0x3a0a, 0x00}, 543a8df5af6SJacopo Mondi {0x3a0b, 0xfb}, 544a8df5af6SJacopo Mondi {0x3a0d, 0x02}, 545a8df5af6SJacopo Mondi {0x3a0e, 0x01}, 546a8df5af6SJacopo Mondi {0x3a0f, 0x58}, 547a8df5af6SJacopo Mondi {0x3a10, 0x50}, 548a8df5af6SJacopo Mondi {0x3a1b, 0x58}, 549a8df5af6SJacopo Mondi {0x3a1e, 0x50}, 550a8df5af6SJacopo Mondi {0x3a11, 0x60}, 551a8df5af6SJacopo Mondi {0x3a1f, 0x28}, 552a8df5af6SJacopo Mondi {0x4001, 0x02}, 553a8df5af6SJacopo Mondi {0x4004, 0x02}, 554a8df5af6SJacopo Mondi {0x4000, 0x09}, 555a8df5af6SJacopo Mondi {0x3000, 0x00}, 556a8df5af6SJacopo Mondi {0x3001, 0x00}, 557a8df5af6SJacopo Mondi {0x3002, 0x00}, 558a8df5af6SJacopo Mondi {0x3017, 0xe0}, 559a8df5af6SJacopo Mondi {0x301c, 0xfc}, 560a8df5af6SJacopo Mondi {0x3636, 0x06}, 561a8df5af6SJacopo Mondi {0x3016, 0x08}, 562a8df5af6SJacopo Mondi {0x3827, 0xec}, 563a8df5af6SJacopo Mondi {0x3018, 0x44}, 564a8df5af6SJacopo Mondi {0x3035, 0x21}, 565a8df5af6SJacopo Mondi {0x3106, 0xf5}, 566a8df5af6SJacopo Mondi {0x3034, 0x1a}, 567a8df5af6SJacopo Mondi {0x301c, 0xf8}, 568a8df5af6SJacopo Mondi {0x4800, 0x34}, 569a8df5af6SJacopo Mondi {0x3503, 0x03}, 570a8df5af6SJacopo Mondi {0x0100, 0x01}, 571a8df5af6SJacopo Mondi }; 572a8df5af6SJacopo Mondi 573e907bd66SJacopo Mondi static const struct ov5647_mode ov5647_8bpp_modes[] = { 574e907bd66SJacopo Mondi /* 8-bit VGA mode: Uncentred crop 2x2 binned 1296x972 image. */ 575d7d6074eSJacopo Mondi { 576d7d6074eSJacopo Mondi .format = { 577d7d6074eSJacopo Mondi .code = MEDIA_BUS_FMT_SBGGR8_1X8, 578d7d6074eSJacopo Mondi .colorspace = V4L2_COLORSPACE_SRGB, 579d7d6074eSJacopo Mondi .field = V4L2_FIELD_NONE, 580d7d6074eSJacopo Mondi .width = 640, 581d7d6074eSJacopo Mondi .height = 480 582d7d6074eSJacopo Mondi }, 58314f70a32SDave Stevenson .crop = { 58414f70a32SDave Stevenson .left = OV5647_PIXEL_ARRAY_LEFT, 58514f70a32SDave Stevenson .top = OV5647_PIXEL_ARRAY_TOP, 58614f70a32SDave Stevenson .width = 1280, 58714f70a32SDave Stevenson .height = 960, 58814f70a32SDave Stevenson }, 589911f4516SDave Stevenson .pixel_rate = 77291670, 590*c6da1ae4SJacopo Mondi .hts = 1896, 591e907bd66SJacopo Mondi .reg_list = ov5647_640x480_8bpp, 592e907bd66SJacopo Mondi .num_regs = ARRAY_SIZE(ov5647_640x480_8bpp) 593d7d6074eSJacopo Mondi }, 594d7d6074eSJacopo Mondi }; 595d7d6074eSJacopo Mondi 596a8df5af6SJacopo Mondi static const struct ov5647_mode ov5647_10bpp_modes[] = { 597a8df5af6SJacopo Mondi /* 2592x1944 full resolution full FOV 10-bit mode. */ 598a8df5af6SJacopo Mondi { 599a8df5af6SJacopo Mondi .format = { 600a8df5af6SJacopo Mondi .code = MEDIA_BUS_FMT_SBGGR10_1X10, 601a8df5af6SJacopo Mondi .colorspace = V4L2_COLORSPACE_SRGB, 602a8df5af6SJacopo Mondi .field = V4L2_FIELD_NONE, 603a8df5af6SJacopo Mondi .width = 2592, 604a8df5af6SJacopo Mondi .height = 1944 605a8df5af6SJacopo Mondi }, 606a8df5af6SJacopo Mondi .crop = { 607a8df5af6SJacopo Mondi .left = OV5647_PIXEL_ARRAY_LEFT, 608a8df5af6SJacopo Mondi .top = OV5647_PIXEL_ARRAY_TOP, 609a8df5af6SJacopo Mondi .width = 2592, 610a8df5af6SJacopo Mondi .height = 1944 611a8df5af6SJacopo Mondi }, 612911f4516SDave Stevenson .pixel_rate = 87500000, 613*c6da1ae4SJacopo Mondi .hts = 2844, 614a8df5af6SJacopo Mondi .reg_list = ov5647_2592x1944_10bpp, 615a8df5af6SJacopo Mondi .num_regs = ARRAY_SIZE(ov5647_2592x1944_10bpp) 616a8df5af6SJacopo Mondi }, 617a8df5af6SJacopo Mondi /* 1080p30 10-bit mode. Full resolution centre-cropped down to 1080p. */ 618a8df5af6SJacopo Mondi { 619a8df5af6SJacopo Mondi .format = { 620a8df5af6SJacopo Mondi .code = MEDIA_BUS_FMT_SBGGR10_1X10, 621a8df5af6SJacopo Mondi .colorspace = V4L2_COLORSPACE_SRGB, 622a8df5af6SJacopo Mondi .field = V4L2_FIELD_NONE, 623a8df5af6SJacopo Mondi .width = 1920, 624a8df5af6SJacopo Mondi .height = 1080 625a8df5af6SJacopo Mondi }, 626a8df5af6SJacopo Mondi .crop = { 627a8df5af6SJacopo Mondi .left = 348 + OV5647_PIXEL_ARRAY_LEFT, 628a8df5af6SJacopo Mondi .top = 434 + OV5647_PIXEL_ARRAY_TOP, 629a8df5af6SJacopo Mondi .width = 1928, 630a8df5af6SJacopo Mondi .height = 1080, 631a8df5af6SJacopo Mondi }, 632911f4516SDave Stevenson .pixel_rate = 81666700, 633*c6da1ae4SJacopo Mondi .hts = 2416, 634a8df5af6SJacopo Mondi .reg_list = ov5647_1080p30_10bpp, 635a8df5af6SJacopo Mondi .num_regs = ARRAY_SIZE(ov5647_1080p30_10bpp) 636a8df5af6SJacopo Mondi }, 637a8df5af6SJacopo Mondi /* 2x2 binned full FOV 10-bit mode. */ 638a8df5af6SJacopo Mondi { 639a8df5af6SJacopo Mondi .format = { 640a8df5af6SJacopo Mondi .code = MEDIA_BUS_FMT_SBGGR10_1X10, 641a8df5af6SJacopo Mondi .colorspace = V4L2_COLORSPACE_SRGB, 642a8df5af6SJacopo Mondi .field = V4L2_FIELD_NONE, 643a8df5af6SJacopo Mondi .width = 1296, 644a8df5af6SJacopo Mondi .height = 972 645a8df5af6SJacopo Mondi }, 646a8df5af6SJacopo Mondi .crop = { 647a8df5af6SJacopo Mondi .left = OV5647_PIXEL_ARRAY_LEFT, 648a8df5af6SJacopo Mondi .top = OV5647_PIXEL_ARRAY_TOP, 649a8df5af6SJacopo Mondi .width = 2592, 650a8df5af6SJacopo Mondi .height = 1944, 651a8df5af6SJacopo Mondi }, 652911f4516SDave Stevenson .pixel_rate = 81666700, 653*c6da1ae4SJacopo Mondi .hts = 1896, 654a8df5af6SJacopo Mondi .reg_list = ov5647_2x2binned_10bpp, 655a8df5af6SJacopo Mondi .num_regs = ARRAY_SIZE(ov5647_2x2binned_10bpp) 656a8df5af6SJacopo Mondi }, 657a8df5af6SJacopo Mondi /* 10-bit VGA full FOV 60fps. 2x2 binned and subsampled down to VGA. */ 658a8df5af6SJacopo Mondi { 659a8df5af6SJacopo Mondi .format = { 660a8df5af6SJacopo Mondi .code = MEDIA_BUS_FMT_SBGGR10_1X10, 661a8df5af6SJacopo Mondi .colorspace = V4L2_COLORSPACE_SRGB, 662a8df5af6SJacopo Mondi .field = V4L2_FIELD_NONE, 663a8df5af6SJacopo Mondi .width = 640, 664a8df5af6SJacopo Mondi .height = 480 665a8df5af6SJacopo Mondi }, 666a8df5af6SJacopo Mondi .crop = { 667a8df5af6SJacopo Mondi .left = 16 + OV5647_PIXEL_ARRAY_LEFT, 668a8df5af6SJacopo Mondi .top = OV5647_PIXEL_ARRAY_TOP, 669a8df5af6SJacopo Mondi .width = 2560, 670a8df5af6SJacopo Mondi .height = 1920, 671a8df5af6SJacopo Mondi }, 672911f4516SDave Stevenson .pixel_rate = 55000000, 673*c6da1ae4SJacopo Mondi .hts = 1852, 674a8df5af6SJacopo Mondi .reg_list = ov5647_640x480_10bpp, 675a8df5af6SJacopo Mondi .num_regs = ARRAY_SIZE(ov5647_640x480_10bpp) 676a8df5af6SJacopo Mondi }, 677a8df5af6SJacopo Mondi }; 678a8df5af6SJacopo Mondi 679d7d6074eSJacopo Mondi static const struct ov5647_format_list ov5647_formats[] = { 680d7d6074eSJacopo Mondi { 681d7d6074eSJacopo Mondi .mbus_code = MEDIA_BUS_FMT_SBGGR8_1X8, 682e907bd66SJacopo Mondi .modes = ov5647_8bpp_modes, 683e907bd66SJacopo Mondi .num_modes = ARRAY_SIZE(ov5647_8bpp_modes), 684d7d6074eSJacopo Mondi }, 685a8df5af6SJacopo Mondi { 686a8df5af6SJacopo Mondi .mbus_code = MEDIA_BUS_FMT_SBGGR10_1X10, 687a8df5af6SJacopo Mondi .modes = ov5647_10bpp_modes, 688a8df5af6SJacopo Mondi .num_modes = ARRAY_SIZE(ov5647_10bpp_modes), 689a8df5af6SJacopo Mondi }, 690d7d6074eSJacopo Mondi }; 691d7d6074eSJacopo Mondi 692d7d6074eSJacopo Mondi #define OV5647_NUM_FORMATS (ARRAY_SIZE(ov5647_formats)) 693d7d6074eSJacopo Mondi 69487576ac6SJacopo Mondi /* Default sensor mode is 2x2 binned 640x480 SBGGR10_1X10. */ 69587576ac6SJacopo Mondi #define OV5647_DEFAULT_MODE (&ov5647_formats[1].modes[3]) 69687576ac6SJacopo Mondi #define OV5647_DEFAULT_FORMAT (ov5647_formats[1].modes[3].format) 697d7d6074eSJacopo Mondi 6983c2472a3SRamiro Oliveira static int ov5647_write(struct v4l2_subdev *sd, u16 reg, u8 val) 6993c2472a3SRamiro Oliveira { 7003c2472a3SRamiro Oliveira unsigned char data[3] = { reg >> 8, reg & 0xff, val}; 7013c2472a3SRamiro Oliveira struct i2c_client *client = v4l2_get_subdevdata(sd); 702c9a05cecSJacopo Mondi int ret; 7033c2472a3SRamiro Oliveira 7043c2472a3SRamiro Oliveira ret = i2c_master_send(client, data, 3); 7052b18cbcfSJacopo Mondi if (ret < 0) { 7063c2472a3SRamiro Oliveira dev_dbg(&client->dev, "%s: i2c write error, reg: %x\n", 7073c2472a3SRamiro Oliveira __func__, reg); 7083c2472a3SRamiro Oliveira return ret; 7093c2472a3SRamiro Oliveira } 7103c2472a3SRamiro Oliveira 7112b18cbcfSJacopo Mondi return 0; 7122b18cbcfSJacopo Mondi } 7132b18cbcfSJacopo Mondi 7143c2472a3SRamiro Oliveira static int ov5647_read(struct v4l2_subdev *sd, u16 reg, u8 *val) 7153c2472a3SRamiro Oliveira { 7163c2472a3SRamiro Oliveira unsigned char data_w[2] = { reg >> 8, reg & 0xff }; 7173c2472a3SRamiro Oliveira struct i2c_client *client = v4l2_get_subdevdata(sd); 718c9a05cecSJacopo Mondi int ret; 7193c2472a3SRamiro Oliveira 7203c2472a3SRamiro Oliveira ret = i2c_master_send(client, data_w, 2); 7213c2472a3SRamiro Oliveira if (ret < 0) { 7223c2472a3SRamiro Oliveira dev_dbg(&client->dev, "%s: i2c write error, reg: %x\n", 7233c2472a3SRamiro Oliveira __func__, reg); 7243c2472a3SRamiro Oliveira return ret; 7253c2472a3SRamiro Oliveira } 7263c2472a3SRamiro Oliveira 7273c2472a3SRamiro Oliveira ret = i2c_master_recv(client, val, 1); 7282b18cbcfSJacopo Mondi if (ret < 0) { 7293c2472a3SRamiro Oliveira dev_dbg(&client->dev, "%s: i2c read error, reg: %x\n", 7303c2472a3SRamiro Oliveira __func__, reg); 7313c2472a3SRamiro Oliveira return ret; 7323c2472a3SRamiro Oliveira } 7333c2472a3SRamiro Oliveira 7342b18cbcfSJacopo Mondi return 0; 7352b18cbcfSJacopo Mondi } 7362b18cbcfSJacopo Mondi 7373c2472a3SRamiro Oliveira static int ov5647_write_array(struct v4l2_subdev *sd, 738d7d6074eSJacopo Mondi const struct regval_list *regs, int array_size) 7393c2472a3SRamiro Oliveira { 7403c2472a3SRamiro Oliveira int i, ret; 7413c2472a3SRamiro Oliveira 7423c2472a3SRamiro Oliveira for (i = 0; i < array_size; i++) { 7433c2472a3SRamiro Oliveira ret = ov5647_write(sd, regs[i].addr, regs[i].data); 7443c2472a3SRamiro Oliveira if (ret < 0) 7453c2472a3SRamiro Oliveira return ret; 7463c2472a3SRamiro Oliveira } 7473c2472a3SRamiro Oliveira 7483c2472a3SRamiro Oliveira return 0; 7493c2472a3SRamiro Oliveira } 7503c2472a3SRamiro Oliveira 7513c2472a3SRamiro Oliveira static int ov5647_set_virtual_channel(struct v4l2_subdev *sd, int channel) 7523c2472a3SRamiro Oliveira { 7533c2472a3SRamiro Oliveira u8 channel_id; 7543c2472a3SRamiro Oliveira int ret; 7553c2472a3SRamiro Oliveira 756cef66734SJacob Chen ret = ov5647_read(sd, OV5647_REG_MIPI_CTRL14, &channel_id); 7573c2472a3SRamiro Oliveira if (ret < 0) 7583c2472a3SRamiro Oliveira return ret; 7593c2472a3SRamiro Oliveira 7603c2472a3SRamiro Oliveira channel_id &= ~(3 << 6); 761c9a05cecSJacopo Mondi 762c9a05cecSJacopo Mondi return ov5647_write(sd, OV5647_REG_MIPI_CTRL14, 763c9a05cecSJacopo Mondi channel_id | (channel << 6)); 7643c2472a3SRamiro Oliveira } 7653c2472a3SRamiro Oliveira 766f7a70f9aSJacopo Mondi static int ov5647_set_mode(struct v4l2_subdev *sd) 767f7a70f9aSJacopo Mondi { 768f7a70f9aSJacopo Mondi struct i2c_client *client = v4l2_get_subdevdata(sd); 769d7d6074eSJacopo Mondi struct ov5647 *sensor = to_sensor(sd); 770f7a70f9aSJacopo Mondi u8 resetval, rdval; 771f7a70f9aSJacopo Mondi int ret; 772f7a70f9aSJacopo Mondi 773f7a70f9aSJacopo Mondi ret = ov5647_read(sd, OV5647_SW_STANDBY, &rdval); 774f7a70f9aSJacopo Mondi if (ret < 0) 775f7a70f9aSJacopo Mondi return ret; 776f7a70f9aSJacopo Mondi 777d7d6074eSJacopo Mondi ret = ov5647_write_array(sd, sensor->mode->reg_list, 778d7d6074eSJacopo Mondi sensor->mode->num_regs); 779f7a70f9aSJacopo Mondi if (ret < 0) { 780f7a70f9aSJacopo Mondi dev_err(&client->dev, "write sensor default regs error\n"); 781f7a70f9aSJacopo Mondi return ret; 782f7a70f9aSJacopo Mondi } 783f7a70f9aSJacopo Mondi 784f7a70f9aSJacopo Mondi ret = ov5647_set_virtual_channel(sd, 0); 785f7a70f9aSJacopo Mondi if (ret < 0) 786f7a70f9aSJacopo Mondi return ret; 787f7a70f9aSJacopo Mondi 788f7a70f9aSJacopo Mondi ret = ov5647_read(sd, OV5647_SW_STANDBY, &resetval); 789f7a70f9aSJacopo Mondi if (ret < 0) 790f7a70f9aSJacopo Mondi return ret; 791f7a70f9aSJacopo Mondi 792f7a70f9aSJacopo Mondi if (!(resetval & 0x01)) { 793f7a70f9aSJacopo Mondi dev_err(&client->dev, "Device was in SW standby"); 794f7a70f9aSJacopo Mondi ret = ov5647_write(sd, OV5647_SW_STANDBY, 0x01); 795f7a70f9aSJacopo Mondi if (ret < 0) 796f7a70f9aSJacopo Mondi return ret; 797f7a70f9aSJacopo Mondi } 798f7a70f9aSJacopo Mondi 799f7a70f9aSJacopo Mondi return 0; 800f7a70f9aSJacopo Mondi } 801f7a70f9aSJacopo Mondi 8023c2472a3SRamiro Oliveira static int ov5647_stream_on(struct v4l2_subdev *sd) 8033c2472a3SRamiro Oliveira { 804f7a70f9aSJacopo Mondi struct i2c_client *client = v4l2_get_subdevdata(sd); 8055bc5ca71SJacopo Mondi struct ov5647 *sensor = to_sensor(sd); 806dea4fcfeSDave Stevenson u8 val = MIPI_CTRL00_BUS_IDLE; 8073c2472a3SRamiro Oliveira int ret; 8083c2472a3SRamiro Oliveira 809f7a70f9aSJacopo Mondi ret = ov5647_set_mode(sd); 810f7a70f9aSJacopo Mondi if (ret) { 811f7a70f9aSJacopo Mondi dev_err(&client->dev, "Failed to program sensor mode: %d\n", ret); 812f7a70f9aSJacopo Mondi return ret; 813f7a70f9aSJacopo Mondi } 814f7a70f9aSJacopo Mondi 8154974c2f1SDavid Plowman /* Apply customized values from user when stream starts. */ 8164974c2f1SDavid Plowman ret = __v4l2_ctrl_handler_setup(sd->ctrl_handler); 8174974c2f1SDavid Plowman if (ret) 8184974c2f1SDavid Plowman return ret; 8194974c2f1SDavid Plowman 8205bc5ca71SJacopo Mondi if (sensor->clock_ncont) 821dea4fcfeSDave Stevenson val |= MIPI_CTRL00_CLOCK_LANE_GATE | 822dea4fcfeSDave Stevenson MIPI_CTRL00_LINE_SYNC_ENABLE; 823dea4fcfeSDave Stevenson 824dea4fcfeSDave Stevenson ret = ov5647_write(sd, OV5647_REG_MIPI_CTRL00, val); 8257bc9f038SJacob Chen if (ret < 0) 8267bc9f038SJacob Chen return ret; 8277bc9f038SJacob Chen 828cef66734SJacob Chen ret = ov5647_write(sd, OV5647_REG_FRAME_OFF_NUMBER, 0x00); 8293c2472a3SRamiro Oliveira if (ret < 0) 8303c2472a3SRamiro Oliveira return ret; 8313c2472a3SRamiro Oliveira 832cef66734SJacob Chen return ov5647_write(sd, OV5640_REG_PAD_OUT, 0x00); 8333c2472a3SRamiro Oliveira } 8343c2472a3SRamiro Oliveira 8353c2472a3SRamiro Oliveira static int ov5647_stream_off(struct v4l2_subdev *sd) 8363c2472a3SRamiro Oliveira { 8373c2472a3SRamiro Oliveira int ret; 8383c2472a3SRamiro Oliveira 839c9a05cecSJacopo Mondi ret = ov5647_write(sd, OV5647_REG_MIPI_CTRL00, 840c9a05cecSJacopo Mondi MIPI_CTRL00_CLOCK_LANE_GATE | MIPI_CTRL00_BUS_IDLE | 841c9a05cecSJacopo Mondi MIPI_CTRL00_CLOCK_LANE_DISABLE); 8427bc9f038SJacob Chen if (ret < 0) 8437bc9f038SJacob Chen return ret; 8447bc9f038SJacob Chen 845cef66734SJacob Chen ret = ov5647_write(sd, OV5647_REG_FRAME_OFF_NUMBER, 0x0f); 8463c2472a3SRamiro Oliveira if (ret < 0) 8473c2472a3SRamiro Oliveira return ret; 8483c2472a3SRamiro Oliveira 849cef66734SJacob Chen return ov5647_write(sd, OV5640_REG_PAD_OUT, 0x01); 8503c2472a3SRamiro Oliveira } 8513c2472a3SRamiro Oliveira 8523c2472a3SRamiro Oliveira static int set_sw_standby(struct v4l2_subdev *sd, bool standby) 8533c2472a3SRamiro Oliveira { 8543c2472a3SRamiro Oliveira int ret; 8553c2472a3SRamiro Oliveira u8 rdval; 8563c2472a3SRamiro Oliveira 857cef66734SJacob Chen ret = ov5647_read(sd, OV5647_SW_STANDBY, &rdval); 8583c2472a3SRamiro Oliveira if (ret < 0) 8593c2472a3SRamiro Oliveira return ret; 8603c2472a3SRamiro Oliveira 8613c2472a3SRamiro Oliveira if (standby) 8623c2472a3SRamiro Oliveira rdval &= ~0x01; 8633c2472a3SRamiro Oliveira else 8643c2472a3SRamiro Oliveira rdval |= 0x01; 8653c2472a3SRamiro Oliveira 866cef66734SJacob Chen return ov5647_write(sd, OV5647_SW_STANDBY, rdval); 8673c2472a3SRamiro Oliveira } 8683c2472a3SRamiro Oliveira 8693c2472a3SRamiro Oliveira static int ov5647_sensor_power(struct v4l2_subdev *sd, int on) 8703c2472a3SRamiro Oliveira { 8713c2472a3SRamiro Oliveira struct i2c_client *client = v4l2_get_subdevdata(sd); 8725bc5ca71SJacopo Mondi struct ov5647 *sensor = to_sensor(sd); 873c9a05cecSJacopo Mondi int ret = 0; 8743c2472a3SRamiro Oliveira 8755bc5ca71SJacopo Mondi mutex_lock(&sensor->lock); 8763c2472a3SRamiro Oliveira 8775bc5ca71SJacopo Mondi if (on && !sensor->power_count) { 8783c2472a3SRamiro Oliveira dev_dbg(&client->dev, "OV5647 power on\n"); 8793c2472a3SRamiro Oliveira 8805bc5ca71SJacopo Mondi if (sensor->pwdn) { 8815bc5ca71SJacopo Mondi gpiod_set_value_cansleep(sensor->pwdn, 0); 882b050791dSDave Stevenson msleep(PWDN_ACTIVE_DELAY_MS); 883b050791dSDave Stevenson } 884b050791dSDave Stevenson 8855bc5ca71SJacopo Mondi ret = clk_prepare_enable(sensor->xclk); 8863c2472a3SRamiro Oliveira if (ret < 0) { 8873c2472a3SRamiro Oliveira dev_err(&client->dev, "clk prepare enable failed\n"); 8883c2472a3SRamiro Oliveira goto out; 8893c2472a3SRamiro Oliveira } 8903c2472a3SRamiro Oliveira 8913c2472a3SRamiro Oliveira ret = ov5647_write_array(sd, sensor_oe_enable_regs, 8923c2472a3SRamiro Oliveira ARRAY_SIZE(sensor_oe_enable_regs)); 8933c2472a3SRamiro Oliveira if (ret < 0) { 8945bc5ca71SJacopo Mondi clk_disable_unprepare(sensor->xclk); 8953c2472a3SRamiro Oliveira dev_err(&client->dev, 8963c2472a3SRamiro Oliveira "write sensor_oe_enable_regs error\n"); 8973c2472a3SRamiro Oliveira goto out; 8983c2472a3SRamiro Oliveira } 8993c2472a3SRamiro Oliveira 900f7a70f9aSJacopo Mondi /* Stream off to coax lanes into LP-11 state. */ 901f7a70f9aSJacopo Mondi ret = ov5647_stream_off(sd); 9023c2472a3SRamiro Oliveira if (ret < 0) { 9035bc5ca71SJacopo Mondi clk_disable_unprepare(sensor->xclk); 9043c2472a3SRamiro Oliveira dev_err(&client->dev, 9053c2472a3SRamiro Oliveira "Camera not available, check Power\n"); 9063c2472a3SRamiro Oliveira goto out; 9073c2472a3SRamiro Oliveira } 9085bc5ca71SJacopo Mondi } else if (!on && sensor->power_count == 1) { 9093c2472a3SRamiro Oliveira dev_dbg(&client->dev, "OV5647 power off\n"); 9103c2472a3SRamiro Oliveira 9113c2472a3SRamiro Oliveira ret = ov5647_write_array(sd, sensor_oe_disable_regs, 9123c2472a3SRamiro Oliveira ARRAY_SIZE(sensor_oe_disable_regs)); 9133c2472a3SRamiro Oliveira if (ret < 0) 9143c2472a3SRamiro Oliveira dev_dbg(&client->dev, "disable oe failed\n"); 9153c2472a3SRamiro Oliveira 9163c2472a3SRamiro Oliveira ret = set_sw_standby(sd, true); 9173c2472a3SRamiro Oliveira if (ret < 0) 9183c2472a3SRamiro Oliveira dev_dbg(&client->dev, "soft stby failed\n"); 9193c2472a3SRamiro Oliveira 9205bc5ca71SJacopo Mondi clk_disable_unprepare(sensor->xclk); 9215bc5ca71SJacopo Mondi gpiod_set_value_cansleep(sensor->pwdn, 1); 9223c2472a3SRamiro Oliveira } 9233c2472a3SRamiro Oliveira 9243c2472a3SRamiro Oliveira /* Update the power count. */ 9255bc5ca71SJacopo Mondi sensor->power_count += on ? 1 : -1; 9265bc5ca71SJacopo Mondi WARN_ON(sensor->power_count < 0); 9273c2472a3SRamiro Oliveira 9283c2472a3SRamiro Oliveira out: 9295bc5ca71SJacopo Mondi mutex_unlock(&sensor->lock); 9303c2472a3SRamiro Oliveira 9313c2472a3SRamiro Oliveira return ret; 9323c2472a3SRamiro Oliveira } 9333c2472a3SRamiro Oliveira 9343c2472a3SRamiro Oliveira #ifdef CONFIG_VIDEO_ADV_DEBUG 9353c2472a3SRamiro Oliveira static int ov5647_sensor_get_register(struct v4l2_subdev *sd, 9363c2472a3SRamiro Oliveira struct v4l2_dbg_register *reg) 9373c2472a3SRamiro Oliveira { 9383c2472a3SRamiro Oliveira int ret; 939c9a05cecSJacopo Mondi u8 val; 9403c2472a3SRamiro Oliveira 9413c2472a3SRamiro Oliveira ret = ov5647_read(sd, reg->reg & 0xff, &val); 9423c2472a3SRamiro Oliveira if (ret < 0) 9433c2472a3SRamiro Oliveira return ret; 9443c2472a3SRamiro Oliveira 9453c2472a3SRamiro Oliveira reg->val = val; 9463c2472a3SRamiro Oliveira reg->size = 1; 9473c2472a3SRamiro Oliveira 9483c2472a3SRamiro Oliveira return 0; 9493c2472a3SRamiro Oliveira } 9503c2472a3SRamiro Oliveira 9513c2472a3SRamiro Oliveira static int ov5647_sensor_set_register(struct v4l2_subdev *sd, 9523c2472a3SRamiro Oliveira const struct v4l2_dbg_register *reg) 9533c2472a3SRamiro Oliveira { 9543c2472a3SRamiro Oliveira return ov5647_write(sd, reg->reg & 0xff, reg->val & 0xff); 9553c2472a3SRamiro Oliveira } 9563c2472a3SRamiro Oliveira #endif 9573c2472a3SRamiro Oliveira 958c9a05cecSJacopo Mondi /* Subdev core operations registration */ 9593c2472a3SRamiro Oliveira static const struct v4l2_subdev_core_ops ov5647_subdev_core_ops = { 9603c2472a3SRamiro Oliveira .s_power = ov5647_sensor_power, 9613c2472a3SRamiro Oliveira #ifdef CONFIG_VIDEO_ADV_DEBUG 9623c2472a3SRamiro Oliveira .g_register = ov5647_sensor_get_register, 9633c2472a3SRamiro Oliveira .s_register = ov5647_sensor_set_register, 9643c2472a3SRamiro Oliveira #endif 9653c2472a3SRamiro Oliveira }; 9663c2472a3SRamiro Oliveira 96714f70a32SDave Stevenson static const struct v4l2_rect * 96814f70a32SDave Stevenson __ov5647_get_pad_crop(struct ov5647 *ov5647, struct v4l2_subdev_pad_config *cfg, 96914f70a32SDave Stevenson unsigned int pad, enum v4l2_subdev_format_whence which) 97014f70a32SDave Stevenson { 97114f70a32SDave Stevenson switch (which) { 97214f70a32SDave Stevenson case V4L2_SUBDEV_FORMAT_TRY: 97314f70a32SDave Stevenson return v4l2_subdev_get_try_crop(&ov5647->sd, cfg, pad); 97414f70a32SDave Stevenson case V4L2_SUBDEV_FORMAT_ACTIVE: 97514f70a32SDave Stevenson return &ov5647->mode->crop; 97614f70a32SDave Stevenson } 97714f70a32SDave Stevenson 97814f70a32SDave Stevenson return NULL; 97914f70a32SDave Stevenson } 98014f70a32SDave Stevenson 9813c2472a3SRamiro Oliveira static int ov5647_s_stream(struct v4l2_subdev *sd, int enable) 9823c2472a3SRamiro Oliveira { 9835bc5ca71SJacopo Mondi struct ov5647 *sensor = to_sensor(sd); 984ab614f27SJacopo Mondi int ret; 985ab614f27SJacopo Mondi 986ab614f27SJacopo Mondi mutex_lock(&sensor->lock); 9873c2472a3SRamiro Oliveira if (enable) 988ab614f27SJacopo Mondi ret = ov5647_stream_on(sd); 9893c2472a3SRamiro Oliveira else 990ab614f27SJacopo Mondi ret = ov5647_stream_off(sd); 991ab614f27SJacopo Mondi mutex_unlock(&sensor->lock); 992ab614f27SJacopo Mondi 993ab614f27SJacopo Mondi return ret; 9943c2472a3SRamiro Oliveira } 9953c2472a3SRamiro Oliveira 9963c2472a3SRamiro Oliveira static const struct v4l2_subdev_video_ops ov5647_subdev_video_ops = { 9973c2472a3SRamiro Oliveira .s_stream = ov5647_s_stream, 9983c2472a3SRamiro Oliveira }; 9993c2472a3SRamiro Oliveira 10003c2472a3SRamiro Oliveira static int ov5647_enum_mbus_code(struct v4l2_subdev *sd, 10013c2472a3SRamiro Oliveira struct v4l2_subdev_pad_config *cfg, 10023c2472a3SRamiro Oliveira struct v4l2_subdev_mbus_code_enum *code) 10033c2472a3SRamiro Oliveira { 1004d7d6074eSJacopo Mondi if (code->index >= OV5647_NUM_FORMATS) 10053c2472a3SRamiro Oliveira return -EINVAL; 10063c2472a3SRamiro Oliveira 1007d7d6074eSJacopo Mondi code->code = ov5647_formats[code->index].mbus_code; 10083c2472a3SRamiro Oliveira 10093c2472a3SRamiro Oliveira return 0; 10103c2472a3SRamiro Oliveira } 10113c2472a3SRamiro Oliveira 1012464090c0SJacopo Mondi static int ov5647_enum_frame_size(struct v4l2_subdev *sd, 1013464090c0SJacopo Mondi struct v4l2_subdev_pad_config *cfg, 1014464090c0SJacopo Mondi struct v4l2_subdev_frame_size_enum *fse) 1015464090c0SJacopo Mondi { 1016d7d6074eSJacopo Mondi const struct v4l2_mbus_framefmt *fmt; 1017d7d6074eSJacopo Mondi unsigned int i = 0; 1018d7d6074eSJacopo Mondi 1019d7d6074eSJacopo Mondi for (; i < OV5647_NUM_FORMATS; ++i) { 1020d7d6074eSJacopo Mondi if (ov5647_formats[i].mbus_code == fse->code) 1021d7d6074eSJacopo Mondi break; 1022d7d6074eSJacopo Mondi } 1023d7d6074eSJacopo Mondi if (i == OV5647_NUM_FORMATS) 1024464090c0SJacopo Mondi return -EINVAL; 1025464090c0SJacopo Mondi 1026d7d6074eSJacopo Mondi if (fse->index >= ov5647_formats[i].num_modes) 1027464090c0SJacopo Mondi return -EINVAL; 1028464090c0SJacopo Mondi 1029d7d6074eSJacopo Mondi fmt = &ov5647_formats[i].modes[fse->index].format; 1030d7d6074eSJacopo Mondi fse->min_width = fmt->width; 1031d7d6074eSJacopo Mondi fse->max_width = fmt->width; 1032d7d6074eSJacopo Mondi fse->min_height = fmt->height; 1033d7d6074eSJacopo Mondi fse->max_height = fmt->height; 1034464090c0SJacopo Mondi 1035464090c0SJacopo Mondi return 0; 1036464090c0SJacopo Mondi } 1037464090c0SJacopo Mondi 10386869e971SJacopo Mondi static int ov5647_get_pad_fmt(struct v4l2_subdev *sd, 10390f87233aSDave Stevenson struct v4l2_subdev_pad_config *cfg, 10400f87233aSDave Stevenson struct v4l2_subdev_format *format) 10410f87233aSDave Stevenson { 10420f87233aSDave Stevenson struct v4l2_mbus_framefmt *fmt = &format->format; 10436869e971SJacopo Mondi const struct v4l2_mbus_framefmt *sensor_format; 10446869e971SJacopo Mondi struct ov5647 *sensor = to_sensor(sd); 10450f87233aSDave Stevenson 10466869e971SJacopo Mondi mutex_lock(&sensor->lock); 10476869e971SJacopo Mondi switch (format->which) { 10486869e971SJacopo Mondi case V4L2_SUBDEV_FORMAT_TRY: 10496869e971SJacopo Mondi sensor_format = v4l2_subdev_get_try_format(sd, cfg, format->pad); 10506869e971SJacopo Mondi break; 10516869e971SJacopo Mondi default: 10526869e971SJacopo Mondi sensor_format = &sensor->mode->format; 10536869e971SJacopo Mondi break; 10546869e971SJacopo Mondi } 10556869e971SJacopo Mondi 10566869e971SJacopo Mondi *fmt = *sensor_format; 10576869e971SJacopo Mondi mutex_unlock(&sensor->lock); 10586869e971SJacopo Mondi 10596869e971SJacopo Mondi return 0; 10606869e971SJacopo Mondi } 10616869e971SJacopo Mondi 10626869e971SJacopo Mondi static int ov5647_set_pad_fmt(struct v4l2_subdev *sd, 10636869e971SJacopo Mondi struct v4l2_subdev_pad_config *cfg, 10646869e971SJacopo Mondi struct v4l2_subdev_format *format) 10656869e971SJacopo Mondi { 10666869e971SJacopo Mondi struct v4l2_mbus_framefmt *fmt = &format->format; 10676869e971SJacopo Mondi const struct ov5647_mode *ov5647_mode_list; 10686869e971SJacopo Mondi struct ov5647 *sensor = to_sensor(sd); 10696869e971SJacopo Mondi const struct ov5647_mode *mode; 10706869e971SJacopo Mondi unsigned int num_modes; 10716869e971SJacopo Mondi unsigned int i; 10726869e971SJacopo Mondi 10736869e971SJacopo Mondi for (i = 0; i < OV5647_NUM_FORMATS; ++i) { 10746869e971SJacopo Mondi if (ov5647_formats[i].mbus_code != fmt->code) 10756869e971SJacopo Mondi continue; 10766869e971SJacopo Mondi 10776869e971SJacopo Mondi ov5647_mode_list = ov5647_formats[i].modes; 10786869e971SJacopo Mondi num_modes = ov5647_formats[i].num_modes; 10796869e971SJacopo Mondi break; 10806869e971SJacopo Mondi } 10816869e971SJacopo Mondi 10826869e971SJacopo Mondi /* 10836869e971SJacopo Mondi * Default mbus code MEDIA_BUS_FMT_SBGGR10_1X10 if the requested one is 10846869e971SJacopo Mondi * not supported. 10856869e971SJacopo Mondi */ 10866869e971SJacopo Mondi if (i == OV5647_NUM_FORMATS) { 10876869e971SJacopo Mondi ov5647_mode_list = ov5647_10bpp_modes; 10886869e971SJacopo Mondi num_modes = ARRAY_SIZE(ov5647_10bpp_modes); 10896869e971SJacopo Mondi } 10906869e971SJacopo Mondi 10916869e971SJacopo Mondi mode = v4l2_find_nearest_size(ov5647_mode_list, num_modes, 10926869e971SJacopo Mondi format.width, format.height, 10936869e971SJacopo Mondi fmt->width, fmt->height); 10946869e971SJacopo Mondi 10956869e971SJacopo Mondi /* Update the sensor mode and apply at it at streamon time. */ 10966869e971SJacopo Mondi mutex_lock(&sensor->lock); 1097911f4516SDave Stevenson if (format->which == V4L2_SUBDEV_FORMAT_TRY) { 10986869e971SJacopo Mondi *v4l2_subdev_get_try_format(sd, cfg, format->pad) = mode->format; 1099911f4516SDave Stevenson } else { 1100*c6da1ae4SJacopo Mondi int hblank; 1101*c6da1ae4SJacopo Mondi 11026869e971SJacopo Mondi sensor->mode = mode; 1103911f4516SDave Stevenson __v4l2_ctrl_modify_range(sensor->pixel_rate, mode->pixel_rate, 1104911f4516SDave Stevenson mode->pixel_rate, 1, mode->pixel_rate); 1105*c6da1ae4SJacopo Mondi 1106*c6da1ae4SJacopo Mondi hblank = mode->hts - mode->format.width; 1107*c6da1ae4SJacopo Mondi __v4l2_ctrl_modify_range(sensor->hblank, hblank, hblank, 1, 1108*c6da1ae4SJacopo Mondi hblank); 1109911f4516SDave Stevenson } 11106869e971SJacopo Mondi *fmt = mode->format; 11116869e971SJacopo Mondi mutex_unlock(&sensor->lock); 11120f87233aSDave Stevenson 11130f87233aSDave Stevenson return 0; 11140f87233aSDave Stevenson } 11150f87233aSDave Stevenson 111614f70a32SDave Stevenson static int ov5647_get_selection(struct v4l2_subdev *sd, 111714f70a32SDave Stevenson struct v4l2_subdev_pad_config *cfg, 111814f70a32SDave Stevenson struct v4l2_subdev_selection *sel) 111914f70a32SDave Stevenson { 112014f70a32SDave Stevenson switch (sel->target) { 112114f70a32SDave Stevenson case V4L2_SEL_TGT_CROP: { 112214f70a32SDave Stevenson struct ov5647 *sensor = to_sensor(sd); 112314f70a32SDave Stevenson 112414f70a32SDave Stevenson mutex_lock(&sensor->lock); 112514f70a32SDave Stevenson sel->r = *__ov5647_get_pad_crop(sensor, cfg, sel->pad, 112614f70a32SDave Stevenson sel->which); 112714f70a32SDave Stevenson mutex_unlock(&sensor->lock); 112814f70a32SDave Stevenson 112914f70a32SDave Stevenson return 0; 113014f70a32SDave Stevenson } 113114f70a32SDave Stevenson 113214f70a32SDave Stevenson case V4L2_SEL_TGT_NATIVE_SIZE: 113314f70a32SDave Stevenson sel->r.top = 0; 113414f70a32SDave Stevenson sel->r.left = 0; 113514f70a32SDave Stevenson sel->r.width = OV5647_NATIVE_WIDTH; 113614f70a32SDave Stevenson sel->r.height = OV5647_NATIVE_HEIGHT; 113714f70a32SDave Stevenson 113814f70a32SDave Stevenson return 0; 113914f70a32SDave Stevenson 114014f70a32SDave Stevenson case V4L2_SEL_TGT_CROP_DEFAULT: 114114f70a32SDave Stevenson case V4L2_SEL_TGT_CROP_BOUNDS: 114214f70a32SDave Stevenson sel->r.top = OV5647_PIXEL_ARRAY_TOP; 114314f70a32SDave Stevenson sel->r.left = OV5647_PIXEL_ARRAY_LEFT; 114414f70a32SDave Stevenson sel->r.width = OV5647_PIXEL_ARRAY_WIDTH; 114514f70a32SDave Stevenson sel->r.height = OV5647_PIXEL_ARRAY_HEIGHT; 114614f70a32SDave Stevenson 114714f70a32SDave Stevenson return 0; 114814f70a32SDave Stevenson } 114914f70a32SDave Stevenson 115014f70a32SDave Stevenson return -EINVAL; 115114f70a32SDave Stevenson } 115214f70a32SDave Stevenson 11533c2472a3SRamiro Oliveira static const struct v4l2_subdev_pad_ops ov5647_subdev_pad_ops = { 11543c2472a3SRamiro Oliveira .enum_mbus_code = ov5647_enum_mbus_code, 1155464090c0SJacopo Mondi .enum_frame_size = ov5647_enum_frame_size, 11566869e971SJacopo Mondi .set_fmt = ov5647_set_pad_fmt, 11576869e971SJacopo Mondi .get_fmt = ov5647_get_pad_fmt, 115814f70a32SDave Stevenson .get_selection = ov5647_get_selection, 11593c2472a3SRamiro Oliveira }; 11603c2472a3SRamiro Oliveira 11613c2472a3SRamiro Oliveira static const struct v4l2_subdev_ops ov5647_subdev_ops = { 11623c2472a3SRamiro Oliveira .core = &ov5647_subdev_core_ops, 11633c2472a3SRamiro Oliveira .video = &ov5647_subdev_video_ops, 11643c2472a3SRamiro Oliveira .pad = &ov5647_subdev_pad_ops, 11653c2472a3SRamiro Oliveira }; 11663c2472a3SRamiro Oliveira 11673c2472a3SRamiro Oliveira static int ov5647_detect(struct v4l2_subdev *sd) 11683c2472a3SRamiro Oliveira { 1169c9a05cecSJacopo Mondi struct i2c_client *client = v4l2_get_subdevdata(sd); 11703c2472a3SRamiro Oliveira u8 read; 11713c2472a3SRamiro Oliveira int ret; 11723c2472a3SRamiro Oliveira 11733c2472a3SRamiro Oliveira ret = ov5647_write(sd, OV5647_SW_RESET, 0x01); 11743c2472a3SRamiro Oliveira if (ret < 0) 11753c2472a3SRamiro Oliveira return ret; 11763c2472a3SRamiro Oliveira 11773c2472a3SRamiro Oliveira ret = ov5647_read(sd, OV5647_REG_CHIPID_H, &read); 11783c2472a3SRamiro Oliveira if (ret < 0) 11793c2472a3SRamiro Oliveira return ret; 11803c2472a3SRamiro Oliveira 11813c2472a3SRamiro Oliveira if (read != 0x56) { 11823c2472a3SRamiro Oliveira dev_err(&client->dev, "ID High expected 0x56 got %x", read); 11833c2472a3SRamiro Oliveira return -ENODEV; 11843c2472a3SRamiro Oliveira } 11853c2472a3SRamiro Oliveira 11863c2472a3SRamiro Oliveira ret = ov5647_read(sd, OV5647_REG_CHIPID_L, &read); 11873c2472a3SRamiro Oliveira if (ret < 0) 11883c2472a3SRamiro Oliveira return ret; 11893c2472a3SRamiro Oliveira 11903c2472a3SRamiro Oliveira if (read != 0x47) { 11913c2472a3SRamiro Oliveira dev_err(&client->dev, "ID Low expected 0x47 got %x", read); 11923c2472a3SRamiro Oliveira return -ENODEV; 11933c2472a3SRamiro Oliveira } 11943c2472a3SRamiro Oliveira 11953c2472a3SRamiro Oliveira return ov5647_write(sd, OV5647_SW_RESET, 0x00); 11963c2472a3SRamiro Oliveira } 11973c2472a3SRamiro Oliveira 11983c2472a3SRamiro Oliveira static int ov5647_open(struct v4l2_subdev *sd, struct v4l2_subdev_fh *fh) 11993c2472a3SRamiro Oliveira { 12003c2472a3SRamiro Oliveira struct v4l2_mbus_framefmt *format = 12013c2472a3SRamiro Oliveira v4l2_subdev_get_try_format(sd, fh->pad, 0); 1202c9a05cecSJacopo Mondi struct v4l2_rect *crop = v4l2_subdev_get_try_crop(sd, fh->pad, 0); 12033c2472a3SRamiro Oliveira 120414f70a32SDave Stevenson crop->left = OV5647_PIXEL_ARRAY_LEFT; 120514f70a32SDave Stevenson crop->top = OV5647_PIXEL_ARRAY_TOP; 120614f70a32SDave Stevenson crop->width = OV5647_PIXEL_ARRAY_WIDTH; 120714f70a32SDave Stevenson crop->height = OV5647_PIXEL_ARRAY_HEIGHT; 12083c2472a3SRamiro Oliveira 1209d7d6074eSJacopo Mondi *format = OV5647_DEFAULT_FORMAT; 12103c2472a3SRamiro Oliveira 12113c2472a3SRamiro Oliveira return 0; 12123c2472a3SRamiro Oliveira } 12133c2472a3SRamiro Oliveira 12143c2472a3SRamiro Oliveira static const struct v4l2_subdev_internal_ops ov5647_subdev_internal_ops = { 12153c2472a3SRamiro Oliveira .open = ov5647_open, 12163c2472a3SRamiro Oliveira }; 12173c2472a3SRamiro Oliveira 12184974c2f1SDavid Plowman static int ov5647_s_auto_white_balance(struct v4l2_subdev *sd, u32 val) 12194974c2f1SDavid Plowman { 12204974c2f1SDavid Plowman return ov5647_write(sd, OV5647_REG_AWB, val ? 1 : 0); 12214974c2f1SDavid Plowman } 12224974c2f1SDavid Plowman 12234974c2f1SDavid Plowman static int ov5647_s_autogain(struct v4l2_subdev *sd, u32 val) 12244974c2f1SDavid Plowman { 12254974c2f1SDavid Plowman int ret; 12264974c2f1SDavid Plowman u8 reg; 12274974c2f1SDavid Plowman 12284974c2f1SDavid Plowman /* Non-zero turns on AGC by clearing bit 1.*/ 12294974c2f1SDavid Plowman ret = ov5647_read(sd, OV5647_REG_AEC_AGC, ®); 12304974c2f1SDavid Plowman if (ret) 12314974c2f1SDavid Plowman return ret; 12324974c2f1SDavid Plowman 12334974c2f1SDavid Plowman return ov5647_write(sd, OV5647_REG_AEC_AGC, val ? reg & ~BIT(1) 12344974c2f1SDavid Plowman : reg | BIT(1)); 12354974c2f1SDavid Plowman } 12364974c2f1SDavid Plowman 12374974c2f1SDavid Plowman static int ov5647_s_exposure_auto(struct v4l2_subdev *sd, u32 val) 12384974c2f1SDavid Plowman { 12394974c2f1SDavid Plowman int ret; 12404974c2f1SDavid Plowman u8 reg; 12414974c2f1SDavid Plowman 12424974c2f1SDavid Plowman /* 12434974c2f1SDavid Plowman * Everything except V4L2_EXPOSURE_MANUAL turns on AEC by 12444974c2f1SDavid Plowman * clearing bit 0. 12454974c2f1SDavid Plowman */ 12464974c2f1SDavid Plowman ret = ov5647_read(sd, OV5647_REG_AEC_AGC, ®); 12474974c2f1SDavid Plowman if (ret) 12484974c2f1SDavid Plowman return ret; 12494974c2f1SDavid Plowman 12504974c2f1SDavid Plowman return ov5647_write(sd, OV5647_REG_AEC_AGC, 12514974c2f1SDavid Plowman val == V4L2_EXPOSURE_MANUAL ? reg | BIT(0) 12524974c2f1SDavid Plowman : reg & ~BIT(0)); 12534974c2f1SDavid Plowman } 12544974c2f1SDavid Plowman 12554974c2f1SDavid Plowman static int ov5647_s_analogue_gain(struct v4l2_subdev *sd, u32 val) 12564974c2f1SDavid Plowman { 12574974c2f1SDavid Plowman int ret; 12584974c2f1SDavid Plowman 12594974c2f1SDavid Plowman /* 10 bits of gain, 2 in the high register. */ 12604974c2f1SDavid Plowman ret = ov5647_write(sd, OV5647_REG_GAIN_HI, (val >> 8) & 3); 12614974c2f1SDavid Plowman if (ret) 12624974c2f1SDavid Plowman return ret; 12634974c2f1SDavid Plowman 12644974c2f1SDavid Plowman return ov5647_write(sd, OV5647_REG_GAIN_LO, val & 0xff); 12654974c2f1SDavid Plowman } 12664974c2f1SDavid Plowman 12674974c2f1SDavid Plowman static int ov5647_s_exposure(struct v4l2_subdev *sd, u32 val) 12684974c2f1SDavid Plowman { 12694974c2f1SDavid Plowman int ret; 12704974c2f1SDavid Plowman 12714974c2f1SDavid Plowman /* 12724974c2f1SDavid Plowman * Sensor has 20 bits, but the bottom 4 bits are fractions of a line 12734974c2f1SDavid Plowman * which we leave as zero (and don't receive in "val"). 12744974c2f1SDavid Plowman */ 12754974c2f1SDavid Plowman ret = ov5647_write(sd, OV5647_REG_EXP_HI, (val >> 12) & 0xf); 12764974c2f1SDavid Plowman if (ret) 12774974c2f1SDavid Plowman return ret; 12784974c2f1SDavid Plowman 12794974c2f1SDavid Plowman ret = ov5647_write(sd, OV5647_REG_EXP_MID, (val >> 4) & 0xff); 12804974c2f1SDavid Plowman if (ret) 12814974c2f1SDavid Plowman return ret; 12824974c2f1SDavid Plowman 12834974c2f1SDavid Plowman return ov5647_write(sd, OV5647_REG_EXP_LO, (val & 0xf) << 4); 12844974c2f1SDavid Plowman } 12854974c2f1SDavid Plowman 12864974c2f1SDavid Plowman static int ov5647_s_ctrl(struct v4l2_ctrl *ctrl) 12874974c2f1SDavid Plowman { 12884974c2f1SDavid Plowman struct ov5647 *sensor = container_of(ctrl->handler, 12894974c2f1SDavid Plowman struct ov5647, ctrls); 12904974c2f1SDavid Plowman struct v4l2_subdev *sd = &sensor->sd; 12914974c2f1SDavid Plowman struct i2c_client *client = v4l2_get_subdevdata(sd); 12924974c2f1SDavid Plowman 12934974c2f1SDavid Plowman /* v4l2_ctrl_lock() locks our own mutex */ 12944974c2f1SDavid Plowman 12954974c2f1SDavid Plowman /* 12964974c2f1SDavid Plowman * If the device is not powered up by the host driver do 12974974c2f1SDavid Plowman * not apply any controls to H/W at this time. Instead 12984974c2f1SDavid Plowman * the controls will be restored at s_stream(1) time. 12994974c2f1SDavid Plowman */ 13004974c2f1SDavid Plowman if (!sensor->power_count) 13014974c2f1SDavid Plowman return 0; 13024974c2f1SDavid Plowman 13034974c2f1SDavid Plowman switch (ctrl->id) { 13044974c2f1SDavid Plowman case V4L2_CID_AUTO_WHITE_BALANCE: 13054974c2f1SDavid Plowman return ov5647_s_auto_white_balance(sd, ctrl->val); 13064974c2f1SDavid Plowman case V4L2_CID_AUTOGAIN: 13074974c2f1SDavid Plowman return ov5647_s_autogain(sd, ctrl->val); 13084974c2f1SDavid Plowman case V4L2_CID_EXPOSURE_AUTO: 13094974c2f1SDavid Plowman return ov5647_s_exposure_auto(sd, ctrl->val); 13104974c2f1SDavid Plowman case V4L2_CID_ANALOGUE_GAIN: 13114974c2f1SDavid Plowman return ov5647_s_analogue_gain(sd, ctrl->val); 13124974c2f1SDavid Plowman case V4L2_CID_EXPOSURE: 13134974c2f1SDavid Plowman return ov5647_s_exposure(sd, ctrl->val); 1314911f4516SDave Stevenson case V4L2_CID_PIXEL_RATE: 1315911f4516SDave Stevenson /* Read-only, but we adjust it based on mode. */ 1316911f4516SDave Stevenson return 0; 1317*c6da1ae4SJacopo Mondi case V4L2_CID_HBLANK: 1318*c6da1ae4SJacopo Mondi /* Read-only, but we adjust it based on mode. */ 1319*c6da1ae4SJacopo Mondi return 0; 13204974c2f1SDavid Plowman default: 13214974c2f1SDavid Plowman dev_info(&client->dev, 13224974c2f1SDavid Plowman "Control (id:0x%x, val:0x%x) not supported\n", 13234974c2f1SDavid Plowman ctrl->id, ctrl->val); 13244974c2f1SDavid Plowman return -EINVAL; 13254974c2f1SDavid Plowman } 13264974c2f1SDavid Plowman 13274974c2f1SDavid Plowman return 0; 13284974c2f1SDavid Plowman } 13294974c2f1SDavid Plowman 13304974c2f1SDavid Plowman static const struct v4l2_ctrl_ops ov5647_ctrl_ops = { 13314974c2f1SDavid Plowman .s_ctrl = ov5647_s_ctrl, 13324974c2f1SDavid Plowman }; 13334974c2f1SDavid Plowman 13344974c2f1SDavid Plowman static int ov5647_init_controls(struct ov5647 *sensor) 13354974c2f1SDavid Plowman { 13364974c2f1SDavid Plowman struct i2c_client *client = v4l2_get_subdevdata(&sensor->sd); 1337*c6da1ae4SJacopo Mondi int hblank; 13384974c2f1SDavid Plowman 1339*c6da1ae4SJacopo Mondi v4l2_ctrl_handler_init(&sensor->ctrls, 7); 13404974c2f1SDavid Plowman 13414974c2f1SDavid Plowman v4l2_ctrl_new_std(&sensor->ctrls, &ov5647_ctrl_ops, 13424974c2f1SDavid Plowman V4L2_CID_AUTOGAIN, 0, 1, 1, 0); 13434974c2f1SDavid Plowman 13444974c2f1SDavid Plowman v4l2_ctrl_new_std(&sensor->ctrls, &ov5647_ctrl_ops, 13454974c2f1SDavid Plowman V4L2_CID_AUTO_WHITE_BALANCE, 0, 1, 1, 0); 13464974c2f1SDavid Plowman 13474974c2f1SDavid Plowman v4l2_ctrl_new_std_menu(&sensor->ctrls, &ov5647_ctrl_ops, 13484974c2f1SDavid Plowman V4L2_CID_EXPOSURE_AUTO, V4L2_EXPOSURE_MANUAL, 13494974c2f1SDavid Plowman 0, V4L2_EXPOSURE_MANUAL); 13504974c2f1SDavid Plowman 13514974c2f1SDavid Plowman /* min: 4 lines; max: 0xffff lines; default: 1000 lines. */ 13524974c2f1SDavid Plowman v4l2_ctrl_new_std(&sensor->ctrls, &ov5647_ctrl_ops, 13534974c2f1SDavid Plowman V4L2_CID_EXPOSURE, 4, 65535, 1, 1000); 13544974c2f1SDavid Plowman 13554974c2f1SDavid Plowman /* min: 16 = 1.0x; max (10 bits); default: 32 = 2.0x. */ 13564974c2f1SDavid Plowman v4l2_ctrl_new_std(&sensor->ctrls, &ov5647_ctrl_ops, 13574974c2f1SDavid Plowman V4L2_CID_ANALOGUE_GAIN, 16, 1023, 1, 32); 13584974c2f1SDavid Plowman 1359911f4516SDave Stevenson /* By default, PIXEL_RATE is read only, but it does change per mode */ 1360911f4516SDave Stevenson sensor->pixel_rate = v4l2_ctrl_new_std(&sensor->ctrls, &ov5647_ctrl_ops, 1361911f4516SDave Stevenson V4L2_CID_PIXEL_RATE, 1362911f4516SDave Stevenson sensor->mode->pixel_rate, 1363911f4516SDave Stevenson sensor->mode->pixel_rate, 1, 1364911f4516SDave Stevenson sensor->mode->pixel_rate); 1365*c6da1ae4SJacopo Mondi 1366*c6da1ae4SJacopo Mondi /* By default, HBLANK is read only, but it does change per mode. */ 1367*c6da1ae4SJacopo Mondi hblank = sensor->mode->hts - sensor->mode->format.width; 1368*c6da1ae4SJacopo Mondi sensor->hblank = v4l2_ctrl_new_std(&sensor->ctrls, &ov5647_ctrl_ops, 1369*c6da1ae4SJacopo Mondi V4L2_CID_HBLANK, hblank, hblank, 1, 1370*c6da1ae4SJacopo Mondi hblank); 1371*c6da1ae4SJacopo Mondi 1372911f4516SDave Stevenson if (sensor->ctrls.error) 1373911f4516SDave Stevenson goto handler_free; 1374911f4516SDave Stevenson 1375911f4516SDave Stevenson sensor->pixel_rate->flags |= V4L2_CTRL_FLAG_READ_ONLY; 1376*c6da1ae4SJacopo Mondi sensor->hblank->flags |= V4L2_CTRL_FLAG_READ_ONLY; 1377911f4516SDave Stevenson sensor->sd.ctrl_handler = &sensor->ctrls; 1378911f4516SDave Stevenson 1379911f4516SDave Stevenson return 0; 1380911f4516SDave Stevenson 1381911f4516SDave Stevenson handler_free: 1382911f4516SDave Stevenson dev_err(&client->dev, "%s Controls initialization failed (%d)\n", 13834974c2f1SDavid Plowman __func__, sensor->ctrls.error); 13844974c2f1SDavid Plowman v4l2_ctrl_handler_free(&sensor->ctrls); 13854974c2f1SDavid Plowman 13864974c2f1SDavid Plowman return sensor->ctrls.error; 13874974c2f1SDavid Plowman } 13884974c2f1SDavid Plowman 1389dea4fcfeSDave Stevenson static int ov5647_parse_dt(struct ov5647 *sensor, struct device_node *np) 13903c2472a3SRamiro Oliveira { 1391dea4fcfeSDave Stevenson struct v4l2_fwnode_endpoint bus_cfg = { 1392dea4fcfeSDave Stevenson .bus_type = V4L2_MBUS_CSI2_DPHY, 1393dea4fcfeSDave Stevenson }; 13943c2472a3SRamiro Oliveira struct device_node *ep; 13953c2472a3SRamiro Oliveira int ret; 13963c2472a3SRamiro Oliveira 13973c2472a3SRamiro Oliveira ep = of_graph_get_next_endpoint(np, NULL); 13983c2472a3SRamiro Oliveira if (!ep) 13993c2472a3SRamiro Oliveira return -EINVAL; 14003c2472a3SRamiro Oliveira 1401859969b3SSakari Ailus ret = v4l2_fwnode_endpoint_parse(of_fwnode_handle(ep), &bus_cfg); 1402dea4fcfeSDave Stevenson if (ret) 1403dea4fcfeSDave Stevenson goto out; 14043c2472a3SRamiro Oliveira 1405dea4fcfeSDave Stevenson sensor->clock_ncont = bus_cfg.bus.mipi_csi2.flags & 1406dea4fcfeSDave Stevenson V4L2_MBUS_CSI2_NONCONTINUOUS_CLOCK; 1407dea4fcfeSDave Stevenson 1408dea4fcfeSDave Stevenson out: 14093c2472a3SRamiro Oliveira of_node_put(ep); 1410c9a05cecSJacopo Mondi 14113c2472a3SRamiro Oliveira return ret; 14123c2472a3SRamiro Oliveira } 14133c2472a3SRamiro Oliveira 1414e6714993SKieran Bingham static int ov5647_probe(struct i2c_client *client) 14153c2472a3SRamiro Oliveira { 1416c9a05cecSJacopo Mondi struct device_node *np = client->dev.of_node; 14173c2472a3SRamiro Oliveira struct device *dev = &client->dev; 14183c2472a3SRamiro Oliveira struct ov5647 *sensor; 14193c2472a3SRamiro Oliveira struct v4l2_subdev *sd; 14203c2472a3SRamiro Oliveira u32 xclk_freq; 1421c9a05cecSJacopo Mondi int ret; 14223c2472a3SRamiro Oliveira 14233c2472a3SRamiro Oliveira sensor = devm_kzalloc(dev, sizeof(*sensor), GFP_KERNEL); 14243c2472a3SRamiro Oliveira if (!sensor) 14253c2472a3SRamiro Oliveira return -ENOMEM; 14263c2472a3SRamiro Oliveira 14273c2472a3SRamiro Oliveira if (IS_ENABLED(CONFIG_OF) && np) { 1428dea4fcfeSDave Stevenson ret = ov5647_parse_dt(sensor, np); 14293c2472a3SRamiro Oliveira if (ret) { 14303c2472a3SRamiro Oliveira dev_err(dev, "DT parsing error: %d\n", ret); 14313c2472a3SRamiro Oliveira return ret; 14323c2472a3SRamiro Oliveira } 14333c2472a3SRamiro Oliveira } 14343c2472a3SRamiro Oliveira 14353c2472a3SRamiro Oliveira sensor->xclk = devm_clk_get(dev, NULL); 14363c2472a3SRamiro Oliveira if (IS_ERR(sensor->xclk)) { 14373c2472a3SRamiro Oliveira dev_err(dev, "could not get xclk"); 14383c2472a3SRamiro Oliveira return PTR_ERR(sensor->xclk); 14393c2472a3SRamiro Oliveira } 14403c2472a3SRamiro Oliveira 14413c2472a3SRamiro Oliveira xclk_freq = clk_get_rate(sensor->xclk); 14423c2472a3SRamiro Oliveira if (xclk_freq != 25000000) { 14433c2472a3SRamiro Oliveira dev_err(dev, "Unsupported clock frequency: %u\n", xclk_freq); 14443c2472a3SRamiro Oliveira return -EINVAL; 14453c2472a3SRamiro Oliveira } 14463c2472a3SRamiro Oliveira 1447c9a05cecSJacopo Mondi /* Request the power down GPIO asserted. */ 1448c9a05cecSJacopo Mondi sensor->pwdn = devm_gpiod_get_optional(dev, "pwdn", GPIOD_OUT_HIGH); 1449b050791dSDave Stevenson if (IS_ERR(sensor->pwdn)) { 1450b050791dSDave Stevenson dev_err(dev, "Failed to get 'pwdn' gpio\n"); 1451b050791dSDave Stevenson return -EINVAL; 1452b050791dSDave Stevenson } 1453b050791dSDave Stevenson 14543c2472a3SRamiro Oliveira mutex_init(&sensor->lock); 14553c2472a3SRamiro Oliveira 1456d7d6074eSJacopo Mondi sensor->mode = OV5647_DEFAULT_MODE; 1457d7d6074eSJacopo Mondi 14584974c2f1SDavid Plowman ret = ov5647_init_controls(sensor); 14594974c2f1SDavid Plowman if (ret) 14604974c2f1SDavid Plowman goto mutex_destroy; 14614974c2f1SDavid Plowman 14623c2472a3SRamiro Oliveira sd = &sensor->sd; 14633c2472a3SRamiro Oliveira v4l2_i2c_subdev_init(sd, client, &ov5647_subdev_ops); 1464c9a05cecSJacopo Mondi sd->internal_ops = &ov5647_subdev_internal_ops; 14657ef761a0SDave Stevenson sd->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE | V4L2_SUBDEV_FL_HAS_EVENTS; 14663c2472a3SRamiro Oliveira 14673c2472a3SRamiro Oliveira sensor->pad.flags = MEDIA_PAD_FL_SOURCE; 14683c2472a3SRamiro Oliveira sd->entity.function = MEDIA_ENT_F_CAM_SENSOR; 14693c2472a3SRamiro Oliveira ret = media_entity_pads_init(&sd->entity, 1, &sensor->pad); 14703c2472a3SRamiro Oliveira if (ret < 0) 14714974c2f1SDavid Plowman goto ctrl_handler_free; 14723c2472a3SRamiro Oliveira 1473b050791dSDave Stevenson if (sensor->pwdn) { 1474b050791dSDave Stevenson gpiod_set_value_cansleep(sensor->pwdn, 0); 1475b050791dSDave Stevenson msleep(PWDN_ACTIVE_DELAY_MS); 1476b050791dSDave Stevenson } 1477b050791dSDave Stevenson 14783c2472a3SRamiro Oliveira ret = ov5647_detect(sd); 1479b050791dSDave Stevenson gpiod_set_value_cansleep(sensor->pwdn, 1); 14803c2472a3SRamiro Oliveira if (ret < 0) 1481c9a05cecSJacopo Mondi goto entity_cleanup; 14823c2472a3SRamiro Oliveira 14833c2472a3SRamiro Oliveira ret = v4l2_async_register_subdev(sd); 14843c2472a3SRamiro Oliveira if (ret < 0) 1485c9a05cecSJacopo Mondi goto entity_cleanup; 14863c2472a3SRamiro Oliveira 14873c2472a3SRamiro Oliveira dev_dbg(dev, "OmniVision OV5647 camera driver probed\n"); 1488c9a05cecSJacopo Mondi 14893c2472a3SRamiro Oliveira return 0; 1490c9a05cecSJacopo Mondi 1491c9a05cecSJacopo Mondi entity_cleanup: 14923c2472a3SRamiro Oliveira media_entity_cleanup(&sd->entity); 14934974c2f1SDavid Plowman ctrl_handler_free: 14944974c2f1SDavid Plowman v4l2_ctrl_handler_free(&sensor->ctrls); 1495c9a05cecSJacopo Mondi mutex_destroy: 14963c2472a3SRamiro Oliveira mutex_destroy(&sensor->lock); 1497c9a05cecSJacopo Mondi 14983c2472a3SRamiro Oliveira return ret; 14993c2472a3SRamiro Oliveira } 15003c2472a3SRamiro Oliveira 15013c2472a3SRamiro Oliveira static int ov5647_remove(struct i2c_client *client) 15023c2472a3SRamiro Oliveira { 15033c2472a3SRamiro Oliveira struct v4l2_subdev *sd = i2c_get_clientdata(client); 15045bc5ca71SJacopo Mondi struct ov5647 *sensor = to_sensor(sd); 15053c2472a3SRamiro Oliveira 15065bc5ca71SJacopo Mondi v4l2_async_unregister_subdev(&sensor->sd); 15075bc5ca71SJacopo Mondi media_entity_cleanup(&sensor->sd.entity); 15085bc5ca71SJacopo Mondi v4l2_ctrl_handler_free(&sensor->ctrls); 15093c2472a3SRamiro Oliveira v4l2_device_unregister_subdev(sd); 15105bc5ca71SJacopo Mondi mutex_destroy(&sensor->lock); 15113c2472a3SRamiro Oliveira 15123c2472a3SRamiro Oliveira return 0; 15133c2472a3SRamiro Oliveira } 15143c2472a3SRamiro Oliveira 15153c2472a3SRamiro Oliveira static const struct i2c_device_id ov5647_id[] = { 15163c2472a3SRamiro Oliveira { "ov5647", 0 }, 1517c9a05cecSJacopo Mondi { /* sentinel */ } 15183c2472a3SRamiro Oliveira }; 15193c2472a3SRamiro Oliveira MODULE_DEVICE_TABLE(i2c, ov5647_id); 15203c2472a3SRamiro Oliveira 15213c2472a3SRamiro Oliveira #if IS_ENABLED(CONFIG_OF) 15223c2472a3SRamiro Oliveira static const struct of_device_id ov5647_of_match[] = { 15233c2472a3SRamiro Oliveira { .compatible = "ovti,ov5647" }, 15243c2472a3SRamiro Oliveira { /* sentinel */ }, 15253c2472a3SRamiro Oliveira }; 15263c2472a3SRamiro Oliveira MODULE_DEVICE_TABLE(of, ov5647_of_match); 15273c2472a3SRamiro Oliveira #endif 15283c2472a3SRamiro Oliveira 15293c2472a3SRamiro Oliveira static struct i2c_driver ov5647_driver = { 15303c2472a3SRamiro Oliveira .driver = { 15313c2472a3SRamiro Oliveira .of_match_table = of_match_ptr(ov5647_of_match), 1532c9a05cecSJacopo Mondi .name = "ov5647", 15333c2472a3SRamiro Oliveira }, 1534e6714993SKieran Bingham .probe_new = ov5647_probe, 15353c2472a3SRamiro Oliveira .remove = ov5647_remove, 15363c2472a3SRamiro Oliveira .id_table = ov5647_id, 15373c2472a3SRamiro Oliveira }; 15383c2472a3SRamiro Oliveira 15393c2472a3SRamiro Oliveira module_i2c_driver(ov5647_driver); 15403c2472a3SRamiro Oliveira 15413c2472a3SRamiro Oliveira MODULE_AUTHOR("Ramiro Oliveira <roliveir@synopsys.com>"); 15423c2472a3SRamiro Oliveira MODULE_DESCRIPTION("A low-level driver for OmniVision ov5647 sensors"); 15433c2472a3SRamiro Oliveira MODULE_LICENSE("GPL v2"); 1544