// SPDX-License-Identifier: GPL-2.0 /* * mt9t112 Camera Driver * * Copyright (C) 2018 Jacopo Mondi <jacopo+renesas@jmondi.org> * * Copyright (C) 2009 Renesas Solutions Corp. * Kuninori Morimoto <morimoto.kuninori@renesas.com> * * Based on ov772x driver, mt9m111 driver, * * Copyright (C) 2008 Kuninori Morimoto <morimoto.kuninori@renesas.com> * Copyright (C) 2008, Robert Jarzmik <robert.jarzmik@free.fr> * Copyright 2006-7 Jonathan Corbet <corbet@lwn.net> * Copyright (C) 2008 Magnus Damm * Copyright (C) 2008, Guennadi Liakhovetski <kernel@pengutronix.de> * * TODO: This driver lacks support for frame rate control due to missing * register level documentation and suitable hardware for testing. * v4l-utils compliance tools will report errors. #include <linux/clk.h>#include <linux/delay.h>#include <linux/gpio/consumer.h>#include <linux/i2c.h>#include <linux/init.h>#include <linux/module.h>#include <linux/slab.h>#include <linux/v4l2-mediabus.h>#include <linux/videodev2.h>#include <media/i2c/mt9t112.h>#include <media/v4l2-common.h>#include <media/v4l2-image-sizes.h>#include <media/v4l2-subdev.h>/* you can check PLL/clock info */ /* #define EXT_CLOCK 24000000 */ /************************************************************************ * macro /* * frame size #define MAX_WIDTH 2048 #define MAX_HEIGHT 1536 /* * macro of read/write #define ECHECKER(ret, x) \do { \if ((ret) < 0 ) \return (ret); \while (0 )#define mt9t112_reg_write(ret, client, a, b) \#define mt9t112_mcu_write(ret, client, a, b) \#define mt9t112_reg_mask_set(ret, client, a, b, c) \#define mt9t112_mcu_mask_set(ret, client, a, b, c) \#define mt9t112_reg_read(ret, client, a) \/* * Logical address #define _VAR(id, offset, base) (base | (id & 0 x1f) << 10 | (offset & 0 x3ff))#define VAR(id, offset) _VAR(id, offset, 0 x0000)#define VAR8(id, offset) _VAR(id, offset, 0 x8000)/************************************************************************ * struct struct mt9t112_format {enum v4l2_colorspace colorspace;struct mt9t112_priv {struct v4l2_subdev subdev;struct mt9t112_platform_data *info;struct i2c_client *client;struct v4l2_rect frame;struct clk *clk;struct gpio_desc *standby_gpio;const struct mt9t112_format *format;int num_formats;bool init_done;/************************************************************************ * supported format static const struct mt9t112_format mt9t112_cfmts[] = {1 ,0 ,1 ,1 ,1 ,2 ,1 ,3 ,8 ,2 ,4 ,2 ,/************************************************************************ * general function static struct mt9t112_priv *to_mt9t112(const struct i2c_client *client)return container_of(i2c_get_clientdata(client),struct mt9t112_priv,static int __mt9t112_reg_read(const struct i2c_client *client, u16 command)struct i2c_msg msg[2 ];2 ];int ret;0 ].addr = client->addr;0 ].flags = 0 ;0 ].len = 2 ;0 ].buf = (u8 *)&command;1 ].addr = client->addr;1 ].flags = I2C_M_RD;1 ].len = 2 ;1 ].buf = buf;/* * If return value of this function is < 0, it means error, else, * below 16bit is valid data. 2 );if (ret < 0 )return ret;2 );return swab16(ret);static int __mt9t112_reg_write(const struct i2c_client *client,struct i2c_msg msg;4 ];int ret;0 , &command, 2 );2 , &data, 2 );0 ;4 ;/* * i2c_transfer return message length, but this function should * return 0 if correct case. 1 );return ret >= 0 ? 0 : ret;static int __mt9t112_reg_mask_set(const struct i2c_client *client,int val = __mt9t112_reg_read(client, command);if (val < 0 )return val;return __mt9t112_reg_write(client, command, val);/* mcu access */ static int __mt9t112_mcu_read(const struct i2c_client *client, u16 command)int ret;0 x098E, command);if (ret < 0 )return ret;return __mt9t112_reg_read(client, 0 x0990);static int __mt9t112_mcu_write(const struct i2c_client *client,int ret;0 x098E, command);if (ret < 0 )return ret;return __mt9t112_reg_write(client, 0 x0990, data);static int __mt9t112_mcu_mask_set(const struct i2c_client *client,int val = __mt9t112_mcu_read(client, command);if (val < 0 )return val;return __mt9t112_mcu_write(client, command, val);static int mt9t112_reset(const struct i2c_client *client)int ret;0 x001a, 0 x0001, 0 x0001);1000 , 5000 );0 x001a, 0 x0001, 0 x0000);return ret;#ifndef EXT_CLOCK#define CLOCK_INFO(a, b)#else #define CLOCK_INFO(a, b) mt9t112_clock_info(a, b)static int mt9t112_clock_info(const struct i2c_client *client, u32 ext)int m, n, p1, p2, p3, p4, p5, p6, p7;char *enable;1000 ; /* kbyte order */ 0 x0012);0 x000f;4 ;0 x000f;4 ;0 x000f;0 x002a);0 x000f;4 ;0 x000f;4 ;0 x000f;0 x002c);0 x000f;0 x0010);0 x00ff;8 ) & 0 x003f;6000 ) || (ext > 54000 )) ? "X" : "" ;"EXTCLK : %10u K %s\n" , ext, enable);2 * m * ext / (n + 1 );384000 ) || (vco > 768000 )) ? "X" : "" ;"VCO : %10u K %s\n" , vco, enable);1 ) / (p2 + 1 );96000 ) ? "X" : "" ;"PIXCLK : %10u K %s\n" , clk, enable);1 );768000 ) ? "X" : "" ;"MIPICLK : %10u K %s\n" , clk, enable);1 );96000 ) ? "X" : "" ;"MCU CLK : %10u K %s\n" , clk, enable);1 );54000 ) ? "X" : "" ;"SOC CLK : %10u K %s\n" , clk, enable);1 );70000 ) ? "X" : "" ;"Sensor CLK : %10u K %s\n" , clk, enable);1 );"External sensor : %10u K\n" , clk);1 );2000 ) || (clk > 24000 )) ? "X" : "" ;"PFD : %10u K %s\n" , clk, enable);return 0 ;#endif static int mt9t112_set_a_frame_size(const struct i2c_client *client,int ret;2 ;2 ;/* (Context A) Image Width/Height. */ 26 , 0 ), width);26 , 2 ), height);/* (Context A) Output Width/Height. */ 18 , 43 ), 8 + width);18 , 45 ), 8 + height);/* (Context A) Start Row/Column. */ 18 , 2 ), 4 + hstart);18 , 4 ), 4 + wstart);/* (Context A) End Row/Column. */ 18 , 6 ), 11 + height + hstart);18 , 8 ), 11 + width + wstart);1 , 0 ), 0 x06);return ret;static int mt9t112_set_pll_dividers(const struct i2c_client *client,int ret;/* N/M */ 8 ) | (m << 0 );0 x0010, 0 x3fff, val);/* P1/P2/P3 */ 0 x0F) << 8 ) | ((p2 & 0 x0F) << 4 ) | ((p1 & 0 x0F) << 0 );0 x0012, 0 x0fff, val);/* P4/P5/P6 */ 0 x7 << 12 ) | ((p6 & 0 x0F) << 8 ) | ((p5 & 0 x0F) << 4 ) |0 x0F) << 0 );0 x002A, 0 x7fff, val);/* P7 */ 0 x1 << 12 ) | ((p7 & 0 x0F) << 0 );0 x002C, 0 x100f, val);return ret;static int mt9t112_init_pll(const struct i2c_client *client)struct mt9t112_priv *priv = to_mt9t112(client);int data, i, ret;0 x0014, 0 x003, 0 x0001);/* PLL control: BYPASS PLL = 8517. */ 0 x0014, 0 x2145);/* Replace these registers when new timing parameters are generated. */ /* * TEST_BYPASS on * PLL_ENABLE on * SEL_LOCK_DET on * TEST_BYPASS off 0 x0014, 0 x2525);0 x0014, 0 x2527);0 x0014, 0 x3427);0 x0014, 0 x3027);10 );/* * PLL_BYPASS off * Reference clock count * I2C Master Clock Divider 0 x0014, 0 x3046);/* JPEG initialization workaround */ 0 x0016, 0 x0400);0 x0022, 0 x0190);0 x3B84, 0 x0212);/* External sensor clock is PLL bypass. */ 0 x002E, 0 x0500);0 x0018, 0 x0002, 0 x0002);0 x3B82, 0 x0004, 0 x0004);/* MCU disabled. */ 0 x0018, 0 x0004, 0 x0004);/* Out of standby. */ 0 x0018, 0 x0001, 0 );50 );/* * Standby Workaround * Disable Secondary I2C Pads 0 x0614, 0 x0001);1 );0 x0614, 0 x0001);1 );0 x0614, 0 x0001);1 );0 x0614, 0 x0001);1 );0 x0614, 0 x0001);1 );0 x0614, 0 x0001);1 );/* Poll to verify out of standby. Must Poll this bit. */ for (i = 0 ; i < 100 ; i++) {0 x0018);if (!(data & 0 x4000))break ;10 );return ret;static int mt9t112_init_setting(const struct i2c_client *client)int ret;/* Adaptive Output Clock (A) */ 26 , 160 ), 0 x0040, 0 x0000);/* Read Mode (A) */ 18 , 12 ), 0 x0024);/* Fine Correction (A) */ 18 , 15 ), 0 x00CC);/* Fine IT Min (A) */ 18 , 17 ), 0 x01f1);/* Fine IT Max Margin (A) */ 18 , 19 ), 0 x00fF);/* Base Frame Lines (A) */ 18 , 29 ), 0 x032D);/* Min Line Length (A) */ 18 , 31 ), 0 x073a);/* Line Length (A) */ 18 , 37 ), 0 x07d0);/* Adaptive Output Clock (B) */ 27 , 160 ), 0 x0040, 0 x0000);/* Row Start (B) */ 18 , 74 ), 0 x004);/* Column Start (B) */ 18 , 76 ), 0 x004);/* Row End (B) */ 18 , 78 ), 0 x60B);/* Column End (B) */ 18 , 80 ), 0 x80B);/* Fine Correction (B) */ 18 , 87 ), 0 x008C);/* Fine IT Min (B) */ 18 , 89 ), 0 x01F1);/* Fine IT Max Margin (B) */ 18 , 91 ), 0 x00FF);/* Base Frame Lines (B) */ 18 , 101 ), 0 x0668);/* Min Line Length (B) */ 18 , 103 ), 0 x0AF0);/* Line Length (B) */ 18 , 109 ), 0 x0AF0);/* * Flicker Detection registers. * This section should be replaced whenever new timing file is * generated. All the following registers need to be replaced. * Following registers are generated from Register Wizard but user can * modify them. For detail see auto flicker detection tuning. /* FD_FDPERIOD_SELECT */ 8 , 5 ), 0 x01);/* PRI_B_CONFIG_FD_ALGO_RUN */ 27 , 17 ), 0 x0003);/* PRI_A_CONFIG_FD_ALGO_RUN */ 26 , 17 ), 0 x0003);/* * AFD range detection tuning registers. /* Search_f1_50 */ 18 , 165 ), 0 x25);/* Search_f2_50 */ 18 , 166 ), 0 x28);/* Search_f1_60 */ 18 , 167 ), 0 x2C);/* Search_f2_60 */ 18 , 168 ), 0 x2F);/* Period_50Hz (A) */ 18 , 68 ), 0 xBA);/* Secret register by Aptina. */ /* Period_50Hz (A MSB) */ 18 , 303 ), 0 x00);/* Period_60Hz (A) */ 18 , 69 ), 0 x9B);/* Secret register by Aptina. */ /* Period_60Hz (A MSB) */ 18 , 301 ), 0 x00);/* Period_50Hz (B) */ 18 , 140 ), 0 x82);/* Secret register by Aptina. */ /* Period_50Hz (B) MSB */ 18 , 304 ), 0 x00);/* Period_60Hz (B) */ 18 , 141 ), 0 x6D);/* Secret register by Aptina. */ /* Period_60Hz (B) MSB */ 18 , 302 ), 0 x00);/* FD Mode */ 8 , 2 ), 0 x10);/* Stat_min */ 8 , 9 ), 0 x02);/* Stat_max */ 8 , 10 ), 0 x03);/* Min_amplitude */ 8 , 12 ), 0 x0A);/* RX FIFO Watermark (A) */ 18 , 70 ), 0 x0014);/* RX FIFO Watermark (B) */ 18 , 142 ), 0 x0014);/* MCLK: 16MHz * PCLK: 73MHz * CorePixCLK: 36.5 MHz 18 , 0 x0044), 133 );18 , 0 x0045), 110 );18 , 0 x008c), 130 );18 , 0 x008d), 108 );18 , 0 x00A5), 27 );18 , 0 x00a6), 30 );18 , 0 x00a7), 32 );18 , 0 x00a8), 35 );return ret;static int mt9t112_auto_focus_setting(const struct i2c_client *client)int ret;12 , 13 ), 0 x000F);12 , 23 ), 0 x0F0F);1 , 0 ), 0 x06);0 x0614, 0 x0000);1 , 0 ), 0 x05);12 , 2 ), 0 x02);12 , 3 ), 0 x0002);17 , 3 ), 0 x8001);17 , 11 ), 0 x0025);17 , 13 ), 0 x0193);17 , 33 ), 0 x18);1 , 0 ), 0 x05);return ret;static int mt9t112_auto_focus_trigger(const struct i2c_client *client)int ret;12 , 25 ), 0 x01);return ret;static int mt9t112_init_camera(const struct i2c_client *client)int ret;0 x0018, 0 x0004, 0 );/* Analog setting B.*/ 0 x3084, 0 x2409);0 x3092, 0 x0A49);0 x3094, 0 x4949);0 x3096, 0 x4950);/* * Disable adaptive clock. * PRI_A_CONFIG_JPEG_OB_TX_CONTROL_VAR * PRI_B_CONFIG_JPEG_OB_TX_CONTROL_VAR 26 , 160 ), 0 x0A2E);27 , 160 ), 0 x0A2E);/* * Configure Status in Status_before_length Format and enable header. * PRI_B_CONFIG_JPEG_OB_TX_CONTROL_VAR 27 , 144 ), 0 x0CB4);/* * Enable JPEG in context B. * PRI_B_CONFIG_JPEG_OB_TX_CONTROL_VAR 27 , 142 ), 0 x01);/* Disable Dac_TXLO. */ 0 x316C, 0 x350F);/* Set max slew rates. */ 0 x1E, 0 x777);return ret;/************************************************************************ * v4l2_subdev_core_ops #ifdef CONFIG_VIDEO_ADV_DEBUGstatic int mt9t112_g_register(struct v4l2_subdev *sd,struct v4l2_dbg_register *reg)struct i2c_client *client = v4l2_get_subdevdata(sd);int ret;2 ;return 0 ;static int mt9t112_s_register(struct v4l2_subdev *sd,const struct v4l2_dbg_register *reg)struct i2c_client *client = v4l2_get_subdevdata(sd);int ret;return ret;#endif static int mt9t112_power_on(struct mt9t112_priv *priv)int ret;if (ret)return ret;if (priv->standby_gpio) {0 );100 );return 0 ;static int mt9t112_power_off(struct mt9t112_priv *priv)if (priv->standby_gpio) {1 );100 );return 0 ;static int mt9t112_s_power(struct v4l2_subdev *sd, int on)struct i2c_client *client = v4l2_get_subdevdata(sd);struct mt9t112_priv *priv = to_mt9t112(client);return on ? mt9t112_power_on(priv) :static const struct v4l2_subdev_core_ops mt9t112_subdev_core_ops = {#ifdef CONFIG_VIDEO_ADV_DEBUG#endif /************************************************************************ * v4l2_subdev_video_ops static int mt9t112_s_stream(struct v4l2_subdev *sd, int enable)struct i2c_client *client = v4l2_get_subdevdata(sd);struct mt9t112_priv *priv = to_mt9t112(client);int ret = 0 ;if (!enable) {/* FIXME * * If user selected large output size, and used it long time, * mt9t112 camera will be very warm. * * But current driver can not stop mt9t112 camera. * So, set small size here to solve this problem. return ret;if (!priv->init_done) {0 x0001 : 0 x0000;/* Invert PCLK (Data sampled on falling edge of pixclk). */ 0 x3C20, param);5 );true ;26 , 7 ), priv->format->fmt);26 , 9 ), priv->format->order);1 , 0 ), 0 x06);"format : %d\n" , priv->format->code);"size : %d x %d\n" ,return ret;static int mt9t112_set_params(struct mt9t112_priv *priv,const struct v4l2_rect *rect,int i;/* * get color format for (i = 0 ; i < priv->num_formats; i++)if (mt9t112_cfmts[i].code == code)break ;if (i == priv->num_formats)return -EINVAL;/* * frame size check 0 , MAX_WIDTH, 0 ,0 , MAX_HEIGHT, 0 , 0 );return 0 ;static int mt9t112_get_selection(struct v4l2_subdev *sd,struct v4l2_subdev_state *sd_state,struct v4l2_subdev_selection *sel)struct i2c_client *client = v4l2_get_subdevdata(sd);struct mt9t112_priv *priv = to_mt9t112(client);if (sel->which != V4L2_SUBDEV_FORMAT_ACTIVE)return -EINVAL;switch (sel->target) {case V4L2_SEL_TGT_CROP_BOUNDS:0 ;0 ;return 0 ;case V4L2_SEL_TGT_CROP:return 0 ;default :return -EINVAL;static int mt9t112_set_selection(struct v4l2_subdev *sd,struct v4l2_subdev_state *sd_state,struct v4l2_subdev_selection *sel)struct i2c_client *client = v4l2_get_subdevdata(sd);struct mt9t112_priv *priv = to_mt9t112(client);const struct v4l2_rect *rect = &sel->r;if (sel->which != V4L2_SUBDEV_FORMAT_ACTIVE ||return -EINVAL;return mt9t112_set_params(priv, rect, priv->format->code);static int mt9t112_get_fmt(struct v4l2_subdev *sd,struct v4l2_subdev_state *sd_state,struct v4l2_subdev_format *format)struct v4l2_mbus_framefmt *mf = &format->format;struct i2c_client *client = v4l2_get_subdevdata(sd);struct mt9t112_priv *priv = to_mt9t112(client);if (format->pad)return -EINVAL;return 0 ;static int mt9t112_s_fmt(struct v4l2_subdev *sd,struct v4l2_mbus_framefmt *mf)struct i2c_client *client = v4l2_get_subdevdata(sd);struct mt9t112_priv *priv = to_mt9t112(client);struct v4l2_rect rect = {int ret;if (!ret)return ret;static int mt9t112_set_fmt(struct v4l2_subdev *sd,struct v4l2_subdev_state *sd_state,struct v4l2_subdev_format *format)struct i2c_client *client = v4l2_get_subdevdata(sd);struct v4l2_mbus_framefmt *mf = &format->format;struct mt9t112_priv *priv = to_mt9t112(client);int i;if (format->pad)return -EINVAL;for (i = 0 ; i < priv->num_formats; i++)if (mt9t112_cfmts[i].code == mf->code)break ;if (i == priv->num_formats) {else {0 , MAX_WIDTH, 0 ,0 , MAX_HEIGHT, 0 , 0 );if (format->which == V4L2_SUBDEV_FORMAT_ACTIVE)return mt9t112_s_fmt(sd, mf);return 0 ;static int mt9t112_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);struct mt9t112_priv *priv = to_mt9t112(client);if (code->pad || code->index >= priv->num_formats)return -EINVAL;return 0 ;static const struct v4l2_subdev_video_ops mt9t112_subdev_video_ops = {static const struct v4l2_subdev_pad_ops mt9t112_subdev_pad_ops = {/************************************************************************ * i2c driver static const struct v4l2_subdev_ops mt9t112_subdev_ops = {static int mt9t112_camera_probe(struct i2c_client *client)struct mt9t112_priv *priv = to_mt9t112(client);const char *devname;int chipid;int ret;1 );if (ret < 0 )return ret;/* Check and show chip ID. */ 0 x0000);switch (chipid) {case 0 x2680:"mt9t111" ;1 ;break ;case 0 x2682:"mt9t112" ;break ;default :"Product ID error %04x\n" , chipid);goto done;"%s chip ID %04x\n" , devname, chipid);0 );return ret;static int mt9t112_probe(struct i2c_client *client)struct mt9t112_priv *priv;int ret;if (!client->dev.platform_data) {"mt9t112: missing platform data!\n" );return -EINVAL;sizeof (*priv), GFP_KERNEL);if (!priv)return -ENOMEM;false ;"extclk" );if (PTR_ERR(priv->clk) == -ENOENT) {else if (IS_ERR(priv->clk)) {"Unable to get clock \" extclk\"\n" );return PTR_ERR(priv->clk);"standby" ,if (IS_ERR(priv->standby_gpio)) {"Unable to get gpio \" standby\"\n" );return PTR_ERR(priv->standby_gpio);if (ret)return ret;return v4l2_async_register_subdev(&priv->subdev);static void mt9t112_remove(struct i2c_client *client)struct mt9t112_priv *priv = to_mt9t112(client);static const struct i2c_device_id mt9t112_id[] = {"mt9t112" },static struct i2c_driver mt9t112_i2c_driver = {"mt9t112" ,"V4L2 driver for MT9T111/MT9T112 camera sensor" );"Kuninori Morimoto" );"GPL v2" );
Messung V0.5 in Prozent C=95 H=94 G=94
¤ Dauer der Verarbeitung: 0.31 Sekunden
(vorverarbeitet am 2026-06-08)
¤ *© Formatika GbR, Deutschland
