/* * Zoran ZR36016 basic configuration functions * * Copyright (C) 2001 Wolfgang Scherr * * $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 #include #include #include #include #include /* I/O commands, error codes */ #include /* 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 (imode == 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 "); MODULE_DESCRIPTION("Driver module for ZR36016 video frontends " ZR016_VERSION); MODULE_LICENSE("GPL");