123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596 |
- // SPDX-License-Identifier: GPL-2.0-only
- /*
- * Omnivision OV2659 CMOS Image Sensor driver
- *
- * Copyright (C) 2015 Texas Instruments, Inc.
- *
- * Benoit Parrot <[email protected]>
- * Lad, Prabhakar <[email protected]>
- */
- #include <linux/clk.h>
- #include <linux/delay.h>
- #include <linux/gpio/consumer.h>
- #include <linux/i2c.h>
- #include <linux/module.h>
- #include <linux/of_graph.h>
- #include <linux/pm_runtime.h>
- #include <media/i2c/ov2659.h>
- #include <media/v4l2-ctrls.h>
- #include <media/v4l2-event.h>
- #include <media/v4l2-fwnode.h>
- #include <media/v4l2-image-sizes.h>
- #include <media/v4l2-subdev.h>
- #define DRIVER_NAME "ov2659"
- /*
- * OV2659 register definitions
- */
- #define REG_SOFTWARE_STANDBY 0x0100
- #define REG_SOFTWARE_RESET 0x0103
- #define REG_IO_CTRL00 0x3000
- #define REG_IO_CTRL01 0x3001
- #define REG_IO_CTRL02 0x3002
- #define REG_OUTPUT_VALUE00 0x3008
- #define REG_OUTPUT_VALUE01 0x3009
- #define REG_OUTPUT_VALUE02 0x300d
- #define REG_OUTPUT_SELECT00 0x300e
- #define REG_OUTPUT_SELECT01 0x300f
- #define REG_OUTPUT_SELECT02 0x3010
- #define REG_OUTPUT_DRIVE 0x3011
- #define REG_INPUT_READOUT00 0x302d
- #define REG_INPUT_READOUT01 0x302e
- #define REG_INPUT_READOUT02 0x302f
- #define REG_SC_PLL_CTRL0 0x3003
- #define REG_SC_PLL_CTRL1 0x3004
- #define REG_SC_PLL_CTRL2 0x3005
- #define REG_SC_PLL_CTRL3 0x3006
- #define REG_SC_CHIP_ID_H 0x300a
- #define REG_SC_CHIP_ID_L 0x300b
- #define REG_SC_PWC 0x3014
- #define REG_SC_CLKRST0 0x301a
- #define REG_SC_CLKRST1 0x301b
- #define REG_SC_CLKRST2 0x301c
- #define REG_SC_CLKRST3 0x301d
- #define REG_SC_SUB_ID 0x302a
- #define REG_SC_SCCB_ID 0x302b
- #define REG_GROUP_ADDRESS_00 0x3200
- #define REG_GROUP_ADDRESS_01 0x3201
- #define REG_GROUP_ADDRESS_02 0x3202
- #define REG_GROUP_ADDRESS_03 0x3203
- #define REG_GROUP_ACCESS 0x3208
- #define REG_AWB_R_GAIN_H 0x3400
- #define REG_AWB_R_GAIN_L 0x3401
- #define REG_AWB_G_GAIN_H 0x3402
- #define REG_AWB_G_GAIN_L 0x3403
- #define REG_AWB_B_GAIN_H 0x3404
- #define REG_AWB_B_GAIN_L 0x3405
- #define REG_AWB_MANUAL_CONTROL 0x3406
- #define REG_TIMING_HS_H 0x3800
- #define REG_TIMING_HS_L 0x3801
- #define REG_TIMING_VS_H 0x3802
- #define REG_TIMING_VS_L 0x3803
- #define REG_TIMING_HW_H 0x3804
- #define REG_TIMING_HW_L 0x3805
- #define REG_TIMING_VH_H 0x3806
- #define REG_TIMING_VH_L 0x3807
- #define REG_TIMING_DVPHO_H 0x3808
- #define REG_TIMING_DVPHO_L 0x3809
- #define REG_TIMING_DVPVO_H 0x380a
- #define REG_TIMING_DVPVO_L 0x380b
- #define REG_TIMING_HTS_H 0x380c
- #define REG_TIMING_HTS_L 0x380d
- #define REG_TIMING_VTS_H 0x380e
- #define REG_TIMING_VTS_L 0x380f
- #define REG_TIMING_HOFFS_H 0x3810
- #define REG_TIMING_HOFFS_L 0x3811
- #define REG_TIMING_VOFFS_H 0x3812
- #define REG_TIMING_VOFFS_L 0x3813
- #define REG_TIMING_XINC 0x3814
- #define REG_TIMING_YINC 0x3815
- #define REG_TIMING_VERT_FORMAT 0x3820
- #define REG_TIMING_HORIZ_FORMAT 0x3821
- #define REG_FORMAT_CTRL00 0x4300
- #define REG_VFIFO_READ_START_H 0x4608
- #define REG_VFIFO_READ_START_L 0x4609
- #define REG_DVP_CTRL02 0x4708
- #define REG_ISP_CTRL00 0x5000
- #define REG_ISP_CTRL01 0x5001
- #define REG_ISP_CTRL02 0x5002
- #define REG_LENC_RED_X0_H 0x500c
- #define REG_LENC_RED_X0_L 0x500d
- #define REG_LENC_RED_Y0_H 0x500e
- #define REG_LENC_RED_Y0_L 0x500f
- #define REG_LENC_RED_A1 0x5010
- #define REG_LENC_RED_B1 0x5011
- #define REG_LENC_RED_A2_B2 0x5012
- #define REG_LENC_GREEN_X0_H 0x5013
- #define REG_LENC_GREEN_X0_L 0x5014
- #define REG_LENC_GREEN_Y0_H 0x5015
- #define REG_LENC_GREEN_Y0_L 0x5016
- #define REG_LENC_GREEN_A1 0x5017
- #define REG_LENC_GREEN_B1 0x5018
- #define REG_LENC_GREEN_A2_B2 0x5019
- #define REG_LENC_BLUE_X0_H 0x501a
- #define REG_LENC_BLUE_X0_L 0x501b
- #define REG_LENC_BLUE_Y0_H 0x501c
- #define REG_LENC_BLUE_Y0_L 0x501d
- #define REG_LENC_BLUE_A1 0x501e
- #define REG_LENC_BLUE_B1 0x501f
- #define REG_LENC_BLUE_A2_B2 0x5020
- #define REG_AWB_CTRL00 0x5035
- #define REG_AWB_CTRL01 0x5036
- #define REG_AWB_CTRL02 0x5037
- #define REG_AWB_CTRL03 0x5038
- #define REG_AWB_CTRL04 0x5039
- #define REG_AWB_LOCAL_LIMIT 0x503a
- #define REG_AWB_CTRL12 0x5049
- #define REG_AWB_CTRL13 0x504a
- #define REG_AWB_CTRL14 0x504b
- #define REG_SHARPENMT_THRESH1 0x5064
- #define REG_SHARPENMT_THRESH2 0x5065
- #define REG_SHARPENMT_OFFSET1 0x5066
- #define REG_SHARPENMT_OFFSET2 0x5067
- #define REG_DENOISE_THRESH1 0x5068
- #define REG_DENOISE_THRESH2 0x5069
- #define REG_DENOISE_OFFSET1 0x506a
- #define REG_DENOISE_OFFSET2 0x506b
- #define REG_SHARPEN_THRESH1 0x506c
- #define REG_SHARPEN_THRESH2 0x506d
- #define REG_CIP_CTRL00 0x506e
- #define REG_CIP_CTRL01 0x506f
- #define REG_CMX_SIGN 0x5079
- #define REG_CMX_MISC_CTRL 0x507a
- #define REG_PRE_ISP_CTRL00 0x50a0
- #define TEST_PATTERN_ENABLE BIT(7)
- #define VERTICAL_COLOR_BAR_MASK 0x53
- #define REG_NULL 0x0000 /* Array end token */
- #define OV265X_ID(_msb, _lsb) ((_msb) << 8 | (_lsb))
- #define OV2659_ID 0x2656
- struct sensor_register {
- u16 addr;
- u8 value;
- };
- struct ov2659_framesize {
- u16 width;
- u16 height;
- u16 max_exp_lines;
- const struct sensor_register *regs;
- };
- struct ov2659_pll_ctrl {
- u8 ctrl1;
- u8 ctrl2;
- u8 ctrl3;
- };
- struct ov2659_pixfmt {
- u32 code;
- /* Output format Register Value (REG_FORMAT_CTRL00) */
- struct sensor_register *format_ctrl_regs;
- };
- struct pll_ctrl_reg {
- unsigned int div;
- unsigned char reg;
- };
- struct ov2659 {
- struct v4l2_subdev sd;
- struct media_pad pad;
- struct v4l2_mbus_framefmt format;
- unsigned int xvclk_frequency;
- const struct ov2659_platform_data *pdata;
- struct mutex lock;
- struct i2c_client *client;
- struct v4l2_ctrl_handler ctrls;
- struct v4l2_ctrl *link_frequency;
- struct clk *clk;
- const struct ov2659_framesize *frame_size;
- struct sensor_register *format_ctrl_regs;
- struct ov2659_pll_ctrl pll;
- int streaming;
- /* used to control the sensor PWDN pin */
- struct gpio_desc *pwdn_gpio;
- /* used to control the sensor RESETB pin */
- struct gpio_desc *resetb_gpio;
- };
- static const struct sensor_register ov2659_init_regs[] = {
- { REG_IO_CTRL00, 0x03 },
- { REG_IO_CTRL01, 0xff },
- { REG_IO_CTRL02, 0xe0 },
- { 0x3633, 0x3d },
- { 0x3620, 0x02 },
- { 0x3631, 0x11 },
- { 0x3612, 0x04 },
- { 0x3630, 0x20 },
- { 0x4702, 0x02 },
- { 0x370c, 0x34 },
- { REG_TIMING_HS_H, 0x00 },
- { REG_TIMING_HS_L, 0x00 },
- { REG_TIMING_VS_H, 0x00 },
- { REG_TIMING_VS_L, 0x00 },
- { REG_TIMING_HW_H, 0x06 },
- { REG_TIMING_HW_L, 0x5f },
- { REG_TIMING_VH_H, 0x04 },
- { REG_TIMING_VH_L, 0xb7 },
- { REG_TIMING_DVPHO_H, 0x03 },
- { REG_TIMING_DVPHO_L, 0x20 },
- { REG_TIMING_DVPVO_H, 0x02 },
- { REG_TIMING_DVPVO_L, 0x58 },
- { REG_TIMING_HTS_H, 0x05 },
- { REG_TIMING_HTS_L, 0x14 },
- { REG_TIMING_VTS_H, 0x02 },
- { REG_TIMING_VTS_L, 0x68 },
- { REG_TIMING_HOFFS_L, 0x08 },
- { REG_TIMING_VOFFS_L, 0x02 },
- { REG_TIMING_XINC, 0x31 },
- { REG_TIMING_YINC, 0x31 },
- { 0x3a02, 0x02 },
- { 0x3a03, 0x68 },
- { 0x3a08, 0x00 },
- { 0x3a09, 0x5c },
- { 0x3a0a, 0x00 },
- { 0x3a0b, 0x4d },
- { 0x3a0d, 0x08 },
- { 0x3a0e, 0x06 },
- { 0x3a14, 0x02 },
- { 0x3a15, 0x28 },
- { REG_DVP_CTRL02, 0x01 },
- { 0x3623, 0x00 },
- { 0x3634, 0x76 },
- { 0x3701, 0x44 },
- { 0x3702, 0x18 },
- { 0x3703, 0x24 },
- { 0x3704, 0x24 },
- { 0x3705, 0x0c },
- { REG_TIMING_VERT_FORMAT, 0x81 },
- { REG_TIMING_HORIZ_FORMAT, 0x01 },
- { 0x370a, 0x52 },
- { REG_VFIFO_READ_START_H, 0x00 },
- { REG_VFIFO_READ_START_L, 0x80 },
- { REG_FORMAT_CTRL00, 0x30 },
- { 0x5086, 0x02 },
- { REG_ISP_CTRL00, 0xfb },
- { REG_ISP_CTRL01, 0x1f },
- { REG_ISP_CTRL02, 0x00 },
- { 0x5025, 0x0e },
- { 0x5026, 0x18 },
- { 0x5027, 0x34 },
- { 0x5028, 0x4c },
- { 0x5029, 0x62 },
- { 0x502a, 0x74 },
- { 0x502b, 0x85 },
- { 0x502c, 0x92 },
- { 0x502d, 0x9e },
- { 0x502e, 0xb2 },
- { 0x502f, 0xc0 },
- { 0x5030, 0xcc },
- { 0x5031, 0xe0 },
- { 0x5032, 0xee },
- { 0x5033, 0xf6 },
- { 0x5034, 0x11 },
- { 0x5070, 0x1c },
- { 0x5071, 0x5b },
- { 0x5072, 0x05 },
- { 0x5073, 0x20 },
- { 0x5074, 0x94 },
- { 0x5075, 0xb4 },
- { 0x5076, 0xb4 },
- { 0x5077, 0xaf },
- { 0x5078, 0x05 },
- { REG_CMX_SIGN, 0x98 },
- { REG_CMX_MISC_CTRL, 0x21 },
- { REG_AWB_CTRL00, 0x6a },
- { REG_AWB_CTRL01, 0x11 },
- { REG_AWB_CTRL02, 0x92 },
- { REG_AWB_CTRL03, 0x21 },
- { REG_AWB_CTRL04, 0xe1 },
- { REG_AWB_LOCAL_LIMIT, 0x01 },
- { 0x503c, 0x05 },
- { 0x503d, 0x08 },
- { 0x503e, 0x08 },
- { 0x503f, 0x64 },
- { 0x5040, 0x58 },
- { 0x5041, 0x2a },
- { 0x5042, 0xc5 },
- { 0x5043, 0x2e },
- { 0x5044, 0x3a },
- { 0x5045, 0x3c },
- { 0x5046, 0x44 },
- { 0x5047, 0xf8 },
- { 0x5048, 0x08 },
- { REG_AWB_CTRL12, 0x70 },
- { REG_AWB_CTRL13, 0xf0 },
- { REG_AWB_CTRL14, 0xf0 },
- { REG_LENC_RED_X0_H, 0x03 },
- { REG_LENC_RED_X0_L, 0x20 },
- { REG_LENC_RED_Y0_H, 0x02 },
- { REG_LENC_RED_Y0_L, 0x5c },
- { REG_LENC_RED_A1, 0x48 },
- { REG_LENC_RED_B1, 0x00 },
- { REG_LENC_RED_A2_B2, 0x66 },
- { REG_LENC_GREEN_X0_H, 0x03 },
- { REG_LENC_GREEN_X0_L, 0x30 },
- { REG_LENC_GREEN_Y0_H, 0x02 },
- { REG_LENC_GREEN_Y0_L, 0x7c },
- { REG_LENC_GREEN_A1, 0x40 },
- { REG_LENC_GREEN_B1, 0x00 },
- { REG_LENC_GREEN_A2_B2, 0x66 },
- { REG_LENC_BLUE_X0_H, 0x03 },
- { REG_LENC_BLUE_X0_L, 0x10 },
- { REG_LENC_BLUE_Y0_H, 0x02 },
- { REG_LENC_BLUE_Y0_L, 0x7c },
- { REG_LENC_BLUE_A1, 0x3a },
- { REG_LENC_BLUE_B1, 0x00 },
- { REG_LENC_BLUE_A2_B2, 0x66 },
- { REG_CIP_CTRL00, 0x44 },
- { REG_SHARPENMT_THRESH1, 0x08 },
- { REG_SHARPENMT_THRESH2, 0x10 },
- { REG_SHARPENMT_OFFSET1, 0x12 },
- { REG_SHARPENMT_OFFSET2, 0x02 },
- { REG_SHARPEN_THRESH1, 0x08 },
- { REG_SHARPEN_THRESH2, 0x10 },
- { REG_CIP_CTRL01, 0xa6 },
- { REG_DENOISE_THRESH1, 0x08 },
- { REG_DENOISE_THRESH2, 0x10 },
- { REG_DENOISE_OFFSET1, 0x04 },
- { REG_DENOISE_OFFSET2, 0x12 },
- { 0x507e, 0x40 },
- { 0x507f, 0x20 },
- { 0x507b, 0x02 },
- { REG_CMX_MISC_CTRL, 0x01 },
- { 0x5084, 0x0c },
- { 0x5085, 0x3e },
- { 0x5005, 0x80 },
- { 0x3a0f, 0x30 },
- { 0x3a10, 0x28 },
- { 0x3a1b, 0x32 },
- { 0x3a1e, 0x26 },
- { 0x3a11, 0x60 },
- { 0x3a1f, 0x14 },
- { 0x5060, 0x69 },
- { 0x5061, 0x7d },
- { 0x5062, 0x7d },
- { 0x5063, 0x69 },
- { REG_NULL, 0x00 },
- };
- /* 1280X720 720p */
- static struct sensor_register ov2659_720p[] = {
- { REG_TIMING_HS_H, 0x00 },
- { REG_TIMING_HS_L, 0xa0 },
- { REG_TIMING_VS_H, 0x00 },
- { REG_TIMING_VS_L, 0xf0 },
- { REG_TIMING_HW_H, 0x05 },
- { REG_TIMING_HW_L, 0xbf },
- { REG_TIMING_VH_H, 0x03 },
- { REG_TIMING_VH_L, 0xcb },
- { REG_TIMING_DVPHO_H, 0x05 },
- { REG_TIMING_DVPHO_L, 0x00 },
- { REG_TIMING_DVPVO_H, 0x02 },
- { REG_TIMING_DVPVO_L, 0xd0 },
- { REG_TIMING_HTS_H, 0x06 },
- { REG_TIMING_HTS_L, 0x4c },
- { REG_TIMING_VTS_H, 0x02 },
- { REG_TIMING_VTS_L, 0xe8 },
- { REG_TIMING_HOFFS_L, 0x10 },
- { REG_TIMING_VOFFS_L, 0x06 },
- { REG_TIMING_XINC, 0x11 },
- { REG_TIMING_YINC, 0x11 },
- { REG_TIMING_VERT_FORMAT, 0x80 },
- { REG_TIMING_HORIZ_FORMAT, 0x00 },
- { 0x370a, 0x12 },
- { 0x3a03, 0xe8 },
- { 0x3a09, 0x6f },
- { 0x3a0b, 0x5d },
- { 0x3a15, 0x9a },
- { REG_VFIFO_READ_START_H, 0x00 },
- { REG_VFIFO_READ_START_L, 0x80 },
- { REG_ISP_CTRL02, 0x00 },
- { REG_NULL, 0x00 },
- };
- /* 1600X1200 UXGA */
- static struct sensor_register ov2659_uxga[] = {
- { REG_TIMING_HS_H, 0x00 },
- { REG_TIMING_HS_L, 0x00 },
- { REG_TIMING_VS_H, 0x00 },
- { REG_TIMING_VS_L, 0x00 },
- { REG_TIMING_HW_H, 0x06 },
- { REG_TIMING_HW_L, 0x5f },
- { REG_TIMING_VH_H, 0x04 },
- { REG_TIMING_VH_L, 0xbb },
- { REG_TIMING_DVPHO_H, 0x06 },
- { REG_TIMING_DVPHO_L, 0x40 },
- { REG_TIMING_DVPVO_H, 0x04 },
- { REG_TIMING_DVPVO_L, 0xb0 },
- { REG_TIMING_HTS_H, 0x07 },
- { REG_TIMING_HTS_L, 0x9f },
- { REG_TIMING_VTS_H, 0x04 },
- { REG_TIMING_VTS_L, 0xd0 },
- { REG_TIMING_HOFFS_L, 0x10 },
- { REG_TIMING_VOFFS_L, 0x06 },
- { REG_TIMING_XINC, 0x11 },
- { REG_TIMING_YINC, 0x11 },
- { 0x3a02, 0x04 },
- { 0x3a03, 0xd0 },
- { 0x3a08, 0x00 },
- { 0x3a09, 0xb8 },
- { 0x3a0a, 0x00 },
- { 0x3a0b, 0x9a },
- { 0x3a0d, 0x08 },
- { 0x3a0e, 0x06 },
- { 0x3a14, 0x04 },
- { 0x3a15, 0x50 },
- { 0x3623, 0x00 },
- { 0x3634, 0x44 },
- { 0x3701, 0x44 },
- { 0x3702, 0x30 },
- { 0x3703, 0x48 },
- { 0x3704, 0x48 },
- { 0x3705, 0x18 },
- { REG_TIMING_VERT_FORMAT, 0x80 },
- { REG_TIMING_HORIZ_FORMAT, 0x00 },
- { 0x370a, 0x12 },
- { REG_VFIFO_READ_START_H, 0x00 },
- { REG_VFIFO_READ_START_L, 0x80 },
- { REG_ISP_CTRL02, 0x00 },
- { REG_NULL, 0x00 },
- };
- /* 1280X1024 SXGA */
- static struct sensor_register ov2659_sxga[] = {
- { REG_TIMING_HS_H, 0x00 },
- { REG_TIMING_HS_L, 0x00 },
- { REG_TIMING_VS_H, 0x00 },
- { REG_TIMING_VS_L, 0x00 },
- { REG_TIMING_HW_H, 0x06 },
- { REG_TIMING_HW_L, 0x5f },
- { REG_TIMING_VH_H, 0x04 },
- { REG_TIMING_VH_L, 0xb7 },
- { REG_TIMING_DVPHO_H, 0x05 },
- { REG_TIMING_DVPHO_L, 0x00 },
- { REG_TIMING_DVPVO_H, 0x04 },
- { REG_TIMING_DVPVO_L, 0x00 },
- { REG_TIMING_HTS_H, 0x07 },
- { REG_TIMING_HTS_L, 0x9c },
- { REG_TIMING_VTS_H, 0x04 },
- { REG_TIMING_VTS_L, 0xd0 },
- { REG_TIMING_HOFFS_L, 0x10 },
- { REG_TIMING_VOFFS_L, 0x06 },
- { REG_TIMING_XINC, 0x11 },
- { REG_TIMING_YINC, 0x11 },
- { 0x3a02, 0x02 },
- { 0x3a03, 0x68 },
- { 0x3a08, 0x00 },
- { 0x3a09, 0x5c },
- { 0x3a0a, 0x00 },
- { 0x3a0b, 0x4d },
- { 0x3a0d, 0x08 },
- { 0x3a0e, 0x06 },
- { 0x3a14, 0x02 },
- { 0x3a15, 0x28 },
- { 0x3623, 0x00 },
- { 0x3634, 0x76 },
- { 0x3701, 0x44 },
- { 0x3702, 0x18 },
- { 0x3703, 0x24 },
- { 0x3704, 0x24 },
- { 0x3705, 0x0c },
- { REG_TIMING_VERT_FORMAT, 0x80 },
- { REG_TIMING_HORIZ_FORMAT, 0x00 },
- { 0x370a, 0x52 },
- { REG_VFIFO_READ_START_H, 0x00 },
- { REG_VFIFO_READ_START_L, 0x80 },
- { REG_ISP_CTRL02, 0x00 },
- { REG_NULL, 0x00 },
- };
- /* 1024X768 SXGA */
- static struct sensor_register ov2659_xga[] = {
- { REG_TIMING_HS_H, 0x00 },
- { REG_TIMING_HS_L, 0x00 },
- { REG_TIMING_VS_H, 0x00 },
- { REG_TIMING_VS_L, 0x00 },
- { REG_TIMING_HW_H, 0x06 },
- { REG_TIMING_HW_L, 0x5f },
- { REG_TIMING_VH_H, 0x04 },
- { REG_TIMING_VH_L, 0xb7 },
- { REG_TIMING_DVPHO_H, 0x04 },
- { REG_TIMING_DVPHO_L, 0x00 },
- { REG_TIMING_DVPVO_H, 0x03 },
- { REG_TIMING_DVPVO_L, 0x00 },
- { REG_TIMING_HTS_H, 0x07 },
- { REG_TIMING_HTS_L, 0x9c },
- { REG_TIMING_VTS_H, 0x04 },
- { REG_TIMING_VTS_L, 0xd0 },
- { REG_TIMING_HOFFS_L, 0x10 },
- { REG_TIMING_VOFFS_L, 0x06 },
- { REG_TIMING_XINC, 0x11 },
- { REG_TIMING_YINC, 0x11 },
- { 0x3a02, 0x02 },
- { 0x3a03, 0x68 },
- { 0x3a08, 0x00 },
- { 0x3a09, 0x5c },
- { 0x3a0a, 0x00 },
- { 0x3a0b, 0x4d },
- { 0x3a0d, 0x08 },
- { 0x3a0e, 0x06 },
- { 0x3a14, 0x02 },
- { 0x3a15, 0x28 },
- { 0x3623, 0x00 },
- { 0x3634, 0x76 },
- { 0x3701, 0x44 },
- { 0x3702, 0x18 },
- { 0x3703, 0x24 },
- { 0x3704, 0x24 },
- { 0x3705, 0x0c },
- { REG_TIMING_VERT_FORMAT, 0x80 },
- { REG_TIMING_HORIZ_FORMAT, 0x00 },
- { 0x370a, 0x52 },
- { REG_VFIFO_READ_START_H, 0x00 },
- { REG_VFIFO_READ_START_L, 0x80 },
- { REG_ISP_CTRL02, 0x00 },
- { REG_NULL, 0x00 },
- };
- /* 800X600 SVGA */
- static struct sensor_register ov2659_svga[] = {
- { REG_TIMING_HS_H, 0x00 },
- { REG_TIMING_HS_L, 0x00 },
- { REG_TIMING_VS_H, 0x00 },
- { REG_TIMING_VS_L, 0x00 },
- { REG_TIMING_HW_H, 0x06 },
- { REG_TIMING_HW_L, 0x5f },
- { REG_TIMING_VH_H, 0x04 },
- { REG_TIMING_VH_L, 0xb7 },
- { REG_TIMING_DVPHO_H, 0x03 },
- { REG_TIMING_DVPHO_L, 0x20 },
- { REG_TIMING_DVPVO_H, 0x02 },
- { REG_TIMING_DVPVO_L, 0x58 },
- { REG_TIMING_HTS_H, 0x05 },
- { REG_TIMING_HTS_L, 0x14 },
- { REG_TIMING_VTS_H, 0x02 },
- { REG_TIMING_VTS_L, 0x68 },
- { REG_TIMING_HOFFS_L, 0x08 },
- { REG_TIMING_VOFFS_L, 0x02 },
- { REG_TIMING_XINC, 0x31 },
- { REG_TIMING_YINC, 0x31 },
- { 0x3a02, 0x02 },
- { 0x3a03, 0x68 },
- { 0x3a08, 0x00 },
- { 0x3a09, 0x5c },
- { 0x3a0a, 0x00 },
- { 0x3a0b, 0x4d },
- { 0x3a0d, 0x08 },
- { 0x3a0e, 0x06 },
- { 0x3a14, 0x02 },
- { 0x3a15, 0x28 },
- { 0x3623, 0x00 },
- { 0x3634, 0x76 },
- { 0x3701, 0x44 },
- { 0x3702, 0x18 },
- { 0x3703, 0x24 },
- { 0x3704, 0x24 },
- { 0x3705, 0x0c },
- { REG_TIMING_VERT_FORMAT, 0x81 },
- { REG_TIMING_HORIZ_FORMAT, 0x01 },
- { 0x370a, 0x52 },
- { REG_VFIFO_READ_START_H, 0x00 },
- { REG_VFIFO_READ_START_L, 0x80 },
- { REG_ISP_CTRL02, 0x00 },
- { REG_NULL, 0x00 },
- };
- /* 640X480 VGA */
- static struct sensor_register ov2659_vga[] = {
- { REG_TIMING_HS_H, 0x00 },
- { REG_TIMING_HS_L, 0x00 },
- { REG_TIMING_VS_H, 0x00 },
- { REG_TIMING_VS_L, 0x00 },
- { REG_TIMING_HW_H, 0x06 },
- { REG_TIMING_HW_L, 0x5f },
- { REG_TIMING_VH_H, 0x04 },
- { REG_TIMING_VH_L, 0xb7 },
- { REG_TIMING_DVPHO_H, 0x02 },
- { REG_TIMING_DVPHO_L, 0x80 },
- { REG_TIMING_DVPVO_H, 0x01 },
- { REG_TIMING_DVPVO_L, 0xe0 },
- { REG_TIMING_HTS_H, 0x05 },
- { REG_TIMING_HTS_L, 0x14 },
- { REG_TIMING_VTS_H, 0x02 },
- { REG_TIMING_VTS_L, 0x68 },
- { REG_TIMING_HOFFS_L, 0x08 },
- { REG_TIMING_VOFFS_L, 0x02 },
- { REG_TIMING_XINC, 0x31 },
- { REG_TIMING_YINC, 0x31 },
- { 0x3a02, 0x02 },
- { 0x3a03, 0x68 },
- { 0x3a08, 0x00 },
- { 0x3a09, 0x5c },
- { 0x3a0a, 0x00 },
- { 0x3a0b, 0x4d },
- { 0x3a0d, 0x08 },
- { 0x3a0e, 0x06 },
- { 0x3a14, 0x02 },
- { 0x3a15, 0x28 },
- { 0x3623, 0x00 },
- { 0x3634, 0x76 },
- { 0x3701, 0x44 },
- { 0x3702, 0x18 },
- { 0x3703, 0x24 },
- { 0x3704, 0x24 },
- { 0x3705, 0x0c },
- { REG_TIMING_VERT_FORMAT, 0x81 },
- { REG_TIMING_HORIZ_FORMAT, 0x01 },
- { 0x370a, 0x52 },
- { REG_VFIFO_READ_START_H, 0x00 },
- { REG_VFIFO_READ_START_L, 0xa0 },
- { REG_ISP_CTRL02, 0x10 },
- { REG_NULL, 0x00 },
- };
- /* 320X240 QVGA */
- static struct sensor_register ov2659_qvga[] = {
- { REG_TIMING_HS_H, 0x00 },
- { REG_TIMING_HS_L, 0x00 },
- { REG_TIMING_VS_H, 0x00 },
- { REG_TIMING_VS_L, 0x00 },
- { REG_TIMING_HW_H, 0x06 },
- { REG_TIMING_HW_L, 0x5f },
- { REG_TIMING_VH_H, 0x04 },
- { REG_TIMING_VH_L, 0xb7 },
- { REG_TIMING_DVPHO_H, 0x01 },
- { REG_TIMING_DVPHO_L, 0x40 },
- { REG_TIMING_DVPVO_H, 0x00 },
- { REG_TIMING_DVPVO_L, 0xf0 },
- { REG_TIMING_HTS_H, 0x05 },
- { REG_TIMING_HTS_L, 0x14 },
- { REG_TIMING_VTS_H, 0x02 },
- { REG_TIMING_VTS_L, 0x68 },
- { REG_TIMING_HOFFS_L, 0x08 },
- { REG_TIMING_VOFFS_L, 0x02 },
- { REG_TIMING_XINC, 0x31 },
- { REG_TIMING_YINC, 0x31 },
- { 0x3a02, 0x02 },
- { 0x3a03, 0x68 },
- { 0x3a08, 0x00 },
- { 0x3a09, 0x5c },
- { 0x3a0a, 0x00 },
- { 0x3a0b, 0x4d },
- { 0x3a0d, 0x08 },
- { 0x3a0e, 0x06 },
- { 0x3a14, 0x02 },
- { 0x3a15, 0x28 },
- { 0x3623, 0x00 },
- { 0x3634, 0x76 },
- { 0x3701, 0x44 },
- { 0x3702, 0x18 },
- { 0x3703, 0x24 },
- { 0x3704, 0x24 },
- { 0x3705, 0x0c },
- { REG_TIMING_VERT_FORMAT, 0x81 },
- { REG_TIMING_HORIZ_FORMAT, 0x01 },
- { 0x370a, 0x52 },
- { REG_VFIFO_READ_START_H, 0x00 },
- { REG_VFIFO_READ_START_L, 0xa0 },
- { REG_ISP_CTRL02, 0x10 },
- { REG_NULL, 0x00 },
- };
- static const struct pll_ctrl_reg ctrl3[] = {
- { 1, 0x00 },
- { 2, 0x02 },
- { 3, 0x03 },
- { 4, 0x06 },
- { 6, 0x0d },
- { 8, 0x0e },
- { 12, 0x0f },
- { 16, 0x12 },
- { 24, 0x13 },
- { 32, 0x16 },
- { 48, 0x1b },
- { 64, 0x1e },
- { 96, 0x1f },
- { 0, 0x00 },
- };
- static const struct pll_ctrl_reg ctrl1[] = {
- { 2, 0x10 },
- { 4, 0x20 },
- { 6, 0x30 },
- { 8, 0x40 },
- { 10, 0x50 },
- { 12, 0x60 },
- { 14, 0x70 },
- { 16, 0x80 },
- { 18, 0x90 },
- { 20, 0xa0 },
- { 22, 0xb0 },
- { 24, 0xc0 },
- { 26, 0xd0 },
- { 28, 0xe0 },
- { 30, 0xf0 },
- { 0, 0x00 },
- };
- static const struct ov2659_framesize ov2659_framesizes[] = {
- { /* QVGA */
- .width = 320,
- .height = 240,
- .regs = ov2659_qvga,
- .max_exp_lines = 248,
- }, { /* VGA */
- .width = 640,
- .height = 480,
- .regs = ov2659_vga,
- .max_exp_lines = 498,
- }, { /* SVGA */
- .width = 800,
- .height = 600,
- .regs = ov2659_svga,
- .max_exp_lines = 498,
- }, { /* XGA */
- .width = 1024,
- .height = 768,
- .regs = ov2659_xga,
- .max_exp_lines = 498,
- }, { /* 720P */
- .width = 1280,
- .height = 720,
- .regs = ov2659_720p,
- .max_exp_lines = 498,
- }, { /* SXGA */
- .width = 1280,
- .height = 1024,
- .regs = ov2659_sxga,
- .max_exp_lines = 1048,
- }, { /* UXGA */
- .width = 1600,
- .height = 1200,
- .regs = ov2659_uxga,
- .max_exp_lines = 498,
- },
- };
- /* YUV422 YUYV*/
- static struct sensor_register ov2659_format_yuyv[] = {
- { REG_FORMAT_CTRL00, 0x30 },
- { REG_NULL, 0x0 },
- };
- /* YUV422 UYVY */
- static struct sensor_register ov2659_format_uyvy[] = {
- { REG_FORMAT_CTRL00, 0x32 },
- { REG_NULL, 0x0 },
- };
- /* Raw Bayer BGGR */
- static struct sensor_register ov2659_format_bggr[] = {
- { REG_FORMAT_CTRL00, 0x00 },
- { REG_NULL, 0x0 },
- };
- /* RGB565 */
- static struct sensor_register ov2659_format_rgb565[] = {
- { REG_FORMAT_CTRL00, 0x60 },
- { REG_NULL, 0x0 },
- };
- static const struct ov2659_pixfmt ov2659_formats[] = {
- {
- .code = MEDIA_BUS_FMT_YUYV8_2X8,
- .format_ctrl_regs = ov2659_format_yuyv,
- }, {
- .code = MEDIA_BUS_FMT_UYVY8_2X8,
- .format_ctrl_regs = ov2659_format_uyvy,
- }, {
- .code = MEDIA_BUS_FMT_RGB565_2X8_BE,
- .format_ctrl_regs = ov2659_format_rgb565,
- }, {
- .code = MEDIA_BUS_FMT_SBGGR8_1X8,
- .format_ctrl_regs = ov2659_format_bggr,
- },
- };
- static inline struct ov2659 *to_ov2659(struct v4l2_subdev *sd)
- {
- return container_of(sd, struct ov2659, sd);
- }
- /* sensor register write */
- static int ov2659_write(struct i2c_client *client, u16 reg, u8 val)
- {
- struct i2c_msg msg;
- u8 buf[3];
- int ret;
- buf[0] = reg >> 8;
- buf[1] = reg & 0xFF;
- buf[2] = val;
- msg.addr = client->addr;
- msg.flags = client->flags;
- msg.buf = buf;
- msg.len = sizeof(buf);
- ret = i2c_transfer(client->adapter, &msg, 1);
- if (ret >= 0)
- return 0;
- dev_dbg(&client->dev,
- "ov2659 write reg(0x%x val:0x%x) failed !\n", reg, val);
- return ret;
- }
- /* sensor register read */
- static int ov2659_read(struct i2c_client *client, u16 reg, u8 *val)
- {
- struct i2c_msg msg[2];
- u8 buf[2];
- int ret;
- buf[0] = reg >> 8;
- buf[1] = reg & 0xFF;
- msg[0].addr = client->addr;
- msg[0].flags = client->flags;
- msg[0].buf = buf;
- msg[0].len = sizeof(buf);
- msg[1].addr = client->addr;
- msg[1].flags = client->flags | I2C_M_RD;
- msg[1].buf = buf;
- msg[1].len = 1;
- ret = i2c_transfer(client->adapter, msg, 2);
- if (ret >= 0) {
- *val = buf[0];
- return 0;
- }
- dev_dbg(&client->dev,
- "ov2659 read reg(0x%x val:0x%x) failed !\n", reg, *val);
- return ret;
- }
- static int ov2659_write_array(struct i2c_client *client,
- const struct sensor_register *regs)
- {
- int i, ret = 0;
- for (i = 0; ret == 0 && regs[i].addr; i++)
- ret = ov2659_write(client, regs[i].addr, regs[i].value);
- return ret;
- }
- static void ov2659_pll_calc_params(struct ov2659 *ov2659)
- {
- const struct ov2659_platform_data *pdata = ov2659->pdata;
- u8 ctrl1_reg = 0, ctrl2_reg = 0, ctrl3_reg = 0;
- struct i2c_client *client = ov2659->client;
- unsigned int desired = pdata->link_frequency;
- u32 prediv, postdiv, mult;
- u32 bestdelta = -1;
- u32 delta, actual;
- int i, j;
- for (i = 0; ctrl1[i].div != 0; i++) {
- postdiv = ctrl1[i].div;
- for (j = 0; ctrl3[j].div != 0; j++) {
- prediv = ctrl3[j].div;
- for (mult = 1; mult <= 63; mult++) {
- actual = ov2659->xvclk_frequency;
- actual *= mult;
- actual /= prediv;
- actual /= postdiv;
- delta = actual - desired;
- delta = abs(delta);
- if ((delta < bestdelta) || (bestdelta == -1)) {
- bestdelta = delta;
- ctrl1_reg = ctrl1[i].reg;
- ctrl2_reg = mult;
- ctrl3_reg = ctrl3[j].reg;
- }
- }
- }
- }
- ov2659->pll.ctrl1 = ctrl1_reg;
- ov2659->pll.ctrl2 = ctrl2_reg;
- ov2659->pll.ctrl3 = ctrl3_reg;
- dev_dbg(&client->dev,
- "Actual reg config: ctrl1_reg: %02x ctrl2_reg: %02x ctrl3_reg: %02x\n",
- ctrl1_reg, ctrl2_reg, ctrl3_reg);
- }
- static int ov2659_set_pixel_clock(struct ov2659 *ov2659)
- {
- struct i2c_client *client = ov2659->client;
- struct sensor_register pll_regs[] = {
- {REG_SC_PLL_CTRL1, ov2659->pll.ctrl1},
- {REG_SC_PLL_CTRL2, ov2659->pll.ctrl2},
- {REG_SC_PLL_CTRL3, ov2659->pll.ctrl3},
- {REG_NULL, 0x00},
- };
- dev_dbg(&client->dev, "%s\n", __func__);
- return ov2659_write_array(client, pll_regs);
- };
- static void ov2659_get_default_format(struct v4l2_mbus_framefmt *format)
- {
- format->width = ov2659_framesizes[2].width;
- format->height = ov2659_framesizes[2].height;
- format->colorspace = V4L2_COLORSPACE_SRGB;
- format->code = ov2659_formats[0].code;
- format->field = V4L2_FIELD_NONE;
- }
- static void ov2659_set_streaming(struct ov2659 *ov2659, int on)
- {
- struct i2c_client *client = ov2659->client;
- int ret;
- on = !!on;
- dev_dbg(&client->dev, "%s: on: %d\n", __func__, on);
- ret = ov2659_write(client, REG_SOFTWARE_STANDBY, on);
- if (ret)
- dev_err(&client->dev, "ov2659 soft standby failed\n");
- }
- static int ov2659_init(struct v4l2_subdev *sd, u32 val)
- {
- struct i2c_client *client = v4l2_get_subdevdata(sd);
- return ov2659_write_array(client, ov2659_init_regs);
- }
- /*
- * V4L2 subdev video and pad level operations
- */
- static int ov2659_enum_mbus_code(struct v4l2_subdev *sd,
- struct v4l2_subdev_state *sd_state,
- struct v4l2_subdev_mbus_code_enum *code)
- {
- struct i2c_client *client = v4l2_get_subdevdata(sd);
- dev_dbg(&client->dev, "%s:\n", __func__);
- if (code->index >= ARRAY_SIZE(ov2659_formats))
- return -EINVAL;
- code->code = ov2659_formats[code->index].code;
- return 0;
- }
- static int ov2659_enum_frame_sizes(struct v4l2_subdev *sd,
- struct v4l2_subdev_state *sd_state,
- struct v4l2_subdev_frame_size_enum *fse)
- {
- struct i2c_client *client = v4l2_get_subdevdata(sd);
- int i = ARRAY_SIZE(ov2659_formats);
- dev_dbg(&client->dev, "%s:\n", __func__);
- if (fse->index >= ARRAY_SIZE(ov2659_framesizes))
- return -EINVAL;
- while (--i)
- if (fse->code == ov2659_formats[i].code)
- break;
- fse->code = ov2659_formats[i].code;
- fse->min_width = ov2659_framesizes[fse->index].width;
- fse->max_width = fse->min_width;
- fse->max_height = ov2659_framesizes[fse->index].height;
- fse->min_height = fse->max_height;
- return 0;
- }
- static int ov2659_get_fmt(struct v4l2_subdev *sd,
- struct v4l2_subdev_state *sd_state,
- struct v4l2_subdev_format *fmt)
- {
- struct i2c_client *client = v4l2_get_subdevdata(sd);
- struct ov2659 *ov2659 = to_ov2659(sd);
- dev_dbg(&client->dev, "ov2659_get_fmt\n");
- if (fmt->which == V4L2_SUBDEV_FORMAT_TRY) {
- #ifdef CONFIG_VIDEO_V4L2_SUBDEV_API
- struct v4l2_mbus_framefmt *mf;
- mf = v4l2_subdev_get_try_format(sd, sd_state, 0);
- mutex_lock(&ov2659->lock);
- fmt->format = *mf;
- mutex_unlock(&ov2659->lock);
- return 0;
- #else
- return -EINVAL;
- #endif
- }
- mutex_lock(&ov2659->lock);
- fmt->format = ov2659->format;
- mutex_unlock(&ov2659->lock);
- dev_dbg(&client->dev, "ov2659_get_fmt: %x %dx%d\n",
- ov2659->format.code, ov2659->format.width,
- ov2659->format.height);
- return 0;
- }
- static void __ov2659_try_frame_size(struct v4l2_mbus_framefmt *mf,
- const struct ov2659_framesize **size)
- {
- const struct ov2659_framesize *fsize = &ov2659_framesizes[0];
- const struct ov2659_framesize *match = NULL;
- int i = ARRAY_SIZE(ov2659_framesizes);
- unsigned int min_err = UINT_MAX;
- while (i--) {
- int err = abs(fsize->width - mf->width)
- + abs(fsize->height - mf->height);
- if ((err < min_err) && (fsize->regs[0].addr)) {
- min_err = err;
- match = fsize;
- }
- fsize++;
- }
- if (!match)
- match = &ov2659_framesizes[2];
- mf->width = match->width;
- mf->height = match->height;
- if (size)
- *size = match;
- }
- static int ov2659_set_fmt(struct v4l2_subdev *sd,
- struct v4l2_subdev_state *sd_state,
- struct v4l2_subdev_format *fmt)
- {
- struct i2c_client *client = v4l2_get_subdevdata(sd);
- int index = ARRAY_SIZE(ov2659_formats);
- struct v4l2_mbus_framefmt *mf = &fmt->format;
- const struct ov2659_framesize *size = NULL;
- struct ov2659 *ov2659 = to_ov2659(sd);
- int ret = 0;
- dev_dbg(&client->dev, "ov2659_set_fmt\n");
- __ov2659_try_frame_size(mf, &size);
- while (--index >= 0)
- if (ov2659_formats[index].code == mf->code)
- break;
- if (index < 0) {
- index = 0;
- mf->code = ov2659_formats[index].code;
- }
- mf->colorspace = V4L2_COLORSPACE_SRGB;
- mf->field = V4L2_FIELD_NONE;
- mutex_lock(&ov2659->lock);
- if (fmt->which == V4L2_SUBDEV_FORMAT_TRY) {
- #ifdef CONFIG_VIDEO_V4L2_SUBDEV_API
- mf = v4l2_subdev_get_try_format(sd, sd_state, fmt->pad);
- *mf = fmt->format;
- #endif
- } else {
- s64 val;
- if (ov2659->streaming) {
- mutex_unlock(&ov2659->lock);
- return -EBUSY;
- }
- ov2659->frame_size = size;
- ov2659->format = fmt->format;
- ov2659->format_ctrl_regs =
- ov2659_formats[index].format_ctrl_regs;
- if (ov2659->format.code != MEDIA_BUS_FMT_SBGGR8_1X8)
- val = ov2659->pdata->link_frequency / 2;
- else
- val = ov2659->pdata->link_frequency;
- ret = v4l2_ctrl_s_ctrl_int64(ov2659->link_frequency, val);
- if (ret < 0)
- dev_warn(&client->dev,
- "failed to set link_frequency rate (%d)\n",
- ret);
- }
- mutex_unlock(&ov2659->lock);
- return ret;
- }
- static int ov2659_set_frame_size(struct ov2659 *ov2659)
- {
- struct i2c_client *client = ov2659->client;
- dev_dbg(&client->dev, "%s\n", __func__);
- return ov2659_write_array(ov2659->client, ov2659->frame_size->regs);
- }
- static int ov2659_set_format(struct ov2659 *ov2659)
- {
- struct i2c_client *client = ov2659->client;
- dev_dbg(&client->dev, "%s\n", __func__);
- return ov2659_write_array(ov2659->client, ov2659->format_ctrl_regs);
- }
- static int ov2659_s_stream(struct v4l2_subdev *sd, int on)
- {
- struct i2c_client *client = v4l2_get_subdevdata(sd);
- struct ov2659 *ov2659 = to_ov2659(sd);
- int ret = 0;
- dev_dbg(&client->dev, "%s: on: %d\n", __func__, on);
- mutex_lock(&ov2659->lock);
- on = !!on;
- if (ov2659->streaming == on)
- goto unlock;
- if (!on) {
- /* Stop Streaming Sequence */
- ov2659_set_streaming(ov2659, 0);
- ov2659->streaming = on;
- pm_runtime_put(&client->dev);
- goto unlock;
- }
- ret = pm_runtime_resume_and_get(&client->dev);
- if (ret < 0)
- goto unlock;
- ret = ov2659_init(sd, 0);
- if (!ret)
- ret = ov2659_set_pixel_clock(ov2659);
- if (!ret)
- ret = ov2659_set_frame_size(ov2659);
- if (!ret)
- ret = ov2659_set_format(ov2659);
- if (!ret) {
- ov2659_set_streaming(ov2659, 1);
- ov2659->streaming = on;
- }
- unlock:
- mutex_unlock(&ov2659->lock);
- return ret;
- }
- static int ov2659_set_test_pattern(struct ov2659 *ov2659, int value)
- {
- struct i2c_client *client = v4l2_get_subdevdata(&ov2659->sd);
- int ret;
- u8 val;
- ret = ov2659_read(client, REG_PRE_ISP_CTRL00, &val);
- if (ret < 0)
- return ret;
- switch (value) {
- case 0:
- val &= ~TEST_PATTERN_ENABLE;
- break;
- case 1:
- val &= VERTICAL_COLOR_BAR_MASK;
- val |= TEST_PATTERN_ENABLE;
- break;
- }
- return ov2659_write(client, REG_PRE_ISP_CTRL00, val);
- }
- static int ov2659_s_ctrl(struct v4l2_ctrl *ctrl)
- {
- struct ov2659 *ov2659 =
- container_of(ctrl->handler, struct ov2659, ctrls);
- struct i2c_client *client = ov2659->client;
- /* V4L2 controls values will be applied only when power is already up */
- if (!pm_runtime_get_if_in_use(&client->dev))
- return 0;
- switch (ctrl->id) {
- case V4L2_CID_TEST_PATTERN:
- return ov2659_set_test_pattern(ov2659, ctrl->val);
- }
- pm_runtime_put(&client->dev);
- return 0;
- }
- static const struct v4l2_ctrl_ops ov2659_ctrl_ops = {
- .s_ctrl = ov2659_s_ctrl,
- };
- static const char * const ov2659_test_pattern_menu[] = {
- "Disabled",
- "Vertical Color Bars",
- };
- static int ov2659_power_off(struct device *dev)
- {
- struct i2c_client *client = to_i2c_client(dev);
- struct v4l2_subdev *sd = i2c_get_clientdata(client);
- struct ov2659 *ov2659 = to_ov2659(sd);
- dev_dbg(&client->dev, "%s:\n", __func__);
- gpiod_set_value(ov2659->pwdn_gpio, 1);
- clk_disable_unprepare(ov2659->clk);
- return 0;
- }
- static int ov2659_power_on(struct device *dev)
- {
- struct i2c_client *client = to_i2c_client(dev);
- struct v4l2_subdev *sd = i2c_get_clientdata(client);
- struct ov2659 *ov2659 = to_ov2659(sd);
- int ret;
- dev_dbg(&client->dev, "%s:\n", __func__);
- ret = clk_prepare_enable(ov2659->clk);
- if (ret) {
- dev_err(&client->dev, "%s: failed to enable clock\n",
- __func__);
- return ret;
- }
- gpiod_set_value(ov2659->pwdn_gpio, 0);
- if (ov2659->resetb_gpio) {
- gpiod_set_value(ov2659->resetb_gpio, 1);
- usleep_range(500, 1000);
- gpiod_set_value(ov2659->resetb_gpio, 0);
- usleep_range(3000, 5000);
- }
- return 0;
- }
- /* -----------------------------------------------------------------------------
- * V4L2 subdev internal operations
- */
- #ifdef CONFIG_VIDEO_V4L2_SUBDEV_API
- static int ov2659_open(struct v4l2_subdev *sd, struct v4l2_subdev_fh *fh)
- {
- struct i2c_client *client = v4l2_get_subdevdata(sd);
- struct v4l2_mbus_framefmt *format =
- v4l2_subdev_get_try_format(sd, fh->state, 0);
- dev_dbg(&client->dev, "%s:\n", __func__);
- ov2659_get_default_format(format);
- return 0;
- }
- #endif
- static const struct v4l2_subdev_core_ops ov2659_subdev_core_ops = {
- .log_status = v4l2_ctrl_subdev_log_status,
- .subscribe_event = v4l2_ctrl_subdev_subscribe_event,
- .unsubscribe_event = v4l2_event_subdev_unsubscribe,
- };
- static const struct v4l2_subdev_video_ops ov2659_subdev_video_ops = {
- .s_stream = ov2659_s_stream,
- };
- static const struct v4l2_subdev_pad_ops ov2659_subdev_pad_ops = {
- .enum_mbus_code = ov2659_enum_mbus_code,
- .enum_frame_size = ov2659_enum_frame_sizes,
- .get_fmt = ov2659_get_fmt,
- .set_fmt = ov2659_set_fmt,
- };
- #ifdef CONFIG_VIDEO_V4L2_SUBDEV_API
- static const struct v4l2_subdev_ops ov2659_subdev_ops = {
- .core = &ov2659_subdev_core_ops,
- .video = &ov2659_subdev_video_ops,
- .pad = &ov2659_subdev_pad_ops,
- };
- static const struct v4l2_subdev_internal_ops ov2659_subdev_internal_ops = {
- .open = ov2659_open,
- };
- #endif
- static int ov2659_detect(struct v4l2_subdev *sd)
- {
- struct i2c_client *client = v4l2_get_subdevdata(sd);
- u8 pid = 0;
- u8 ver = 0;
- int ret;
- dev_dbg(&client->dev, "%s:\n", __func__);
- ret = ov2659_write(client, REG_SOFTWARE_RESET, 0x01);
- if (ret != 0) {
- dev_err(&client->dev, "Sensor soft reset failed\n");
- return -ENODEV;
- }
- usleep_range(1000, 2000);
- /* Check sensor revision */
- ret = ov2659_read(client, REG_SC_CHIP_ID_H, &pid);
- if (!ret)
- ret = ov2659_read(client, REG_SC_CHIP_ID_L, &ver);
- if (!ret) {
- unsigned short id;
- id = OV265X_ID(pid, ver);
- if (id != OV2659_ID) {
- dev_err(&client->dev,
- "Sensor detection failed (%04X)\n", id);
- ret = -ENODEV;
- } else {
- dev_info(&client->dev, "Found OV%04X sensor\n", id);
- }
- }
- return ret;
- }
- static struct ov2659_platform_data *
- ov2659_get_pdata(struct i2c_client *client)
- {
- struct ov2659_platform_data *pdata;
- struct v4l2_fwnode_endpoint bus_cfg = { .bus_type = 0 };
- struct device_node *endpoint;
- int ret;
- if (!IS_ENABLED(CONFIG_OF) || !client->dev.of_node)
- return client->dev.platform_data;
- endpoint = of_graph_get_next_endpoint(client->dev.of_node, NULL);
- if (!endpoint)
- return NULL;
- ret = v4l2_fwnode_endpoint_alloc_parse(of_fwnode_handle(endpoint),
- &bus_cfg);
- if (ret) {
- pdata = NULL;
- goto done;
- }
- pdata = devm_kzalloc(&client->dev, sizeof(*pdata), GFP_KERNEL);
- if (!pdata)
- goto done;
- if (!bus_cfg.nr_of_link_frequencies) {
- dev_err(&client->dev,
- "link-frequencies property not found or too many\n");
- pdata = NULL;
- goto done;
- }
- pdata->link_frequency = bus_cfg.link_frequencies[0];
- done:
- v4l2_fwnode_endpoint_free(&bus_cfg);
- of_node_put(endpoint);
- return pdata;
- }
- static int ov2659_probe(struct i2c_client *client)
- {
- const struct ov2659_platform_data *pdata = ov2659_get_pdata(client);
- struct v4l2_subdev *sd;
- struct ov2659 *ov2659;
- int ret;
- if (!pdata) {
- dev_err(&client->dev, "platform data not specified\n");
- return -EINVAL;
- }
- ov2659 = devm_kzalloc(&client->dev, sizeof(*ov2659), GFP_KERNEL);
- if (!ov2659)
- return -ENOMEM;
- ov2659->pdata = pdata;
- ov2659->client = client;
- ov2659->clk = devm_clk_get(&client->dev, "xvclk");
- if (IS_ERR(ov2659->clk))
- return PTR_ERR(ov2659->clk);
- ov2659->xvclk_frequency = clk_get_rate(ov2659->clk);
- if (ov2659->xvclk_frequency < 6000000 ||
- ov2659->xvclk_frequency > 27000000)
- return -EINVAL;
- /* Optional gpio don't fail if not present */
- ov2659->pwdn_gpio = devm_gpiod_get_optional(&client->dev, "powerdown",
- GPIOD_OUT_LOW);
- if (IS_ERR(ov2659->pwdn_gpio))
- return PTR_ERR(ov2659->pwdn_gpio);
- /* Optional gpio don't fail if not present */
- ov2659->resetb_gpio = devm_gpiod_get_optional(&client->dev, "reset",
- GPIOD_OUT_HIGH);
- if (IS_ERR(ov2659->resetb_gpio))
- return PTR_ERR(ov2659->resetb_gpio);
- v4l2_ctrl_handler_init(&ov2659->ctrls, 2);
- ov2659->link_frequency =
- v4l2_ctrl_new_std(&ov2659->ctrls, &ov2659_ctrl_ops,
- V4L2_CID_PIXEL_RATE,
- pdata->link_frequency / 2,
- pdata->link_frequency, 1,
- pdata->link_frequency);
- v4l2_ctrl_new_std_menu_items(&ov2659->ctrls, &ov2659_ctrl_ops,
- V4L2_CID_TEST_PATTERN,
- ARRAY_SIZE(ov2659_test_pattern_menu) - 1,
- 0, 0, ov2659_test_pattern_menu);
- ov2659->sd.ctrl_handler = &ov2659->ctrls;
- if (ov2659->ctrls.error) {
- dev_err(&client->dev, "%s: control initialization error %d\n",
- __func__, ov2659->ctrls.error);
- return ov2659->ctrls.error;
- }
- sd = &ov2659->sd;
- client->flags |= I2C_CLIENT_SCCB;
- #ifdef CONFIG_VIDEO_V4L2_SUBDEV_API
- v4l2_i2c_subdev_init(sd, client, &ov2659_subdev_ops);
- sd->internal_ops = &ov2659_subdev_internal_ops;
- sd->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE |
- V4L2_SUBDEV_FL_HAS_EVENTS;
- #endif
- #if defined(CONFIG_MEDIA_CONTROLLER)
- ov2659->pad.flags = MEDIA_PAD_FL_SOURCE;
- sd->entity.function = MEDIA_ENT_F_CAM_SENSOR;
- ret = media_entity_pads_init(&sd->entity, 1, &ov2659->pad);
- if (ret < 0) {
- v4l2_ctrl_handler_free(&ov2659->ctrls);
- return ret;
- }
- #endif
- mutex_init(&ov2659->lock);
- ov2659_get_default_format(&ov2659->format);
- ov2659->frame_size = &ov2659_framesizes[2];
- ov2659->format_ctrl_regs = ov2659_formats[0].format_ctrl_regs;
- ret = ov2659_power_on(&client->dev);
- if (ret < 0)
- goto error;
- ret = ov2659_detect(sd);
- if (ret < 0)
- goto error;
- /* Calculate the PLL register value needed */
- ov2659_pll_calc_params(ov2659);
- ret = v4l2_async_register_subdev(&ov2659->sd);
- if (ret)
- goto error;
- dev_info(&client->dev, "%s sensor driver registered !!\n", sd->name);
- pm_runtime_set_active(&client->dev);
- pm_runtime_enable(&client->dev);
- pm_runtime_idle(&client->dev);
- return 0;
- error:
- v4l2_ctrl_handler_free(&ov2659->ctrls);
- ov2659_power_off(&client->dev);
- media_entity_cleanup(&sd->entity);
- mutex_destroy(&ov2659->lock);
- return ret;
- }
- static void ov2659_remove(struct i2c_client *client)
- {
- struct v4l2_subdev *sd = i2c_get_clientdata(client);
- struct ov2659 *ov2659 = to_ov2659(sd);
- v4l2_ctrl_handler_free(&ov2659->ctrls);
- v4l2_async_unregister_subdev(sd);
- media_entity_cleanup(&sd->entity);
- mutex_destroy(&ov2659->lock);
- pm_runtime_disable(&client->dev);
- if (!pm_runtime_status_suspended(&client->dev))
- ov2659_power_off(&client->dev);
- pm_runtime_set_suspended(&client->dev);
- }
- static const struct dev_pm_ops ov2659_pm_ops = {
- SET_RUNTIME_PM_OPS(ov2659_power_off, ov2659_power_on, NULL)
- };
- static const struct i2c_device_id ov2659_id[] = {
- { "ov2659", 0 },
- { /* sentinel */ },
- };
- MODULE_DEVICE_TABLE(i2c, ov2659_id);
- #if IS_ENABLED(CONFIG_OF)
- static const struct of_device_id ov2659_of_match[] = {
- { .compatible = "ovti,ov2659", },
- { /* sentinel */ },
- };
- MODULE_DEVICE_TABLE(of, ov2659_of_match);
- #endif
- static struct i2c_driver ov2659_i2c_driver = {
- .driver = {
- .name = DRIVER_NAME,
- .pm = &ov2659_pm_ops,
- .of_match_table = of_match_ptr(ov2659_of_match),
- },
- .probe_new = ov2659_probe,
- .remove = ov2659_remove,
- .id_table = ov2659_id,
- };
- module_i2c_driver(ov2659_i2c_driver);
- MODULE_AUTHOR("Benoit Parrot <[email protected]>");
- MODULE_DESCRIPTION("OV2659 CMOS Image Sensor driver");
- MODULE_LICENSE("GPL v2");
|