linux-imx

/*

    bt866 - BT866 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 code was adapted for the bt866 by Christer Weinigel and ported

    to 2.6 by Martin Samuelsson.

​

    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/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("Brooktree-866 video encoder driver");

MODULE_AUTHOR("Mike Bernson & Dave Perks");

MODULE_LICENSE("GPL");

​

static int debug;

module_param(debug, int, 0);

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

​

​

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

​

struct bt866 {

    struct v4l2_subdev sd;

    u8 reg[256];

};

​

static inline struct bt866 *to_bt866(struct v4l2_subdev *sd)

{

    return container_of(sd, struct bt866, sd);

}

​

static int bt866_write(struct bt866 *encoder, u8 subaddr, u8 data)

{

    struct i2c_client *client = v4l2_get_subdevdata(&encoder->sd);

    u8 buffer[2];

    int err;

​

    buffer[0] = subaddr;

    buffer[1] = data;

​

    encoder->reg[subaddr] = data;

​

    v4l_dbg(1, debug, client, "write 0x%02x = 0x%02x\n", subaddr, data);

​

    for (err = 0; err < 3;) {

        if (i2c_master_send(client, buffer, 2) == 2)

            break;

        err++;

        v4l_warn(client, "error #%d writing to 0x%02x\n",

                err, subaddr);

        schedule_timeout_interruptible(msecs_to_jiffies(100));

    }

    if (err == 3) {

        v4l_warn(client, "giving up\n");

        return -1;

    }

​

    return 0;

}

​

static int bt866_s_std_output(struct v4l2_subdev *sd, v4l2_std_id std)

{

    v4l2_dbg(1, debug, sd, "set norm %llx\n", (unsigned long long)std);