Linux/Unix编程

开发平台：
Unix_Linux

bt856.c：源码内容
							/* 
    bt856 - BT856A Digital Video Encoder (Rockwell Part)
    Copyright (C) 1999 Mike Bernson <mike@mlb.org>
    Copyright (C) 1998 Dave Perks <dperks@ibm.net>
    Modifications for LML33/DC10plus unified driver
    Copyright (C) 2000 Serguei Miridonov <mirsev@cicese.mx>
    
    This code was modify/ported from the saa7111 driver written
    by Dave Perks.
    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.
    This program is distributed in the hope that it will be useful,
    but WITHOUT ANY WARRANTY; without even the implied warranty of
    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
    GNU General Public License for more details.
    You should have received a copy of the GNU General Public License
    along with this program; if not, write to the Free Software
    Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
*/
#include <linux/module.h>
#include <linux/init.h>
#include <linux/delay.h>
#include <linux/errno.h>
#include <linux/fs.h>
#include <linux/kernel.h>
#include <linux/major.h>
#include <linux/slab.h>
#include <linux/mm.h>
#include <linux/pci.h>
#include <linux/signal.h>
#include <asm/io.h>
#include <asm/pgtable.h>
#include <asm/page.h>
#include <linux/sched.h>
#include <asm/segment.h>
#include <linux/types.h>
#include <linux/wrapper.h>
#include <linux/videodev.h>
#include <linux/version.h>
#include <asm/uaccess.h>
#include <linux/i2c-old.h>
#include <linux/video_encoder.h>
#define DEBUG(x)   x		/* Debug driver */
/* ----------------------------------------------------------------------- */
struct bt856 {
	struct i2c_bus *bus;
	int addr;
	unsigned char reg[128];
	int norm;
	int enable;
	int bright;
	int contrast;
	int hue;
	int sat;
};
#define   I2C_BT856        0x88
#define I2C_DELAY   10
/* ----------------------------------------------------------------------- */
static int bt856_write(struct bt856 *dev, unsigned char subaddr,
		       unsigned char data)
{
	int ack;
	LOCK_I2C_BUS(dev->bus);
	i2c_start(dev->bus);
	i2c_sendbyte(dev->bus, dev->addr, I2C_DELAY);
	i2c_sendbyte(dev->bus, subaddr, I2C_DELAY);
	ack = i2c_sendbyte(dev->bus, data, I2C_DELAY);
	dev->reg[subaddr] = data;
	i2c_stop(dev->bus);
	UNLOCK_I2C_BUS(dev->bus);
	return ack;
}
static int bt856_setbit(struct bt856 *dev, int subaddr, int bit, int data)
{
	return bt856_write(dev, subaddr,(dev->reg[subaddr] & ~(1 << bit)) | (data ? (1 << bit) : 0));
}
/* ----------------------------------------------------------------------- */
static int bt856_attach(struct i2c_device *device)
{
	struct bt856 *encoder;
	/* This chip is not on the buz card but at the same address saa7185 */
	//if (memcmp(device->bus->name, "buz", 3) == 0 || memcmp(device->bus->name, "zr36057", 6) == 0)
	//   return 1;
	MOD_INC_USE_COUNT;
	device->data = encoder = kmalloc(sizeof(struct bt856), GFP_KERNEL);
	if (encoder == NULL) {
		MOD_DEC_USE_COUNT;
		return -ENOMEM;
	}
	memset(encoder, 0, sizeof(struct bt856));
	strcpy(device->name, "bt856");
	encoder->bus = device->bus;
	encoder->addr = device->addr;
	encoder->norm = VIDEO_MODE_NTSC;
	encoder->enable = 1;
	DEBUG(printk(KERN_INFO "%s-bt856: attachn", encoder->bus->name));
	bt856_write(encoder, 0xdc, 0x18);
	bt856_write(encoder, 0xda, 0);
	bt856_write(encoder, 0xde, 0);
	bt856_setbit(encoder, 0xdc, 3, 1);
	//bt856_setbit(encoder, 0xdc, 6, 0);
	bt856_setbit(encoder, 0xdc, 4, 1);
	switch (encoder->norm) {
	case VIDEO_MODE_NTSC:
		bt856_setbit(encoder, 0xdc, 2, 0);
		break;
	case VIDEO_MODE_PAL:
		bt856_setbit(encoder, 0xdc, 2, 1);
		break;
	}
	bt856_setbit(encoder, 0xdc, 1, 1);
	bt856_setbit(encoder, 0xde, 4, 0);
	bt856_setbit(encoder, 0xde, 3, 1);
	return 0;
}
static int bt856_detach(struct i2c_device *device)
{
	kfree(device->data);
	MOD_DEC_USE_COUNT;
	return 0;
}
static int bt856_command(struct i2c_device *device, unsigned int cmd,
			 void *arg)
{
	struct bt856 *encoder = device->data;
	switch (cmd) {
	case ENCODER_GET_CAPABILITIES:
		{
			struct video_encoder_capability *cap = arg;
			DEBUG(printk
			      (KERN_INFO "%s-bt856: get capabilitiesn",
			       encoder->bus->name));
			cap->flags
			    = VIDEO_ENCODER_PAL
			    | VIDEO_ENCODER_NTSC | VIDEO_ENCODER_CCIR;
			cap->inputs = 2;
			cap->outputs = 1;
		}
		break;
	case ENCODER_SET_NORM:
		{
			int *iarg = arg;
			DEBUG(printk(KERN_INFO "%s-bt856: set norm %dn",
				     encoder->bus->name, *iarg));
			switch (*iarg) {
			case VIDEO_MODE_NTSC:
				bt856_setbit(encoder, 0xdc, 2, 0);
				break;
			case VIDEO_MODE_PAL:
				bt856_setbit(encoder, 0xdc, 2, 1);
				bt856_setbit(encoder, 0xda, 0, 0);
				//bt856_setbit(encoder, 0xda, 0, 1);
				break;
			default:
				return -EINVAL;
			}
			encoder->norm = *iarg;
		}
		break;
	case ENCODER_SET_INPUT:
		{
			int *iarg = arg;
			DEBUG(printk(KERN_INFO "%s-bt856: set input %dn",
				     encoder->bus->name, *iarg));
			/*     We only have video bus.
			   *iarg = 0: input is from bt819
			   *iarg = 1: input is from ZR36060 */
			switch (*iarg) {
			case 0:
				bt856_setbit(encoder, 0xde, 4, 0);
				bt856_setbit(encoder, 0xde, 3, 1);
				bt856_setbit(encoder, 0xdc, 3, 1);
				bt856_setbit(encoder, 0xdc, 6, 0);
				break;
			case 1:
				bt856_setbit(encoder, 0xde, 4, 0);
				bt856_setbit(encoder, 0xde, 3, 1);
				bt856_setbit(encoder, 0xdc, 3, 1);
				bt856_setbit(encoder, 0xdc, 6, 1);
				break;
			case 2:	// Color bar
				bt856_setbit(encoder, 0xdc, 3, 0);
				bt856_setbit(encoder, 0xde, 4, 1);
				break;
			default:
				return -EINVAL;
			}
		}
		break;
	case ENCODER_SET_OUTPUT:
		{
			int *iarg = arg;
			DEBUG(printk(KERN_INFO "%s-bt856: set output %dn",
				     encoder->bus->name, *iarg));
			/* not much choice of outputs */
			if (*iarg != 0) {
				return -EINVAL;
			}
		}
		break;
	case ENCODER_ENABLE_OUTPUT:
		{
			int *iarg = arg;
			encoder->enable = !!*iarg;
			DEBUG(printk
			      (KERN_INFO "%s-bt856: enable output %dn",
			       encoder->bus->name, encoder->enable));
		}
		break;
	default:
		return -EINVAL;
	}
	return 0;
}
/* ----------------------------------------------------------------------- */
static struct i2c_driver i2c_driver_bt856 = {
	"bt856",		/* name */
	I2C_DRIVERID_VIDEOENCODER,	/* ID */
	I2C_BT856, I2C_BT856 + 1,
	bt856_attach,
	bt856_detach,
	bt856_command
};
EXPORT_NO_SYMBOLS;
static int bt856_init(void)
{
	return i2c_register_driver(&i2c_driver_bt856);
}
static void bt856_exit(void)
{
	i2c_unregister_driver(&i2c_driver_bt856);
}
module_init(bt856_init);
module_exit(bt856_exit);
MODULE_LICENSE("GPL");

						