2 * Copyright (C) 2005-2006 Micronas USA Inc.
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License (Version 2) as
6 * published by the Free Software Foundation.
8 * This program is distributed in the hope that it will be useful,
9 * but WITHOUT ANY WARRANTY; without even the implied warranty of
10 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
11 * GNU General Public License for more details.
13 * You should have received a copy of the GNU General Public License
14 * along with this program; if not, write to the Free Software Foundation,
15 * Inc., 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
18 #include <linux/init.h>
19 #include <linux/module.h>
20 #include <linux/i2c.h>
21 #include <linux/videodev2.h>
22 #include <media/v4l2-device.h>
23 #include <media/v4l2-chip-ident.h>
24 #include <linux/slab.h>
26 MODULE_DESCRIPTION("OmniVision ov7640 sensor driver");
27 MODULE_LICENSE("GPL v2");
29 static const u8 initial_registers
[] = {
36 0xFF, 0xFF, /* Terminator (reg 0xFF is unused) */
39 static int write_regs(struct i2c_client
*client
, const u8
*regs
)
43 for (i
= 0; regs
[i
] != 0xFF; i
+= 2)
44 if (i2c_smbus_write_byte_data(client
, regs
[i
], regs
[i
+ 1]) < 0)
49 /* ----------------------------------------------------------------------- */
51 static const struct v4l2_subdev_ops ov7640_ops
;
53 static int ov7640_probe(struct i2c_client
*client
,
54 const struct i2c_device_id
*id
)
56 struct i2c_adapter
*adapter
= client
->adapter
;
57 struct v4l2_subdev
*sd
;
59 if (!i2c_check_functionality(adapter
, I2C_FUNC_SMBUS_BYTE_DATA
))
62 sd
= kzalloc(sizeof(struct v4l2_subdev
), GFP_KERNEL
);
65 v4l2_i2c_subdev_init(sd
, client
, &ov7640_ops
);
67 client
->flags
= I2C_CLIENT_SCCB
;
69 v4l_info(client
, "chip found @ 0x%02x (%s)\n",
70 client
->addr
<< 1, client
->adapter
->name
);
72 if (write_regs(client
, initial_registers
) < 0) {
73 v4l_err(client
, "error initializing OV7640\n");
82 static int ov7640_remove(struct i2c_client
*client
)
84 struct v4l2_subdev
*sd
= i2c_get_clientdata(client
);
86 v4l2_device_unregister_subdev(sd
);
91 static const struct i2c_device_id ov7640_id
[] = {
95 MODULE_DEVICE_TABLE(i2c
, ov7640_id
);
97 static struct i2c_driver ov7640_driver
= {
102 .probe
= ov7640_probe
,
103 .remove
= ov7640_remove
,
104 .id_table
= ov7640_id
,
106 module_i2c_driver(ov7640_driver
);