1 files changed, 524 insertions, 0 deletions

diff --git a/drivers/media/video/zoran/zr36016.c b/drivers/media/video/zoran/zr36016.c
new file mode 100644
index 00000000000..21c088ea904
--- /dev/null
+++ b/drivers/media/video/zoran/zr36016.c
@@ -0,0 +1,524 @@
+/*
+ * Zoran ZR36016 basic configuration functions
+ *
+ * Copyright (C) 2001 Wolfgang Scherr <scherr@net4you.at>
+ *
+ * $Id: zr36016.c,v 1.1.2.14 2003/08/20 19:46:55 rbultje Exp $
+ *
+ * ------------------------------------------------------------------------
+ *
+ * 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.
+ *
+ * ------------------------------------------------------------------------
+ */
+
+#define ZR016_VERSION "v0.7"
+
+#include <linux/module.h>
+#include <linux/init.h>
+#include <linux/slab.h>
+#include <linux/delay.h>
+
+#include <linux/types.h>
+#include <linux/wait.h>
+
+/* I/O commands, error codes */
+#include <asm/io.h>
+
+/* v4l  API */
+
+/* headerfile of this module */
+#include"zr36016.h"
+
+/* codec io API */
+#include"videocodec.h"
+
+/* it doesn't make sense to have more than 20 or so,
+  just to prevent some unwanted loops */
+#define MAX_CODECS 20
+
+/* amount of chips attached via this driver */
+static int zr36016_codecs;
+
+/* debugging is available via module parameter */
+static int debug;
+module_param(debug, int, 0);
+MODULE_PARM_DESC(debug, "Debug level (0-4)");
+
+#define dprintk(num, format, args...) \
+        do { \
+                if (debug >= num) \
+                        printk(format, ##args); \
+        } while (0)
+
+/* =========================================================================
+   Local hardware I/O functions:
+
+   read/write via codec layer (registers are located in the master device)
+   ========================================================================= */
+
+/* read and write functions */
+static u8
+zr36016_read (struct zr36016 *ptr,
+              u16             reg)
+{
+        u8 value = 0;
+
+        // just in case something is wrong...
+        if (ptr->codec->master_data->readreg)
+                value =
+                    (ptr->codec->master_data->
+                     readreg(ptr->codec, reg)) & 0xFF;
+        else
+                dprintk(1,
+                        KERN_ERR "%s: invalid I/O setup, nothing read!\n",
+                        ptr->name);
+
+        dprintk(4, "%s: reading from 0x%04x: %02x\n", ptr->name, reg,
+                value);
+
+        return value;
+}
+
+static void
+zr36016_write (struct zr36016 *ptr,
+               u16             reg,
+               u8              value)
+{
+        dprintk(4, "%s: writing 0x%02x to 0x%04x\n", ptr->name, value,
+                reg);
+
+        // just in case something is wrong...
+        if (ptr->codec->master_data->writereg) {
+                ptr->codec->master_data->writereg(ptr->codec, reg, value);
+        } else
+                dprintk(1,
+                        KERN_ERR
+                        "%s: invalid I/O setup, nothing written!\n",
+                        ptr->name);
+}
+
+/* indirect read and write functions */
+/* the 016 supports auto-addr-increment, but
+ * writing it all time cost not much and is safer... */
+static u8
+zr36016_readi (struct zr36016 *ptr,
+               u16             reg)
+{
+        u8 value = 0;
+
+        // just in case something is wrong...
+        if ((ptr->codec->master_data->writereg) &&
+            (ptr->codec->master_data->readreg)) {
+                ptr->codec->master_data->writereg(ptr->codec, ZR016_IADDR, reg & 0x0F); // ADDR
+                value = (ptr->codec->master_data->readreg(ptr->codec, ZR016_IDATA)) & 0xFF;     // DATA
+        } else
+                dprintk(1,
+                        KERN_ERR
+                        "%s: invalid I/O setup, nothing read (i)!\n",
+                        ptr->name);
+
+        dprintk(4, "%s: reading indirect from 0x%04x: %02x\n", ptr->name,
+                reg, value);
+        return value;
+}
+
+static void
+zr36016_writei (struct zr36016 *ptr,
+                u16             reg,
+                u8              value)
+{
+        dprintk(4, "%s: writing indirect 0x%02x to 0x%04x\n", ptr->name,
+                value, reg);
+
+        // just in case something is wrong...
+        if (ptr->codec->master_data->writereg) {
+                ptr->codec->master_data->writereg(ptr->codec, ZR016_IADDR, reg & 0x0F); // ADDR
+                ptr->codec->master_data->writereg(ptr->codec, ZR016_IDATA, value & 0x0FF);      // DATA
+        } else
+                dprintk(1,
+                        KERN_ERR
+                        "%s: invalid I/O setup, nothing written (i)!\n",
+                        ptr->name);
+}
+
+/* =========================================================================
+   Local helper function:
+
+   version read
+   ========================================================================= */
+
+/* version kept in datastructure */
+static u8
+zr36016_read_version (struct zr36016 *ptr)
+{
+        ptr->version = zr36016_read(ptr, 0) >> 4;
+        return ptr->version;
+}
+
+/* =========================================================================
+   Local helper function:
+
+   basic test of "connectivity", writes/reads to/from PAX-Lo register
+   ========================================================================= */
+
+static int
+zr36016_basic_test (struct zr36016 *ptr)
+{
+        if (debug) {
+                int i;
+                zr36016_writei(ptr, ZR016I_PAX_LO, 0x55);
+                dprintk(1, KERN_INFO "%s: registers: ", ptr->name);
+                for (i = 0; i <= 0x0b; i++)
+                        dprintk(1, "%02x ", zr36016_readi(ptr, i));
+                dprintk(1, "\n");
+        }
+        // for testing just write 0, then the default value to a register and read
+        // it back in both cases
+        zr36016_writei(ptr, ZR016I_PAX_LO, 0x00);
+        if (zr36016_readi(ptr, ZR016I_PAX_LO) != 0x0) {
+                dprintk(1,
+                        KERN_ERR
+                        "%s: attach failed, can't connect to vfe processor!\n",
+                        ptr->name);
+                return -ENXIO;
+        }
+        zr36016_writei(ptr, ZR016I_PAX_LO, 0x0d0);
+        if (zr36016_readi(ptr, ZR016I_PAX_LO) != 0x0d0) {
+                dprintk(1,
+                        KERN_ERR
+                        "%s: attach failed, can't connect to vfe processor!\n",
+                        ptr->name);
+                return -ENXIO;
+        }
+        // we allow version numbers from 0-3, should be enough, though
+        zr36016_read_version(ptr);
+        if (ptr->version & 0x0c) {
+                dprintk(1,
+                        KERN_ERR
+                        "%s: attach failed, suspicious version %d found...\n",
+                        ptr->name, ptr->version);
+                return -ENXIO;
+        }
+
+        return 0;               /* looks good! */
+}
+
+/* =========================================================================
+   Local helper function:
+
+   simple loop for pushing the init datasets - NO USE --
+   ========================================================================= */
+
+#if 0
+static int zr36016_pushit (struct zr36016 *ptr,
+                           u16             startreg,
+                           u16             len,
+                           const char     *data)
+{
+        int i=0;
+
+        dprintk(4, "%s: write data block to 0x%04x (len=%d)\n",
+                ptr->name, startreg,len);
+        while (i<len) {
+                zr36016_writei(ptr, startreg++,  data[i++]);
+        }
+
+        return i;
+}
+#endif
+
+/* =========================================================================
+   Basic datasets & init:
+
+   //TODO//
+   ========================================================================= */
+
+// needed offset values          PAL NTSC SECAM
+static const int zr016_xoff[] = { 20, 20, 20 };
+static const int zr016_yoff[] = { 8, 9, 7 };
+
+static void
+zr36016_init (struct zr36016 *ptr)
+{
+        // stop any processing
+        zr36016_write(ptr, ZR016_GOSTOP, 0);
+
+        // mode setup (yuv422 in and out, compression/expansuon due to mode)
+        zr36016_write(ptr, ZR016_MODE,
+                      ZR016_YUV422 | ZR016_YUV422_YUV422 |
+                      (ptr->mode == CODEC_DO_COMPRESSION ?
+                       ZR016_COMPRESSION : ZR016_EXPANSION));
+
+        // misc setup
+        zr36016_writei(ptr, ZR016I_SETUP1,
+                       (ptr->xdec ? (ZR016_HRFL | ZR016_HORZ) : 0) |
+                       (ptr->ydec ? ZR016_VERT : 0) | ZR016_CNTI);
+        zr36016_writei(ptr, ZR016I_SETUP2, ZR016_CCIR);
+
+        // Window setup
+        // (no extra offset for now, norm defines offset, default width height)
+        zr36016_writei(ptr, ZR016I_PAX_HI, ptr->width >> 8);
+        zr36016_writei(ptr, ZR016I_PAX_LO, ptr->width & 0xFF);
+        zr36016_writei(ptr, ZR016I_PAY_HI, ptr->height >> 8);
+        zr36016_writei(ptr, ZR016I_PAY_LO, ptr->height & 0xFF);
+        zr36016_writei(ptr, ZR016I_NAX_HI, ptr->xoff >> 8);
+        zr36016_writei(ptr, ZR016I_NAX_LO, ptr->xoff & 0xFF);
+        zr36016_writei(ptr, ZR016I_NAY_HI, ptr->yoff >> 8);
+        zr36016_writei(ptr, ZR016I_NAY_LO, ptr->yoff & 0xFF);
+
+        /* shall we continue now, please? */
+        zr36016_write(ptr, ZR016_GOSTOP, 1);
+}
+
+/* =========================================================================
+   CODEC API FUNCTIONS
+
+   this functions are accessed by the master via the API structure
+   ========================================================================= */
+
+/* set compression/expansion mode and launches codec -
+   this should be the last call from the master before starting processing */
+static int
+zr36016_set_mode (struct videocodec *codec,
+                  int                mode)
+{
+        struct zr36016 *ptr = (struct zr36016 *) codec->data;
+
+        dprintk(2, "%s: set_mode %d call\n", ptr->name, mode);
+
+        if ((mode != CODEC_DO_EXPANSION) && (mode != CODEC_DO_COMPRESSION))
+                return -EINVAL;
+
+        ptr->mode = mode;
+        zr36016_init(ptr);
+
+        return 0;
+}
+
+/* set picture size */
+static int
+zr36016_set_video (struct videocodec   *codec,
+                   struct tvnorm       *norm,
+                   struct vfe_settings *cap,
+                   struct vfe_polarity *pol)
+{
+        struct zr36016 *ptr = (struct zr36016 *) codec->data;
+
+        dprintk(2, "%s: set_video %d.%d, %d/%d-%dx%d (0x%x) call\n",
+                ptr->name, norm->HStart, norm->VStart,
+                cap->x, cap->y, cap->width, cap->height,
+                cap->decimation);
+
+        /* if () return -EINVAL;
+         * trust the master driver that it knows what it does - so
+         * we allow invalid startx/y for now ... */
+        ptr->width = cap->width;
+        ptr->height = cap->height;
+        /* (Ronald) This is ugly. zoran_device.c, line 387
+         * already mentions what happens if HStart is even
+         * (blue faces, etc., cr/cb inversed). There's probably
+         * some good reason why HStart is 0 instead of 1, so I'm
+         * leaving it to this for now, but really... This can be
+         * done a lot simpler */
+        ptr->xoff = (norm->HStart ? norm->HStart : 1) + cap->x;
+        /* Something to note here (I don't understand it), setting
+         * VStart too high will cause the codec to 'not work'. I
+         * really don't get it. values of 16 (VStart) already break
+         * it here. Just '0' seems to work. More testing needed! */
+        ptr->yoff = norm->VStart + cap->y;
+        /* (Ronald) dzjeeh, can't this thing do hor_decimation = 4? */
+        ptr->xdec = ((cap->decimation & 0xff) == 1) ? 0 : 1;
+        ptr->ydec = (((cap->decimation >> 8) & 0xff) == 1) ? 0 : 1;
+
+        return 0;
+}
+
+/* additional control functions */
+static int
+zr36016_control (struct videocodec *codec,
+                 int                type,
+                 int                size,
+                 void              *data)
+{
+        struct zr36016 *ptr = (struct zr36016 *) codec->data;
+        int *ival = (int *) data;
+
+        dprintk(2, "%s: control %d call with %d byte\n", ptr->name, type,
+                size);
+
+        switch (type) {
+        case CODEC_G_STATUS:    /* get last status - we don't know it ... */
+                if (size != sizeof(int))
+                        return -EFAULT;
+                *ival = 0;
+                break;
+
+        case CODEC_G_CODEC_MODE:
+                if (size != sizeof(int))
+                        return -EFAULT;
+                *ival = 0;
+                break;
+
+        case CODEC_S_CODEC_MODE:
+                if (size != sizeof(int))
+                        return -EFAULT;
+                if (*ival != 0)
+                        return -EINVAL;
+                /* not needed, do nothing */
+                return 0;
+
+        case CODEC_G_VFE:
+        case CODEC_S_VFE:
+                return 0;
+
+        case CODEC_S_MMAP:
+                /* not available, give an error */
+                return -ENXIO;
+
+        default:
+                return -EINVAL;
+        }
+
+        return size;
+}
+
+/* =========================================================================
+   Exit and unregister function:
+
+   Deinitializes Zoran's JPEG processor
+   ========================================================================= */
+
+static int
+zr36016_unset (struct videocodec *codec)
+{
+        struct zr36016 *ptr = codec->data;
+
+        if (ptr) {
+                /* do wee need some codec deinit here, too ???? */
+
+                dprintk(1, "%s: finished codec #%d\n", ptr->name,
+                        ptr->num);
+                kfree(ptr);
+                codec->data = NULL;
+
+                zr36016_codecs--;
+                return 0;
+        }
+
+        return -EFAULT;
+}
+
+/* =========================================================================
+   Setup and registry function:
+
+   Initializes Zoran's JPEG processor
+
+   Also sets pixel size, average code size, mode (compr./decompr.)
+   (the given size is determined by the processor with the video interface)
+   ========================================================================= */
+
+static int
+zr36016_setup (struct videocodec *codec)
+{
+        struct zr36016 *ptr;
+        int res;
+
+        dprintk(2, "zr36016: initializing VFE subsystem #%d.\n",
+                zr36016_codecs);
+
+        if (zr36016_codecs == MAX_CODECS) {
+                dprintk(1,
+                        KERN_ERR "zr36016: Can't attach more codecs!\n");
+                return -ENOSPC;
+        }
+        //mem structure init
+        codec->data = ptr = kzalloc(sizeof(struct zr36016), GFP_KERNEL);
+        if (NULL == ptr) {
+                dprintk(1, KERN_ERR "zr36016: Can't get enough memory!\n");
+                return -ENOMEM;
+        }
+
+        snprintf(ptr->name, sizeof(ptr->name), "zr36016[%d]",
+                 zr36016_codecs);
+        ptr->num = zr36016_codecs++;
+        ptr->codec = codec;
+
+        //testing
+        res = zr36016_basic_test(ptr);
+        if (res < 0) {
+                zr36016_unset(codec);
+                return res;
+        }
+        //final setup
+        ptr->mode = CODEC_DO_COMPRESSION;
+        ptr->width = 768;
+        ptr->height = 288;
+        ptr->xdec = 1;
+        ptr->ydec = 0;
+        zr36016_init(ptr);
+
+        dprintk(1, KERN_INFO "%s: codec v%d attached and running\n",
+                ptr->name, ptr->version);
+
+        return 0;
+}
+
+static const struct videocodec zr36016_codec = {
+        .owner = THIS_MODULE,
+        .name = "zr36016",
+        .magic = 0L,            // magic not used
+        .flags =
+            CODEC_FLAG_HARDWARE | CODEC_FLAG_VFE | CODEC_FLAG_ENCODER |
+            CODEC_FLAG_DECODER,
+        .type = CODEC_TYPE_ZR36016,
+        .setup = zr36016_setup, // functionality
+        .unset = zr36016_unset,
+        .set_mode = zr36016_set_mode,
+        .set_video = zr36016_set_video,
+        .control = zr36016_control,
+        // others are not used
+};
+
+/* =========================================================================
+   HOOK IN DRIVER AS KERNEL MODULE
+   ========================================================================= */
+
+static int __init
+zr36016_init_module (void)
+{
+        //dprintk(1, "ZR36016 driver %s\n",ZR016_VERSION);
+        zr36016_codecs = 0;
+        return videocodec_register(&zr36016_codec);
+}
+
+static void __exit
+zr36016_cleanup_module (void)
+{
+        if (zr36016_codecs) {
+                dprintk(1,
+                        "zr36016: something's wrong - %d codecs left somehow.\n",
+                        zr36016_codecs);
+        }
+        videocodec_unregister(&zr36016_codec);
+}
+
+module_init(zr36016_init_module);
+module_exit(zr36016_cleanup_module);
+
+MODULE_AUTHOR("Wolfgang Scherr <scherr@net4you.at>");
+MODULE_DESCRIPTION("Driver module for ZR36016 video frontends "
+                   ZR016_VERSION);
+MODULE_LICENSE("GPL");