linux-imx

// SPDX-License-Identifier: GPL-2.0

//

// mt9v011 -Micron 1/4-Inch VGA Digital Image Sensor

//

// Copyright (c) 2009 Mauro Carvalho Chehab <mchehab@kernel.org>

​

#include <linux/i2c.h>

#include <linux/slab.h>

#include <linux/videodev2.h>

#include <linux/delay.h>

#include <linux/module.h>

#include <asm/div64.h>

#include <media/v4l2-device.h>

#include <media/v4l2-ctrls.h>

#include <media/i2c/mt9v011.h>

​

MODULE_DESCRIPTION("Micron mt9v011 sensor driver");

MODULE_AUTHOR("Mauro Carvalho Chehab");

MODULE_LICENSE("GPL v2");

​

static int debug;

module_param(debug, int, 0);

MODULE_PARM_DESC(debug, "Debug level (0-2)");

​

#define R00_MT9V011_CHIP_VERSION    0x00

#define R01_MT9V011_ROWSTART        0x01

#define R02_MT9V011_COLSTART        0x02

#define R03_MT9V011_HEIGHT      0x03

#define R04_MT9V011_WIDTH       0x04

#define R05_MT9V011_HBLANK      0x05

#define R06_MT9V011_VBLANK      0x06

#define R07_MT9V011_OUT_CTRL        0x07

#define R09_MT9V011_SHUTTER_WIDTH   0x09

#define R0A_MT9V011_CLK_SPEED       0x0a

#define R0B_MT9V011_RESTART     0x0b

#define R0C_MT9V011_SHUTTER_DELAY   0x0c

#define R0D_MT9V011_RESET       0x0d

#define R1E_MT9V011_DIGITAL_ZOOM    0x1e

#define R20_MT9V011_READ_MODE       0x20

#define R2B_MT9V011_GREEN_1_GAIN    0x2b

#define R2C_MT9V011_BLUE_GAIN       0x2c

#define R2D_MT9V011_RED_GAIN        0x2d

#define R2E_MT9V011_GREEN_2_GAIN    0x2e

#define R35_MT9V011_GLOBAL_GAIN     0x35

#define RF1_MT9V011_CHIP_ENABLE     0xf1

​

#define MT9V011_VERSION         0x8232

#define MT9V011_REV_B_VERSION       0x8243

​

struct mt9v011 {

    struct v4l2_subdev sd;

#ifdef CONFIG_MEDIA_CONTROLLER

    struct media_pad pad;

#endif

    struct v4l2_ctrl_handler ctrls;

    unsigned width, height;

    unsigned xtal;

    unsigned hflip:1;

    unsigned vflip:1;

​

    u16 global_gain, exposure;

    s16 red_bal, blue_bal;

};

​

static inline struct mt9v011 *to_mt9v011(struct v4l2_subdev *sd)

{

    return container_of(sd, struct mt9v011, sd);

}

​

static int mt9v011_read(struct v4l2_subdev *sd, unsigned char addr)

{

    struct i2c_client *c = v4l2_get_subdevdata(sd);

    __be16 buffer;

    int rc, val;

​

    rc = i2c_master_send(c, &addr, 1);

    if (rc != 1)

        v4l2_dbg(0, debug, sd,

             "i2c i/o error: rc == %d (should be 1)\n", rc);

​

    msleep(10);

​

    rc = i2c_master_recv(c, (char *)&buffer, 2);

    if (rc != 2)

        v4l2_dbg(0, debug, sd,

             "i2c i/o error: rc == %d (should be 2)\n", rc);

​

    val = be16_to_cpu(buffer);

​

    v4l2_dbg(2, debug, sd, "mt9v011: read 0x%02x = 0x%04x\n", addr, val);

​

    return val;