linux-imx

/*

 * saa7185 - Philips SAA7185B video encoder driver version 0.0.3

 *

 * Copyright (C) 1998 Dave Perks <dperks@ibm.net>

 *

 * Slight changes for video timing and attachment output by

 * Wolfgang Scherr <scherr@net4you.net>

 *

 * Changes by Ronald Bultje <rbultje@ronald.bitfreak.net>

 *    - moved over to linux>=2.4.x i2c protocol (1/1/2003)

 *

 * 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.

 */

​

#include <linux/module.h>

#include <linux/types.h>

#include <linux/slab.h>

#include <linux/ioctl.h>

#include <linux/uaccess.h>

#include <linux/i2c.h>

#include <linux/videodev2.h>

#include <media/v4l2-device.h>

​

MODULE_DESCRIPTION("Philips SAA7185 video encoder driver");

MODULE_AUTHOR("Dave Perks");

MODULE_LICENSE("GPL");

​

static int debug;

module_param(debug, int, 0);

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

​

​

/* ----------------------------------------------------------------------- */

​

struct saa7185 {

    struct v4l2_subdev sd;

    unsigned char reg[128];

​

    v4l2_std_id norm;

};

​

static inline struct saa7185 *to_saa7185(struct v4l2_subdev *sd)

{

    return container_of(sd, struct saa7185, sd);

}

​

/* ----------------------------------------------------------------------- */

​

static inline int saa7185_read(struct v4l2_subdev *sd)

{

    struct i2c_client *client = v4l2_get_subdevdata(sd);

​

    return i2c_smbus_read_byte(client);

}

​

static int saa7185_write(struct v4l2_subdev *sd, u8 reg, u8 value)

{

    struct i2c_client *client = v4l2_get_subdevdata(sd);

    struct saa7185 *encoder = to_saa7185(sd);

​

    v4l2_dbg(1, debug, sd, "%02x set to %02x\n", reg, value);

    encoder->reg[reg] = value;

    return i2c_smbus_write_byte_data(client, reg, value);

}

​

static int saa7185_write_block(struct v4l2_subdev *sd,

        const u8 *data, unsigned int len)

{

    struct i2c_client *client = v4l2_get_subdevdata(sd);

    struct saa7185 *encoder = to_saa7185(sd);

    int ret = -1;

    u8 reg;

​

    /* the adv7175 has an autoincrement function, use it if

     * the adapter understands raw I2C */

    if (i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) {

        /* do raw I2C, not smbus compatible */

        u8 block_data[32];

        int block_len;

​

        while (len >= 2) {

            block_len = 0;

            block_data[block_len++] = reg = data[0];

            do {