drivers/media/video/zr36060.c

   1 /*
   2  * Zoran ZR36060 basic configuration functions
   3  *
   4  * Copyright (C) 2002 Laurent Pinchart <laurent.pinchart@skynet.be>
   5  *
   6  * $Id: zr36060.c,v 1.1.2.22 2003/05/06 09:35:36 rbultje Exp $
   7  *
   8  * ------------------------------------------------------------------------
   9  *
  10  * This program is free software; you can redistribute it and/or modify
  11  * it under the terms of the GNU General Public License as published by
  12  * the Free Software Foundation; either version 2 of the License, or
  13  * (at your option) any later version.
  14  *
  15  * This program is distributed in the hope that it will be useful,
  16  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  17  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  18  * GNU General Public License for more details.
  19  *
  20  * You should have received a copy of the GNU General Public License
  21  * along with this program; if not, write to the Free Software
  22  * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  23  *
  24  * ------------------------------------------------------------------------
  25  */
  26
  27 #define ZR060_VERSION "v0.7"
  28
  29 #include <linux/version.h>
  30 #include <linux/module.h>
  31 #include <linux/init.h>
  32 #include <linux/slab.h>
  33 #include <linux/delay.h>
  34
  35 #include <linux/types.h>
  36 #include <linux/wait.h>
  37
  38 /* includes for structures and defines regarding video
  39    #include<linux/videodev.h> */
  40
  41 /* I/O commands, error codes */
  42 #include<asm/io.h>
  43 //#include<errno.h>
  44
  45 /* headerfile of this module */
  46 #include"zr36060.h"
  47
  48 /* codec io API */
  49 #include"videocodec.h"
  50
  51 /* it doesn't make sense to have more than 20 or so,
  52   just to prevent some unwanted loops */
  53 #define MAX_CODECS 20
  54
  55 /* amount of chips attached via this driver */
  56 static int zr36060_codecs = 0;
  57
  58 static int low_bitrate = 0;
  59 module_param(low_bitrate, bool, 0);
  60 MODULE_PARM_DESC(low_bitrate, "Buz compatibility option, halves bitrate");
  61
  62 /* debugging is available via module parameter */
  63 static int debug = 0;
  64 module_param(debug, int, 0);
  65 MODULE_PARM_DESC(debug, "Debug level (0-4)");
  66
  67 #define dprintk(num, format, args...) \
  68         do { \
  69                 if (debug >= num) \
  70                         printk(format, ##args); \
  71         } while (0)
  72
  73 /* =========================================================================
  74    Local hardware I/O functions:
  75
  76    read/write via codec layer (registers are located in the master device)
  77    ========================================================================= */
  78
  79 /* read and write functions */
  80 static u8
  81 zr36060_read (struct zr36060 *ptr,
  82               u16             reg)
  83 {
  84         u8 value = 0;
  85
  86         // just in case something is wrong...
  87         if (ptr->codec->master_data->readreg)
  88                 value = (ptr->codec->master_data->readreg(ptr->codec,
  89                                                           reg)) & 0xff;
  90         else
  91                 dprintk(1,
  92                         KERN_ERR "%s: invalid I/O setup, nothing read!\n",
  93                         ptr->name);
  94
  95         //dprintk(4, "%s: reading from 0x%04x: %02x\n",ptr->name,reg,value);
  96
  97         return value;
  98 }
  99
 100 static void
 101 zr36060_write(struct zr36060 *ptr,
 102               u16             reg,
 103               u8              value)
 104 {
 105         //dprintk(4, "%s: writing 0x%02x to 0x%04x\n",ptr->name,value,reg);
 106         dprintk(4, "0x%02x @0x%04x\n", value, reg);
 107
 108         // just in case something is wrong...
 109         if (ptr->codec->master_data->writereg)
 110                 ptr->codec->master_data->writereg(ptr->codec, reg, value);
 111         else
 112                 dprintk(1,
 113                         KERN_ERR
 114                         "%s: invalid I/O setup, nothing written!\n",
 115                         ptr->name);
 116 }
 117
 118 /* =========================================================================
 119    Local helper function:
 120
 121    status read
 122    ========================================================================= */
 123
 124 /* status is kept in datastructure */
 125 static u8
 126 zr36060_read_status (struct zr36060 *ptr)
 127 {
 128         ptr->status = zr36060_read(ptr, ZR060_CFSR);
 129
 130         zr36060_read(ptr, 0);
 131         return ptr->status;
 132 }
 133
 134 /* =========================================================================
 135    Local helper function:
 136
 137    scale factor read
 138    ========================================================================= */
 139
 140 /* scale factor is kept in datastructure */
 141 static u16
 142 zr36060_read_scalefactor (struct zr36060 *ptr)
 143 {
 144         ptr->scalefact = (zr36060_read(ptr, ZR060_SF_HI) << 8) |
 145                          (zr36060_read(ptr, ZR060_SF_LO) & 0xFF);
 146
 147         /* leave 0 selected for an eventually GO from master */
 148         zr36060_read(ptr, 0);
 149         return ptr->scalefact;
 150 }
 151
 152 /* =========================================================================
 153    Local helper function:
 154
 155    wait if codec is ready to proceed (end of processing) or time is over
 156    ========================================================================= */
 157
 158 static void
 159 zr36060_wait_end (struct zr36060 *ptr)
 160 {
 161         int i = 0;
 162
 163         while (zr36060_read_status(ptr) & ZR060_CFSR_Busy) {
 164                 udelay(1);
 165                 if (i++ > 200000) {     // 200ms, there is for shure something wrong!!!
 166                         dprintk(1,
 167                                 "%s: timout at wait_end (last status: 0x%02x)\n",
 168                                 ptr->name, ptr->status);
 169                         break;
 170                 }
 171         }
 172 }
 173
 174 /* =========================================================================
 175    Local helper function:
 176
 177    basic test of "connectivity", writes/reads to/from memory the SOF marker
 178    ========================================================================= */
 179
 180 static int
 181 zr36060_basic_test (struct zr36060 *ptr)
 182 {
 183         if ((zr36060_read(ptr, ZR060_IDR_DEV) != 0x33) &&
 184             (zr36060_read(ptr, ZR060_IDR_REV) != 0x01)) {
 185                 dprintk(1,
 186                         KERN_ERR
 187                         "%s: attach failed, can't connect to jpeg processor!\n",
 188                         ptr->name);
 189                 return -ENXIO;
 190         }
 191
 192         zr36060_wait_end(ptr);
 193         if (ptr->status & ZR060_CFSR_Busy) {
 194                 dprintk(1,
 195                         KERN_ERR
 196                         "%s: attach failed, jpeg processor failed (end flag)!\n",
 197                         ptr->name);
 198                 return -EBUSY;
 199         }
 200
 201         return 0;               /* looks good! */
 202 }
 203
 204 /* =========================================================================
 205    Local helper function:
 206
 207    simple loop for pushing the init datasets
 208    ========================================================================= */
 209
 210 static int
 211 zr36060_pushit (struct zr36060 *ptr,
 212                 u16             startreg,
 213                 u16             len,
 214                 const char     *data)
 215 {
 216         int i = 0;
 217
 218         dprintk(4, "%s: write data block to 0x%04x (len=%d)\n", ptr->name,
 219                 startreg, len);
 220         while (i < len) {
 221                 zr36060_write(ptr, startreg++, data[i++]);
 222         }
 223
 224         return i;
 225 }
 226
 227 /* =========================================================================
 228    Basic datasets:
 229
 230    jpeg baseline setup data (you find it on lots places in internet, or just
 231    extract it from any regular .jpg image...)
 232
 233    Could be variable, but until it's not needed it they are just fixed to save
 234    memory. Otherwise expand zr36060 structure with arrays, push the values to
 235    it and initalize from there, as e.g. the linux zr36057/60 driver does it.
 236    ========================================================================= */
 237
 238 static const char zr36060_dqt[0x86] = {
 239         0xff, 0xdb,             //Marker: DQT
 240         0x00, 0x84,             //Length: 2*65+2
 241         0x00,                   //Pq,Tq first table
 242         0x10, 0x0b, 0x0c, 0x0e, 0x0c, 0x0a, 0x10, 0x0e,
 243         0x0d, 0x0e, 0x12, 0x11, 0x10, 0x13, 0x18, 0x28,
 244         0x1a, 0x18, 0x16, 0x16, 0x18, 0x31, 0x23, 0x25,
 245         0x1d, 0x28, 0x3a, 0x33, 0x3d, 0x3c, 0x39, 0x33,
 246         0x38, 0x37, 0x40, 0x48, 0x5c, 0x4e, 0x40, 0x44,
 247         0x57, 0x45, 0x37, 0x38, 0x50, 0x6d, 0x51, 0x57,
 248         0x5f, 0x62, 0x67, 0x68, 0x67, 0x3e, 0x4d, 0x71,
 249         0x79, 0x70, 0x64, 0x78, 0x5c, 0x65, 0x67, 0x63,
 250         0x01,                   //Pq,Tq second table
 251         0x11, 0x12, 0x12, 0x18, 0x15, 0x18, 0x2f, 0x1a,
 252         0x1a, 0x2f, 0x63, 0x42, 0x38, 0x42, 0x63, 0x63,
 253         0x63, 0x63, 0x63, 0x63, 0x63, 0x63, 0x63, 0x63,
 254         0x63, 0x63, 0x63, 0x63, 0x63, 0x63, 0x63, 0x63,
 255         0x63, 0x63, 0x63, 0x63, 0x63, 0x63, 0x63, 0x63,
 256         0x63, 0x63, 0x63, 0x63, 0x63, 0x63, 0x63, 0x63,
 257         0x63, 0x63, 0x63, 0x63, 0x63, 0x63, 0x63, 0x63,
 258         0x63, 0x63, 0x63, 0x63, 0x63, 0x63, 0x63, 0x63
 259 };
 260
 261 static const char zr36060_dht[0x1a4] = {
 262         0xff, 0xc4,             //Marker: DHT
 263         0x01, 0xa2,             //Length: 2*AC, 2*DC
 264         0x00,                   //DC first table
 265         0x00, 0x01, 0x05, 0x01, 0x01, 0x01, 0x01, 0x01,
 266         0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x01,
 267         0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0A, 0x0B,
 268         0x01,                   //DC second table
 269         0x00, 0x03, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01,
 270         0x01, 0x01, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x01,
 271         0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0A, 0x0B,
 272         0x10,                   //AC first table
 273         0x00, 0x02, 0x01, 0x03, 0x03, 0x02, 0x04, 0x03,
 274         0x05, 0x05, 0x04, 0x04, 0x00, 0x00,
 275         0x01, 0x7D, 0x01, 0x02, 0x03, 0x00, 0x04, 0x11,
 276         0x05, 0x12, 0x21, 0x31, 0x41, 0x06, 0x13, 0x51, 0x61,
 277         0x07, 0x22, 0x71, 0x14, 0x32, 0x81, 0x91, 0xA1,
 278         0x08, 0x23, 0x42, 0xB1, 0xC1, 0x15, 0x52, 0xD1, 0xF0, 0x24,
 279         0x33, 0x62, 0x72, 0x82, 0x09, 0x0A, 0x16, 0x17,
 280         0x18, 0x19, 0x1A, 0x25, 0x26, 0x27, 0x28, 0x29, 0x2A, 0x34,
 281         0x35, 0x36, 0x37, 0x38, 0x39, 0x3A, 0x43, 0x44,
 282         0x45, 0x46, 0x47, 0x48, 0x49, 0x4A, 0x53, 0x54, 0x55, 0x56,
 283         0x57, 0x58, 0x59, 0x5A, 0x63, 0x64, 0x65, 0x66,
 284         0x67, 0x68, 0x69, 0x6A, 0x73, 0x74, 0x75, 0x76, 0x77, 0x78,
 285         0x79, 0x7A, 0x83, 0x84, 0x85, 0x86, 0x87, 0x88,
 286         0x89, 0x8A, 0x92, 0x93, 0x94, 0x95, 0x96, 0x97, 0x98, 0x99,
 287         0x9A, 0xA2, 0xA3, 0xA4, 0xA5, 0xA6, 0xA7, 0xA8,
 288         0xA9, 0xAA, 0xB2, 0xB3, 0xB4, 0xB5, 0xB6, 0xB7, 0xB8, 0xB9,
 289         0xBA, 0xC2, 0xC3, 0xC4, 0xC5, 0xC6, 0xC7, 0xC8,
 290         0xC9, 0xCA, 0xD2, 0xD3, 0xD4, 0xD5, 0xD6, 0xD7, 0xD8, 0xD9,
 291         0xDA, 0xE1, 0xE2, 0xE3, 0xE4, 0xE5, 0xE6, 0xE7,
 292         0xE8, 0xE9, 0xEA, 0xF1, 0xF2, 0xF3, 0xF4, 0xF5, 0xF6, 0xF7,
 293         0xF8, 0xF9, 0xFA,
 294         0x11,                   //AC second table
 295         0x00, 0x02, 0x01, 0x02, 0x04, 0x04, 0x03, 0x04,
 296         0x07, 0x05, 0x04, 0x04, 0x00, 0x01,
 297         0x02, 0x77, 0x00, 0x01, 0x02, 0x03, 0x11, 0x04,
 298         0x05, 0x21, 0x31, 0x06, 0x12, 0x41, 0x51, 0x07, 0x61, 0x71,
 299         0x13, 0x22, 0x32, 0x81, 0x08, 0x14, 0x42, 0x91,
 300         0xA1, 0xB1, 0xC1, 0x09, 0x23, 0x33, 0x52, 0xF0, 0x15, 0x62,
 301         0x72, 0xD1, 0x0A, 0x16, 0x24, 0x34, 0xE1, 0x25,
 302         0xF1, 0x17, 0x18, 0x19, 0x1A, 0x26, 0x27, 0x28, 0x29, 0x2A,
 303         0x35, 0x36, 0x37, 0x38, 0x39, 0x3A, 0x43, 0x44,
 304         0x45, 0x46, 0x47, 0x48, 0x49, 0x4A, 0x53, 0x54, 0x55, 0x56,
 305         0x57, 0x58, 0x59, 0x5A, 0x63, 0x64, 0x65, 0x66,
 306         0x67, 0x68, 0x69, 0x6A, 0x73, 0x74, 0x75, 0x76, 0x77, 0x78,
 307         0x79, 0x7A, 0x82, 0x83, 0x84, 0x85, 0x86, 0x87,
 308         0x88, 0x89, 0x8A, 0x92, 0x93, 0x94, 0x95, 0x96, 0x97, 0x98,
 309         0x99, 0x9A, 0xA2, 0xA3, 0xA4, 0xA5, 0xA6, 0xA7,
 310         0xA8, 0xA9, 0xAA, 0xB2, 0xB3, 0xB4, 0xB5, 0xB6, 0xB7, 0xB8,
 311         0xB9, 0xBA, 0xC2, 0xC3, 0xC4, 0xC5, 0xC6, 0xC7,
 312         0xC8, 0xC9, 0xCA, 0xD2, 0xD3, 0xD4, 0xD5, 0xD6, 0xD7, 0xD8,
 313         0xD9, 0xDA, 0xE2, 0xE3, 0xE4, 0xE5, 0xE6, 0xE7,
 314         0xE8, 0xE9, 0xEA, 0xF2, 0xF3, 0xF4, 0xF5, 0xF6, 0xF7, 0xF8,
 315         0xF9, 0xFA
 316 };
 317
 318 /* jpeg baseline setup, this is just fixed in this driver (YUV pictures) */
 319 #define NO_OF_COMPONENTS          0x3   //Y,U,V
 320 #define BASELINE_PRECISION        0x8   //MCU size (?)
 321 static const char zr36060_tq[8] = { 0, 1, 1, 0, 0, 0, 0, 0 };   //table idx's QT
 322 static const char zr36060_td[8] = { 0, 1, 1, 0, 0, 0, 0, 0 };   //table idx's DC
 323 static const char zr36060_ta[8] = { 0, 1, 1, 0, 0, 0, 0, 0 };   //table idx's AC
 324
 325 /* horizontal 422 decimation setup (maybe we support 411 or so later, too) */
 326 static const char zr36060_decimation_h[8] = { 2, 1, 1, 0, 0, 0, 0, 0 };
 327 static const char zr36060_decimation_v[8] = { 1, 1, 1, 0, 0, 0, 0, 0 };
 328
 329 /* =========================================================================
 330    Local helper functions:
 331
 332    calculation and setup of parameter-dependent JPEG baseline segments
 333    (needed for compression only)
 334    ========================================================================= */
 335
 336 /* ------------------------------------------------------------------------- */
 337
 338 /* SOF (start of frame) segment depends on width, height and sampling ratio
 339                          of each color component */
 340
 341 static int
 342 zr36060_set_sof (struct zr36060 *ptr)
 343 {
 344         char sof_data[34];      // max. size of register set
 345         int i;
 346
 347         dprintk(3, "%s: write SOF (%dx%d, %d components)\n", ptr->name,
 348                 ptr->width, ptr->height, NO_OF_COMPONENTS);
 349         sof_data[0] = 0xff;
 350         sof_data[1] = 0xc0;
 351         sof_data[2] = 0x00;
 352         sof_data[3] = (3 * NO_OF_COMPONENTS) + 8;
 353         sof_data[4] = BASELINE_PRECISION;       // only '8' possible with zr36060
 354         sof_data[5] = (ptr->height) >> 8;
 355         sof_data[6] = (ptr->height) & 0xff;
 356         sof_data[7] = (ptr->width) >> 8;
 357         sof_data[8] = (ptr->width) & 0xff;
 358         sof_data[9] = NO_OF_COMPONENTS;
 359         for (i = 0; i < NO_OF_COMPONENTS; i++) {
 360                 sof_data[10 + (i * 3)] = i;     // index identifier
 361                 sof_data[11 + (i * 3)] = (ptr->h_samp_ratio[i] << 4) |
 362                                          (ptr->v_samp_ratio[i]); // sampling ratios
 363                 sof_data[12 + (i * 3)] = zr36060_tq[i]; // Q table selection
 364         }
 365         return zr36060_pushit(ptr, ZR060_SOF_IDX,
 366                               (3 * NO_OF_COMPONENTS) + 10, sof_data);
 367 }
 368
 369 /* ------------------------------------------------------------------------- */
 370
 371 /* SOS (start of scan) segment depends on the used scan components
 372                         of each color component */
 373
 374 static int
 375 zr36060_set_sos (struct zr36060 *ptr)
 376 {
 377         char sos_data[16];      // max. size of register set
 378         int i;
 379
 380         dprintk(3, "%s: write SOS\n", ptr->name);
 381         sos_data[0] = 0xff;
 382         sos_data[1] = 0xda;
 383         sos_data[2] = 0x00;
 384         sos_data[3] = 2 + 1 + (2 * NO_OF_COMPONENTS) + 3;
 385         sos_data[4] = NO_OF_COMPONENTS;
 386         for (i = 0; i < NO_OF_COMPONENTS; i++) {
 387                 sos_data[5 + (i * 2)] = i;      // index
 388                 sos_data[6 + (i * 2)] = (zr36060_td[i] << 4) |
 389                                         zr36060_ta[i]; // AC/DC tbl.sel.
 390         }
 391         sos_data[2 + 1 + (2 * NO_OF_COMPONENTS) + 2] = 00;      // scan start
 392         sos_data[2 + 1 + (2 * NO_OF_COMPONENTS) + 3] = 0x3f;
 393         sos_data[2 + 1 + (2 * NO_OF_COMPONENTS) + 4] = 00;
 394         return zr36060_pushit(ptr, ZR060_SOS_IDX,
 395                               4 + 1 + (2 * NO_OF_COMPONENTS) + 3,
 396                               sos_data);
 397 }
 398
 399 /* ------------------------------------------------------------------------- */
 400
 401 /* DRI (define restart interval) */
 402
 403 static int
 404 zr36060_set_dri (struct zr36060 *ptr)
 405 {
 406         char dri_data[6];       // max. size of register set
 407
 408         dprintk(3, "%s: write DRI\n", ptr->name);
 409         dri_data[0] = 0xff;
 410         dri_data[1] = 0xdd;
 411         dri_data[2] = 0x00;
 412         dri_data[3] = 0x04;
 413         dri_data[4] = (ptr->dri) >> 8;
 414         dri_data[5] = (ptr->dri) & 0xff;
 415         return zr36060_pushit(ptr, ZR060_DRI_IDX, 6, dri_data);
 416 }
 417
 418 /* =========================================================================
 419    Setup function:
 420
 421    Setup compression/decompression of Zoran's JPEG processor
 422    ( see also zoran 36060 manual )
 423
 424    ... sorry for the spaghetti code ...
 425    ========================================================================= */
 426 static void
 427 zr36060_init (struct zr36060 *ptr)
 428 {
 429         int sum = 0;
 430         long bitcnt, tmp;
 431
 432         if (ptr->mode == CODEC_DO_COMPRESSION) {
 433                 dprintk(2, "%s: COMPRESSION SETUP\n", ptr->name);
 434
 435                 zr36060_write(ptr, ZR060_LOAD, ZR060_LOAD_SyncRst);
 436
 437                 /* 060 communicates with 067 in master mode */
 438                 zr36060_write(ptr, ZR060_CIR, ZR060_CIR_CodeMstr);
 439
 440                 /* Compression with or without variable scale factor */
 441                 /*FIXME: What about ptr->bitrate_ctrl? */
 442                 zr36060_write(ptr, ZR060_CMR,
 443                               ZR060_CMR_Comp | ZR060_CMR_Pass2 |
 444                               ZR060_CMR_BRB);
 445
 446                 /* Must be zero */
 447                 zr36060_write(ptr, ZR060_MBZ, 0x00);
 448                 zr36060_write(ptr, ZR060_TCR_HI, 0x00);
 449                 zr36060_write(ptr, ZR060_TCR_LO, 0x00);
 450
 451                 /* Disable all IRQs - no DataErr means autoreset */
 452                 zr36060_write(ptr, ZR060_IMR, 0);
 453
 454                 /* volume control settings */
 455                 zr36060_write(ptr, ZR060_SF_HI, ptr->scalefact >> 8);
 456                 zr36060_write(ptr, ZR060_SF_LO, ptr->scalefact & 0xff);
 457
 458                 zr36060_write(ptr, ZR060_AF_HI, 0xff);
 459                 zr36060_write(ptr, ZR060_AF_M, 0xff);
 460                 zr36060_write(ptr, ZR060_AF_LO, 0xff);
 461
 462                 /* setup the variable jpeg tables */
 463                 sum += zr36060_set_sof(ptr);
 464                 sum += zr36060_set_sos(ptr);
 465                 sum += zr36060_set_dri(ptr);
 466
 467                 /* setup the fixed jpeg tables - maybe variable, though -
 468                  * (see table init section above) */
 469                 sum +=
 470                     zr36060_pushit(ptr, ZR060_DQT_IDX, sizeof(zr36060_dqt),
 471                                    zr36060_dqt);
 472                 sum +=
 473                     zr36060_pushit(ptr, ZR060_DHT_IDX, sizeof(zr36060_dht),
 474                                    zr36060_dht);
 475                 zr36060_write(ptr, ZR060_APP_IDX, 0xff);
 476                 zr36060_write(ptr, ZR060_APP_IDX + 1, 0xe0 + ptr->app.appn);
 477                 zr36060_write(ptr, ZR060_APP_IDX + 2, 0x00);
 478                 zr36060_write(ptr, ZR060_APP_IDX + 3, ptr->app.len + 2);
 479                 sum += zr36060_pushit(ptr, ZR060_APP_IDX + 4, 60,
 480                                       ptr->app.data) + 4;
 481                 zr36060_write(ptr, ZR060_COM_IDX, 0xff);
 482                 zr36060_write(ptr, ZR060_COM_IDX + 1, 0xfe);
 483                 zr36060_write(ptr, ZR060_COM_IDX + 2, 0x00);
 484                 zr36060_write(ptr, ZR060_COM_IDX + 3, ptr->com.len + 2);
 485                 sum += zr36060_pushit(ptr, ZR060_COM_IDX + 4, 60,
 486                                       ptr->com.data) + 4;
 487
 488                 /* setup misc. data for compression (target code sizes) */
 489
 490                 /* size of compressed code to reach without header data */
 491                 sum = ptr->real_code_vol - sum;
 492                 bitcnt = sum << 3;      /* need the size in bits */
 493
 494                 tmp = bitcnt >> 16;
 495                 dprintk(3,
 496                         "%s: code: csize=%d, tot=%d, bit=%ld, highbits=%ld\n",
 497                         ptr->name, sum, ptr->real_code_vol, bitcnt, tmp);
 498                 zr36060_write(ptr, ZR060_TCV_NET_HI, tmp >> 8);
 499                 zr36060_write(ptr, ZR060_TCV_NET_MH, tmp & 0xff);
 500                 tmp = bitcnt & 0xffff;
 501                 zr36060_write(ptr, ZR060_TCV_NET_ML, tmp >> 8);
 502                 zr36060_write(ptr, ZR060_TCV_NET_LO, tmp & 0xff);
 503
 504                 bitcnt -= bitcnt >> 7;  // bits without stuffing
 505                 bitcnt -= ((bitcnt * 5) >> 6);  // bits without eob
 506
 507                 tmp = bitcnt >> 16;
 508                 dprintk(3, "%s: code: nettobit=%ld, highnettobits=%ld\n",
 509                         ptr->name, bitcnt, tmp);
 510                 zr36060_write(ptr, ZR060_TCV_DATA_HI, tmp >> 8);
 511                 zr36060_write(ptr, ZR060_TCV_DATA_MH, tmp & 0xff);
 512                 tmp = bitcnt & 0xffff;
 513                 zr36060_write(ptr, ZR060_TCV_DATA_ML, tmp >> 8);
 514                 zr36060_write(ptr, ZR060_TCV_DATA_LO, tmp & 0xff);
 515
 516                 /* JPEG markers to be included in the compressed stream */
 517                 zr36060_write(ptr, ZR060_MER,
 518                               ZR060_MER_DQT | ZR060_MER_DHT |
 519                               ((ptr->com.len > 0) ? ZR060_MER_Com : 0) |
 520                               ((ptr->app.len > 0) ? ZR060_MER_App : 0));
 521
 522                 /* Setup the Video Frontend */
 523                 /* Limit pixel range to 16..235 as per CCIR-601 */
 524                 zr36060_write(ptr, ZR060_VCR, ZR060_VCR_Range);
 525
 526         } else {
 527                 dprintk(2, "%s: EXPANSION SETUP\n", ptr->name);
 528
 529                 zr36060_write(ptr, ZR060_LOAD, ZR060_LOAD_SyncRst);
 530
 531                 /* 060 communicates with 067 in master mode */
 532                 zr36060_write(ptr, ZR060_CIR, ZR060_CIR_CodeMstr);
 533
 534                 /* Decompression */
 535                 zr36060_write(ptr, ZR060_CMR, 0);
 536
 537                 /* Must be zero */
 538                 zr36060_write(ptr, ZR060_MBZ, 0x00);
 539                 zr36060_write(ptr, ZR060_TCR_HI, 0x00);
 540                 zr36060_write(ptr, ZR060_TCR_LO, 0x00);
 541
 542                 /* Disable all IRQs - no DataErr means autoreset */
 543                 zr36060_write(ptr, ZR060_IMR, 0);
 544
 545                 /* setup misc. data for expansion */
 546                 zr36060_write(ptr, ZR060_MER, 0);
 547
 548                 /* setup the fixed jpeg tables - maybe variable, though -
 549                  * (see table init section above) */
 550                 zr36060_pushit(ptr, ZR060_DHT_IDX, sizeof(zr36060_dht),
 551                                zr36060_dht);
 552
 553                 /* Setup the Video Frontend */
 554                 //zr36060_write(ptr, ZR060_VCR, ZR060_VCR_FIExt);
 555                 //this doesn't seem right and doesn't work...
 556                 zr36060_write(ptr, ZR060_VCR, ZR060_VCR_Range);
 557         }
 558
 559         /* Load the tables */
 560         zr36060_write(ptr, ZR060_LOAD,
 561                       ZR060_LOAD_SyncRst | ZR060_LOAD_Load);
 562         zr36060_wait_end(ptr);
 563         dprintk(2, "%s: Status after table preload: 0x%02x\n", ptr->name,
 564                 ptr->status);
 565
 566         if (ptr->status & ZR060_CFSR_Busy) {
 567                 dprintk(1, KERN_ERR "%s: init aborted!\n", ptr->name);
 568                 return;         // something is wrong, its timed out!!!!
 569         }
 570 }
 571
 572 /* =========================================================================
 573    CODEC API FUNCTIONS
 574
 575    this functions are accessed by the master via the API structure
 576    ========================================================================= */
 577
 578 /* set compression/expansion mode and launches codec -
 579    this should be the last call from the master before starting processing */
 580 static int
 581 zr36060_set_mode (struct videocodec *codec,
 582                   int                mode)
 583 {
 584         struct zr36060 *ptr = (struct zr36060 *) codec->data;
 585
 586         dprintk(2, "%s: set_mode %d call\n", ptr->name, mode);
 587
 588         if ((mode != CODEC_DO_EXPANSION) && (mode != CODEC_DO_COMPRESSION))
 589                 return -EINVAL;
 590
 591         ptr->mode = mode;
 592         zr36060_init(ptr);
 593
 594         return 0;
 595 }
 596
 597 /* set picture size (norm is ignored as the codec doesn't know about it) */
 598 static int
 599 zr36060_set_video (struct videocodec   *codec,
 600                    struct tvnorm       *norm,
 601                    struct vfe_settings *cap,
 602                    struct vfe_polarity *pol)
 603 {
 604         struct zr36060 *ptr = (struct zr36060 *) codec->data;
 605         u32 reg;
 606         int size;
 607
 608         dprintk(2, "%s: set_video %d/%d-%dx%d (%%%d) call\n", ptr->name,
 609                 cap->x, cap->y, cap->width, cap->height, cap->decimation);
 610
 611         /* if () return -EINVAL;
 612          * trust the master driver that it knows what it does - so
 613          * we allow invalid startx/y and norm for now ... */
 614         ptr->width = cap->width / (cap->decimation & 0xff);
 615         ptr->height = cap->height / (cap->decimation >> 8);
 616
 617         zr36060_write(ptr, ZR060_LOAD, ZR060_LOAD_SyncRst);
 618
 619         /* Note that VSPol/HSPol bits in zr36060 have the opposite
 620          * meaning of their zr360x7 counterparts with the same names
 621          * N.b. for VSPol this is only true if FIVEdge = 0 (default,
 622          * left unchanged here - in accordance with datasheet).
 623         */
 624         reg = (!pol->vsync_pol ? ZR060_VPR_VSPol : 0)
 625             | (!pol->hsync_pol ? ZR060_VPR_HSPol : 0)
 626             | (pol->field_pol ? ZR060_VPR_FIPol : 0)
 627             | (pol->blank_pol ? ZR060_VPR_BLPol : 0)
 628             | (pol->subimg_pol ? ZR060_VPR_SImgPol : 0)
 629             | (pol->poe_pol ? ZR060_VPR_PoePol : 0)
 630             | (pol->pvalid_pol ? ZR060_VPR_PValPol : 0)
 631             | (pol->vclk_pol ? ZR060_VPR_VCLKPol : 0);
 632         zr36060_write(ptr, ZR060_VPR, reg);
 633
 634         reg = 0;
 635         switch (cap->decimation & 0xff) {
 636         default:
 637         case 1:
 638                 break;
 639
 640         case 2:
 641                 reg |= ZR060_SR_HScale2;
 642                 break;
 643
 644         case 4:
 645                 reg |= ZR060_SR_HScale4;
 646                 break;
 647         }
 648
 649         switch (cap->decimation >> 8) {
 650         default:
 651         case 1:
 652                 break;
 653
 654         case 2:
 655                 reg |= ZR060_SR_VScale;
 656                 break;
 657         }
 658         zr36060_write(ptr, ZR060_SR, reg);
 659
 660         zr36060_write(ptr, ZR060_BCR_Y, 0x00);
 661         zr36060_write(ptr, ZR060_BCR_U, 0x80);
 662         zr36060_write(ptr, ZR060_BCR_V, 0x80);
 663
 664         /* sync generator */
 665
 666         reg = norm->Ht - 1;     /* Vtotal */
 667         zr36060_write(ptr, ZR060_SGR_VTOTAL_HI, (reg >> 8) & 0xff);
 668         zr36060_write(ptr, ZR060_SGR_VTOTAL_LO, (reg >> 0) & 0xff);
 669
 670         reg = norm->Wt - 1;     /* Htotal */
 671         zr36060_write(ptr, ZR060_SGR_HTOTAL_HI, (reg >> 8) & 0xff);
 672         zr36060_write(ptr, ZR060_SGR_HTOTAL_LO, (reg >> 0) & 0xff);
 673
 674         reg = 6 - 1;            /* VsyncSize */
 675         zr36060_write(ptr, ZR060_SGR_VSYNC, reg);
 676
 677         //reg   = 30 - 1;               /* HsyncSize */
 678 ///*CP*/        reg = (zr->params.norm == 1 ? 57 : 68);
 679         reg = 68;
 680         zr36060_write(ptr, ZR060_SGR_HSYNC, reg);
 681
 682         reg = norm->VStart - 1; /* BVstart */
 683         zr36060_write(ptr, ZR060_SGR_BVSTART, reg);
 684
 685         reg += norm->Ha / 2;    /* BVend */
 686         zr36060_write(ptr, ZR060_SGR_BVEND_HI, (reg >> 8) & 0xff);
 687         zr36060_write(ptr, ZR060_SGR_BVEND_LO, (reg >> 0) & 0xff);
 688
 689         reg = norm->HStart - 1; /* BHstart */
 690         zr36060_write(ptr, ZR060_SGR_BHSTART, reg);
 691
 692         reg += norm->Wa;        /* BHend */
 693         zr36060_write(ptr, ZR060_SGR_BHEND_HI, (reg >> 8) & 0xff);
 694         zr36060_write(ptr, ZR060_SGR_BHEND_LO, (reg >> 0) & 0xff);
 695
 696         /* active area */
 697         reg = cap->y + norm->VStart;    /* Vstart */
 698         zr36060_write(ptr, ZR060_AAR_VSTART_HI, (reg >> 8) & 0xff);
 699         zr36060_write(ptr, ZR060_AAR_VSTART_LO, (reg >> 0) & 0xff);
 700
 701         reg += cap->height;     /* Vend */
 702         zr36060_write(ptr, ZR060_AAR_VEND_HI, (reg >> 8) & 0xff);
 703         zr36060_write(ptr, ZR060_AAR_VEND_LO, (reg >> 0) & 0xff);
 704
 705         reg = cap->x + norm->HStart;    /* Hstart */
 706         zr36060_write(ptr, ZR060_AAR_HSTART_HI, (reg >> 8) & 0xff);
 707         zr36060_write(ptr, ZR060_AAR_HSTART_LO, (reg >> 0) & 0xff);
 708
 709         reg += cap->width;      /* Hend */
 710         zr36060_write(ptr, ZR060_AAR_HEND_HI, (reg >> 8) & 0xff);
 711         zr36060_write(ptr, ZR060_AAR_HEND_LO, (reg >> 0) & 0xff);
 712
 713         /* subimage area */
 714         reg = norm->VStart - 4; /* SVstart */
 715         zr36060_write(ptr, ZR060_SWR_VSTART_HI, (reg >> 8) & 0xff);
 716         zr36060_write(ptr, ZR060_SWR_VSTART_LO, (reg >> 0) & 0xff);
 717
 718         reg += norm->Ha / 2 + 8;        /* SVend */
 719         zr36060_write(ptr, ZR060_SWR_VEND_HI, (reg >> 8) & 0xff);
 720         zr36060_write(ptr, ZR060_SWR_VEND_LO, (reg >> 0) & 0xff);
 721
 722         reg = norm->HStart /*+ 64 */  - 4;      /* SHstart */
 723         zr36060_write(ptr, ZR060_SWR_HSTART_HI, (reg >> 8) & 0xff);
 724         zr36060_write(ptr, ZR060_SWR_HSTART_LO, (reg >> 0) & 0xff);
 725
 726         reg += norm->Wa + 8;    /* SHend */
 727         zr36060_write(ptr, ZR060_SWR_HEND_HI, (reg >> 8) & 0xff);
 728         zr36060_write(ptr, ZR060_SWR_HEND_LO, (reg >> 0) & 0xff);
 729
 730         size = ptr->width * ptr->height;
 731         /* Target compressed field size in bits: */
 732         size = size * 16;       /* uncompressed size in bits */
 733         /* (Ronald) by default, quality = 100 is a compression
 734          * ratio 1:2. Setting low_bitrate (insmod option) sets
 735          * it to 1:4 (instead of 1:2, zr36060 max) as limit because the
 736          * buz can't handle more at decimation=1... Use low_bitrate if
 737          * you have a Buz, unless you know what you're doing */
 738         size = size * cap->quality / (low_bitrate ? 400 : 200);
 739         /* Lower limit (arbitrary, 1 KB) */
 740         if (size < 8192)
 741                 size = 8192;
 742         /* Upper limit: 7/8 of the code buffers */
 743         if (size > ptr->total_code_vol * 7)
 744                 size = ptr->total_code_vol * 7;
 745
 746         ptr->real_code_vol = size >> 3; /* in bytes */
 747
 748         /* the MBCVR is the *maximum* block volume, according to the
 749          * JPEG ISO specs, this shouldn't be used, since that allows
 750          * for the best encoding quality. So set it to it's max value */
 751         reg = ptr->max_block_vol;
 752         zr36060_write(ptr, ZR060_MBCVR, reg);
 753
 754         return 0;
 755 }
 756
 757 /* additional control functions */
 758 static int
 759 zr36060_control (struct videocodec *codec,
 760                  int                type,
 761                  int                size,
 762                  void              *data)
 763 {
 764         struct zr36060 *ptr = (struct zr36060 *) codec->data;
 765         int *ival = (int *) data;
 766
 767         dprintk(2, "%s: control %d call with %d byte\n", ptr->name, type,
 768                 size);
 769
 770         switch (type) {
 771         case CODEC_G_STATUS:    /* get last status */
 772                 if (size != sizeof(int))
 773                         return -EFAULT;
 774                 zr36060_read_status(ptr);
 775                 *ival = ptr->status;
 776                 break;
 777
 778         case CODEC_G_CODEC_MODE:
 779                 if (size != sizeof(int))
 780                         return -EFAULT;
 781                 *ival = CODEC_MODE_BJPG;
 782                 break;
 783
 784         case CODEC_S_CODEC_MODE:
 785                 if (size != sizeof(int))
 786                         return -EFAULT;
 787                 if (*ival != CODEC_MODE_BJPG)
 788                         return -EINVAL;
 789                 /* not needed, do nothing */
 790                 return 0;
 791
 792         case CODEC_G_VFE:
 793         case CODEC_S_VFE:
 794                 /* not needed, do nothing */
 795                 return 0;
 796
 797         case CODEC_S_MMAP:
 798                 /* not available, give an error */
 799                 return -ENXIO;
 800
 801         case CODEC_G_JPEG_TDS_BYTE:     /* get target volume in byte */
 802                 if (size != sizeof(int))
 803                         return -EFAULT;
 804                 *ival = ptr->total_code_vol;
 805                 break;
 806
 807         case CODEC_S_JPEG_TDS_BYTE:     /* get target volume in byte */
 808                 if (size != sizeof(int))
 809                         return -EFAULT;
 810                 ptr->total_code_vol = *ival;
 811                 ptr->real_code_vol = (ptr->total_code_vol * 6) >> 3;
 812                 break;
 813
 814         case CODEC_G_JPEG_SCALE:        /* get scaling factor */
 815                 if (size != sizeof(int))
 816                         return -EFAULT;
 817                 *ival = zr36060_read_scalefactor(ptr);
 818                 break;
 819
 820         case CODEC_S_JPEG_SCALE:        /* set scaling factor */
 821                 if (size != sizeof(int))
 822                         return -EFAULT;
 823                 ptr->scalefact = *ival;
 824                 break;
 825
 826         case CODEC_G_JPEG_APP_DATA: {   /* get appn marker data */
 827                 struct jpeg_app_marker *app = data;
 828
 829                 if (size != sizeof(struct jpeg_app_marker))
 830                         return -EFAULT;
 831
 832                 *app = ptr->app;
 833                 break;
 834         }
 835
 836         case CODEC_S_JPEG_APP_DATA: {   /* set appn marker data */
 837                 struct jpeg_app_marker *app = data;
 838
 839                 if (size != sizeof(struct jpeg_app_marker))
 840                         return -EFAULT;
 841
 842                 ptr->app = *app;
 843                 break;
 844         }
 845
 846         case CODEC_G_JPEG_COM_DATA: {   /* get comment marker data */
 847                 struct jpeg_com_marker *com = data;
 848
 849                 if (size != sizeof(struct jpeg_com_marker))
 850                         return -EFAULT;
 851
 852                 *com = ptr->com;
 853                 break;
 854         }
 855
 856         case CODEC_S_JPEG_COM_DATA: {   /* set comment marker data */
 857                 struct jpeg_com_marker *com = data;
 858
 859                 if (size != sizeof(struct jpeg_com_marker))
 860                         return -EFAULT;
 861
 862                 ptr->com = *com;
 863                 break;
 864         }
 865
 866         default:
 867                 return -EINVAL;
 868         }
 869
 870         return size;
 871 }
 872
 873 /* =========================================================================
 874    Exit and unregister function:
 875
 876    Deinitializes Zoran's JPEG processor
 877    ========================================================================= */
 878
 879 static int
 880 zr36060_unset (struct videocodec *codec)
 881 {
 882         struct zr36060 *ptr = codec->data;
 883
 884         if (ptr) {
 885                 /* do wee need some codec deinit here, too ???? */
 886
 887                 dprintk(1, "%s: finished codec #%d\n", ptr->name,
 888                         ptr->num);
 889                 kfree(ptr);
 890                 codec->data = NULL;
 891
 892                 zr36060_codecs--;
 893                 return 0;
 894         }
 895
 896         return -EFAULT;
 897 }
 898
 899 /* =========================================================================
 900    Setup and registry function:
 901
 902    Initializes Zoran's JPEG processor
 903
 904    Also sets pixel size, average code size, mode (compr./decompr.)
 905    (the given size is determined by the processor with the video interface)
 906    ========================================================================= */
 907
 908 static int
 909 zr36060_setup (struct videocodec *codec)
 910 {
 911         struct zr36060 *ptr;
 912         int res;
 913
 914         dprintk(2, "zr36060: initializing MJPEG subsystem #%d.\n",
 915                 zr36060_codecs);
 916
 917         if (zr36060_codecs == MAX_CODECS) {
 918                 dprintk(1,
 919                         KERN_ERR "zr36060: Can't attach more codecs!\n");
 920                 return -ENOSPC;
 921         }
 922         //mem structure init
 923         codec->data = ptr = kmalloc(sizeof(struct zr36060), GFP_KERNEL);
 924         if (NULL == ptr) {
 925                 dprintk(1, KERN_ERR "zr36060: Can't get enough memory!\n");
 926                 return -ENOMEM;
 927         }
 928         memset(ptr, 0, sizeof(struct zr36060));
 929
 930         snprintf(ptr->name, sizeof(ptr->name), "zr36060[%d]",
 931                  zr36060_codecs);
 932         ptr->num = zr36060_codecs++;
 933         ptr->codec = codec;
 934
 935         //testing
 936         res = zr36060_basic_test(ptr);
 937         if (res < 0) {
 938                 zr36060_unset(codec);
 939                 return res;
 940         }
 941         //final setup
 942         memcpy(ptr->h_samp_ratio, zr36060_decimation_h, 8);
 943         memcpy(ptr->v_samp_ratio, zr36060_decimation_v, 8);
 944
 945         ptr->bitrate_ctrl = 0;  /* 0 or 1 - fixed file size flag
 946                                  * (what is the difference?) */
 947         ptr->mode = CODEC_DO_COMPRESSION;
 948         ptr->width = 384;
 949         ptr->height = 288;
 950         ptr->total_code_vol = 16000;    /* CHECKME */
 951         ptr->real_code_vol = (ptr->total_code_vol * 6) >> 3;
 952         ptr->max_block_vol = 240;       /* CHECKME, was 120 is 240 */
 953         ptr->scalefact = 0x100;
 954         ptr->dri = 1;           /* CHECKME, was 8 is 1 */
 955
 956         /* by default, no COM or APP markers - app should set those */
 957         ptr->com.len = 0;
 958         ptr->app.appn = 0;
 959         ptr->app.len = 0;
 960
 961         zr36060_init(ptr);
 962
 963         dprintk(1, KERN_INFO "%s: codec attached and running\n",
 964                 ptr->name);
 965
 966         return 0;
 967 }
 968
 969 static const struct videocodec zr36060_codec = {
 970         .owner = THIS_MODULE,
 971         .name = "zr36060",
 972         .magic = 0L,            // magic not used
 973         .flags =
 974             CODEC_FLAG_JPEG | CODEC_FLAG_HARDWARE | CODEC_FLAG_ENCODER |
 975             CODEC_FLAG_DECODER | CODEC_FLAG_VFE,
 976         .type = CODEC_TYPE_ZR36060,
 977         .setup = zr36060_setup, // functionality
 978         .unset = zr36060_unset,
 979         .set_mode = zr36060_set_mode,
 980         .set_video = zr36060_set_video,
 981         .control = zr36060_control,
 982         // others are not used
 983 };
 984
 985 /* =========================================================================
 986    HOOK IN DRIVER AS KERNEL MODULE
 987    ========================================================================= */
 988
 989 static int __init
 990 zr36060_init_module (void)
 991 {
 992         //dprintk(1, "zr36060 driver %s\n",ZR060_VERSION);
 993         zr36060_codecs = 0;
 994         return videocodec_register(&zr36060_codec);
 995 }
 996
 997 static void __exit
 998 zr36060_cleanup_module (void)
 999 {
1000         if (zr36060_codecs) {
1001                 dprintk(1,
1002                         "zr36060: something's wrong - %d codecs left somehow.\n",
1003                         zr36060_codecs);
1004         }
1005
1006         /* however, we can't just stay alive */
1007         videocodec_unregister(&zr36060_codec);
1008 }
1009
1010 module_init(zr36060_init_module);
1011 module_exit(zr36060_cleanup_module);
1012
1013 MODULE_AUTHOR("Laurent Pinchart <laurent.pinchart@skynet.be>");
1014 MODULE_DESCRIPTION("Driver module for ZR36060 jpeg processors "
1015                    ZR060_VERSION);
1016 MODULE_LICENSE("GPL");