forked from Minki/linux
bcb63314e2
Drop the FSF's postal address from the source code files that typically contain mostly the license text. Of the 628 removed instances, 578 are outdated. The patch has been created with the following command without manual edits: git grep -l "675 Mass Ave\|59 Temple Place\|51 Franklin St" -- \ drivers/media/ include/media|while read i; do i=$i perl -e ' open(F,"< $ENV{i}"); $a=join("", <F>); $a =~ s/[ \t]*\*\n.*You should.*\n.*along with.*\n.*(\n.*USA.*$)?\n//m && $a =~ s/(^.*)Or, (point your browser to) /$1To obtain the license, $2\n$1/m; close(F); open(F, "> $ENV{i}"); print F $a; close(F);'; done Signed-off-by: Sakari Ailus <sakari.ailus@linux.intel.com>
517 lines
14 KiB
C
517 lines
14 KiB
C
/*
|
|
* 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.
|
|
*
|
|
* ------------------------------------------------------------------------
|
|
*/
|
|
|
|
#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//
|
|
========================================================================= */
|
|
|
|
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");
|