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/module.h>
19 #include <linux/init.h>
20 #include <linux/i2c.h>
21 #include <linux/videodev2.h>
32 static u8 initial_registers
[] =
40 0xFF, 0xFF, /* Terminator (reg 0xFF is unused) */
43 static int write_regs(struct i2c_client
*client
, u8
*regs
)
47 for (i
= 0; regs
[i
] != 0xFF; i
+= 2)
48 if (i2c_smbus_write_byte_data(client
, regs
[i
], regs
[i
+ 1]) < 0)
53 static struct i2c_driver wis_ov7640_driver
;
55 static struct i2c_client wis_ov7640_client_templ
= {
56 .name
= "OV7640 (WIS)",
57 .driver
= &wis_ov7640_driver
,
60 static int wis_ov7640_detect(struct i2c_adapter
*adapter
, int addr
, int kind
)
62 struct i2c_client
*client
;
64 if (!i2c_check_functionality(adapter
, I2C_FUNC_SMBUS_BYTE_DATA
))
67 client
= kmalloc(sizeof(struct i2c_client
), GFP_KERNEL
);
70 memcpy(client
, &wis_ov7640_client_templ
,
71 sizeof(wis_ov7640_client_templ
));
72 client
->adapter
= adapter
;
74 client
->flags
= I2C_CLIENT_SCCB
;
77 "wis-ov7640: initializing OV7640 at address %d on %s\n",
80 if (write_regs(client
, initial_registers
) < 0) {
81 printk(KERN_ERR
"wis-ov7640: error initializing OV7640\n");
86 i2c_attach_client(client
);
90 static int wis_ov7640_detach(struct i2c_client
*client
)
94 r
= i2c_detach_client(client
);
102 static struct i2c_driver wis_ov7640_driver
= {
104 .name
= "WIS OV7640 I2C driver",
106 .id
= I2C_DRIVERID_WIS_OV7640
,
107 .detach_client
= wis_ov7640_detach
,
110 static int __init
wis_ov7640_init(void)
114 r
= i2c_add_driver(&wis_ov7640_driver
);
117 return wis_i2c_add_driver(wis_ov7640_driver
.id
, wis_ov7640_detect
);
120 static void __exit
wis_ov7640_cleanup(void)
122 wis_i2c_del_driver(wis_ov7640_detect
);
123 i2c_del_driver(&wis_ov7640_driver
);
126 module_init(wis_ov7640_init
);
127 module_exit(wis_ov7640_cleanup
);
129 MODULE_LICENSE("GPL v2");