/* Shared Code for OmniVision Camera Chip Drivers * * Copyright (c) 2004 Mark McClelland <mark@alpha.dyndns.org> * http://alpha.dyndns.org/ov511/ * * This program is free software; you can redistribute it and/or modify it * under the terms of the GNU General Public License as published by the * Free Software Foundation; either version 2 of the License, or (at your * option) any later version. NO WARRANTY OF ANY KIND is expressed or implied. */#define DEBUG#include <linux/init.h>#include <linux/module.h>#include <linux/moduleparam.h>#include <linux/slab.h>#include "ovcamchip_priv.h"#define DRIVER_VERSION "v2.27 for Linux 2.6"#define DRIVER_AUTHOR "Mark McClelland <mark@alpha.dyndns.org>"#define DRIVER_DESC "OV camera chip I2C driver"#define PINFO(fmt, args...) printk(KERN_INFO "ovcamchip: " fmt "\n" , ## args);#define PERROR(fmt, args...) printk(KERN_ERR "ovcamchip: " fmt "\n" , ## args);#ifdef DEBUGint ovcamchip_debug = 0;static int debug;module_param(debug, int, 0);MODULE_PARM_DESC(debug,  "Debug level: 0=none, 1=inits, 2=warning, 3=config, 4=functions, 5=all");#endif/* By default, let bridge driver tell us if chip is monochrome. mono=0 * will ignore that and always treat chips as color. mono=1 will force * monochrome mode for all chips. */static int mono = -1;module_param(mono, int, 0);MODULE_PARM_DESC(mono,  "1=chips are monochrome (OVx1xx), 0=force color, -1=autodetect (default)");MODULE_AUTHOR(DRIVER_AUTHOR);MODULE_DESCRIPTION(DRIVER_DESC);MODULE_LICENSE("GPL");/* Registers common to all chips, that are needed for detection */#define GENERIC_REG_ID_HIGH       0x1C	/* manufacturer ID MSB */#define GENERIC_REG_ID_LOW        0x1D	/* manufacturer ID LSB */#define GENERIC_REG_COM_I         0x29	/* misc ID bits */extern struct ovcamchip_ops ov6x20_ops;extern struct ovcamchip_ops ov6x30_ops;extern struct ovcamchip_ops ov7x10_ops;extern struct ovcamchip_ops ov7x20_ops;extern struct ovcamchip_ops ov76be_ops;static char *chip_names[NUM_CC_TYPES] = {	[CC_UNKNOWN]	= "Unknown chip",	[CC_OV76BE]	= "OV76BE",	[CC_OV7610]	= "OV7610",	[CC_OV7620]	= "OV7620",	[CC_OV7620AE]	= "OV7620AE",	[CC_OV6620]	= "OV6620",	[CC_OV6630]	= "OV6630",	[CC_OV6630AE]	= "OV6630AE",	[CC_OV6630AF]	= "OV6630AF",};/* Forward declarations */static struct i2c_driver driver;static struct i2c_client client_template;/* ----------------------------------------------------------------------- */int ov_write_regvals(struct i2c_client *c, struct ovcamchip_regvals *rvals){	int rc;	while (rvals->reg != 0xff) {		rc = ov_write(c, rvals->reg, rvals->val);		if (rc < 0)			return rc;		rvals++;	}	return 0;}/* Writes bits at positions specified by mask to an I2C reg. Bits that are in * the same position as 1's in "mask" are cleared and set to "value". Bits * that are in the same position as 0's in "mask" are preserved, regardless * of their respective state in "value". */int ov_write_mask(struct i2c_client *c,		  unsigned char reg,		  unsigned char value,		  unsigned char mask){	int rc;	unsigned char oldval, newval;	if (mask == 0xff) {		newval = value;	} else {		rc = ov_read(c, reg, &oldval);		if (rc < 0)			return rc;		oldval &= (~mask);		/* Clear the masked bits */		value &= mask;			/* Enforce mask on value */		newval = oldval | value;	/* Set the desired bits */	}	return ov_write(c, reg, newval);}/* ----------------------------------------------------------------------- *//* Reset the chip and ensure that I2C is synchronized. Returns <0 if failure. */static int init_camchip(struct i2c_client *c){	int i, success;	unsigned char high, low;	/* Reset the chip */	ov_write(c, 0x12, 0x80);	/* Wait for it to initialize */	set_current_state(TASK_UNINTERRUPTIBLE);	schedule_timeout(1 + 150 * HZ / 1000);	for (i = 0, success = 0; i < I2C_DETECT_RETRIES && !success; i++) {		if (ov_read(c, GENERIC_REG_ID_HIGH, &high) >= 0) {			if (ov_read(c, GENERIC_REG_ID_LOW, &low) >= 0) {				if (high == 0x7F && low == 0xA2) {					success = 1;					continue;				}			}		}		/* Reset the chip */		ov_write(c, 0x12, 0x80);		/* Wait for it to initialize */		set_current_state(TASK_UNINTERRUPTIBLE);		schedule_timeout(1 + 150 * HZ / 1000);		/* Dummy read to sync I2C */		ov_read(c, 0x00, &low);	}	if (!success)		return -EIO;	PDEBUG(1, "I2C synced in %d attempt(s)", i);	return 0;}/* This detects the OV7610, OV7620, or OV76BE chip. */static int ov7xx0_detect(struct i2c_client *c){	struct ovcamchip *ov = i2c_get_clientdata(c);	int rc;	unsigned char val;	PDEBUG(4, "");	/* Detect chip (sub)type */	rc = ov_read(c, GENERIC_REG_COM_I, &val);	if (rc < 0) {		PERROR("Error detecting ov7xx0 type");		return rc;	}	if ((val & 3) == 3) {		PINFO("Camera chip is an OV7610");		ov->subtype = CC_OV7610;	} else if ((val & 3) == 1) {		rc = ov_read(c, 0x15, &val);		if (rc < 0) {			PERROR("Error detecting ov7xx0 type");			return rc;		}		if (val & 1) {			PINFO("Camera chip is an OV7620AE");			/* OV7620 is a close enough match for now. There are			 * some definite differences though, so this should be			 * fixed */			ov->subtype = CC_OV7620;		} else {			PINFO("Camera chip is an OV76BE");			ov->subtype = CC_OV76BE;		}	} else if ((val & 3) == 0) {		PINFO("Camera chip is an OV7620");		ov->subtype = CC_OV7620;	} else {		PERROR("Unknown camera chip version: %d", val & 3);		return -ENOSYS;	}	if (ov->subtype == CC_OV76BE)		ov->sops = &ov76be_ops;	else if (ov->subtype == CC_OV7620)		ov->sops = &ov7x20_ops;	else		ov->sops = &ov7x10_ops;	return 0;}/* This detects the OV6620, OV6630, OV6630AE, or OV6630AF chip. */static int ov6xx0_detect(struct i2c_client *c){	struct ovcamchip *ov = i2c_get_clientdata(c);	int rc;	unsigned char val;	PDEBUG(4, "");	/* Detect chip (sub)type */	rc = ov_read(c, GENERIC_REG_COM_I, &val);	if (rc < 0) {		PERROR("Error detecting ov6xx0 type");		return -1;	}	if ((val & 3) == 0) {		ov->subtype = CC_OV6630;		PINFO("Camera chip is an OV6630");	} else if ((val & 3) == 1) {		ov->subtype = CC_OV6620;		PINFO("Camera chip is an OV6620");	} else if ((val & 3) == 2) {		ov->subtype = CC_OV6630;		PINFO("Camera chip is an OV6630AE");	} else if ((val & 3) == 3) {		ov->subtype = CC_OV6630;		PINFO("Camera chip is an OV6630AF");	}	if (ov->subtype == CC_OV6620)		ov->sops = &ov6x20_ops;	else		ov->sops = &ov6x30_ops;	return 0;}static int ovcamchip_detect(struct i2c_client *c){	/* Ideally we would just try a single register write and see if it NAKs.	 * That isn't possible since the OV518 can't report I2C transaction	 * failures. So, we have to try to initialize the chip (i.e. reset it	 * and check the ID registers) to detect its presence. */	/* Test for 7xx0 */	PDEBUG(3, "Testing for 0V7xx0");	c->addr = OV7xx0_SID;	if (init_camchip(c) < 0) {		/* Test for 6xx0 */		PDEBUG(3, "Testing for 0V6xx0");		c->addr = OV6xx0_SID;		if (init_camchip(c) < 0) { 			return -ENODEV;		} else {			if (ov6xx0_detect(c) < 0) {				PERROR("Failed to init OV6xx0"); 				return -EIO;			}		}	} else {		if (ov7xx0_detect(c) < 0) {			PERROR("Failed to init OV7xx0"); 			return -EIO;		}	}	return 0;}/* ----------------------------------------------------------------------- */static int ovcamchip_attach(struct i2c_adapter *adap){	int rc = 0;	struct ovcamchip *ov;	struct i2c_client *c;	/* I2C is not a PnP bus, so we can never be certain that we're talking	 * to the right chip. To prevent damage to EEPROMS and such, only	 * attach to adapters that are known to contain OV camera chips. */	switch (adap->id) {	case (I2C_ALGO_SMBUS | I2C_HW_SMBUS_OV511):	case (I2C_ALGO_SMBUS | I2C_HW_SMBUS_OV518):	case (I2C_ALGO_SMBUS | I2C_HW_SMBUS_OVFX2):	case (I2C_ALGO_SMBUS | I2C_HW_SMBUS_W9968CF):		PDEBUG(1, "Adapter ID 0x%06x accepted", adap->id);		break;	default:		PDEBUG(1, "Adapter ID 0x%06x rejected", adap->id);		return -ENODEV;	}	c = kmalloc(sizeof *c, GFP_KERNEL);	if (!c) {		rc = -ENOMEM;		goto no_client;	}	memcpy(c, &client_template, sizeof *c);	c->adapter = adap;	strcpy(i2c_clientname(c), "OV????");	ov = kmalloc(sizeof *ov, GFP_KERNEL);	if (!ov) {		rc = -ENOMEM;		goto no_ov;	}	memset(ov, 0, sizeof *ov);	i2c_set_clientdata(c, ov);	rc = ovcamchip_detect(c);	if (rc < 0)		goto error;	strcpy(i2c_clientname(c), chip_names[ov->subtype]);	PDEBUG(1, "Camera chip detection complete");	i2c_attach_client(c);	return rc;error:	kfree(ov);no_ov:	kfree(c);no_client:	PDEBUG(1, "returning %d", rc);	return rc;}static int ovcamchip_detach(struct i2c_client *c){	struct ovcamchip *ov = i2c_get_clientdata(c);	int rc;	rc = ov->sops->free(c);	if (rc < 0)		return rc;	i2c_detach_client(c);	kfree(ov);	kfree(c);	return 0;}static int ovcamchip_command(struct i2c_client *c, unsigned int cmd, void *arg){	struct ovcamchip *ov = i2c_get_clientdata(c);	if (!ov->initialized &&	    cmd != OVCAMCHIP_CMD_Q_SUBTYPE &&	    cmd != OVCAMCHIP_CMD_INITIALIZE) {		dev_err(&c->dev, "ERROR: Camera chip not initialized yet!\n");		return -EPERM;	}	switch (cmd) {	case OVCAMCHIP_CMD_Q_SUBTYPE:	{		*(int *)arg = ov->subtype;		return 0;	}	case OVCAMCHIP_CMD_INITIALIZE:	{		int rc;		if (mono == -1)			ov->mono = *(int *)arg;		else			ov->mono = mono;		if (ov->mono) {			if (ov->subtype != CC_OV7620)				dev_warn(&c->dev, "Warning: Monochrome not "					"implemented for this chip\n");			else				dev_info(&c->dev, "Initializing chip as "					"monochrome\n");		}		rc = ov->sops->init(c);		if (rc < 0)			return rc;		ov->initialized = 1;		return 0;	}	default:		return ov->sops->command(c, cmd, arg);	}}/* ----------------------------------------------------------------------- */static struct i2c_driver driver = {	.owner =		THIS_MODULE,	.name =			"ovcamchip",	.id =			I2C_DRIVERID_OVCAMCHIP,	.class =		I2C_CLASS_CAM_DIGITAL,	.flags =		I2C_DF_NOTIFY,	.attach_adapter =	ovcamchip_attach,	.detach_client =	ovcamchip_detach,	.command =		ovcamchip_command,};static struct i2c_client client_template = {	I2C_DEVNAME("(unset)"),	.id =		-1,	.driver =	&driver,};static int __init ovcamchip_init(void){#ifdef DEBUG	ovcamchip_debug = debug;#endif	PINFO(DRIVER_VERSION " : " DRIVER_DESC);	return i2c_add_driver(&driver);}static void __exit ovcamchip_exit(void){	i2c_del_driver(&driver);}module_init(ovcamchip_init);module_exit(ovcamchip_exit);