drivers/media/video/bt8xx/bttv-risc.c

   1 /*
   2
   3     bttv-risc.c  --  interfaces to other kernel modules
   4
   5     bttv risc code handling
   6         - memory management
   7         - generation
   8
   9     (c) 2000-2003 Gerd Knorr <kraxel@bytesex.org>
  10
  11     This program is free software; you can redistribute it and/or modify
  12     it under the terms of the GNU General Public License as published by
  13     the Free Software Foundation; either version 2 of the License, or
  14     (at your option) any later version.
  15
  16     This program is distributed in the hope that it will be useful,
  17     but WITHOUT ANY WARRANTY; without even the implied warranty of
  18     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  19     GNU General Public License for more details.
  20
  21     You should have received a copy of the GNU General Public License
  22     along with this program; if not, write to the Free Software
  23     Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  24
  25 */
  26
  27 #include <linux/module.h>
  28 #include <linux/init.h>
  29 #include <linux/pci.h>
  30 #include <linux/vmalloc.h>
  31 #include <linux/interrupt.h>
  32 #include <asm/page.h>
  33 #include <asm/pgtable.h>
  34
  35 #include "bttvp.h"
  36
  37 #define VCR_HACK_LINES 4
  38
  39 /* ---------------------------------------------------------- */
  40 /* risc code generators                                       */
  41
  42 int
  43 bttv_risc_packed(struct bttv *btv, struct btcx_riscmem *risc,
  44                  struct scatterlist *sglist,
  45                  unsigned int offset, unsigned int bpl,
  46                  unsigned int padding, unsigned int skip_lines,
  47                  unsigned int store_lines)
  48 {
  49         u32 instructions,line,todo;
  50         struct scatterlist *sg;
  51         u32 *rp;
  52         int rc;
  53
  54         /* estimate risc mem: worst case is one write per page border +
  55            one write per scan line + sync + jump (all 2 dwords).  padding
  56            can cause next bpl to start close to a page border.  First DMA
  57            region may be smaller than PAGE_SIZE */
  58         instructions  = skip_lines * 4;
  59         instructions += (1 + ((bpl + padding) * store_lines)
  60                          / PAGE_SIZE + store_lines) * 8;
  61         instructions += 2 * 8;
  62         if ((rc = btcx_riscmem_alloc(btv->c.pci,risc,instructions)) < 0)
  63                 return rc;
  64
  65         /* sync instruction */
  66         rp = risc->cpu;
  67         *(rp++) = cpu_to_le32(BT848_RISC_SYNC|BT848_FIFO_STATUS_FM1);
  68         *(rp++) = cpu_to_le32(0);
  69
  70         while (skip_lines-- > 0) {
  71                 *(rp++) = cpu_to_le32(BT848_RISC_SKIP | BT848_RISC_SOL |
  72                                       BT848_RISC_EOL | bpl);
  73         }
  74
  75         /* scan lines */
  76         sg = sglist;
  77         for (line = 0; line < store_lines; line++) {
  78                 if ((btv->opt_vcr_hack) &&
  79                     (line >= (store_lines - VCR_HACK_LINES)))
  80                         continue;
  81                 while (offset && offset >= sg_dma_len(sg)) {
  82                         offset -= sg_dma_len(sg);
  83                         sg++;
  84                 }
  85                 if (bpl <= sg_dma_len(sg)-offset) {
  86                         /* fits into current chunk */
  87                         *(rp++)=cpu_to_le32(BT848_RISC_WRITE|BT848_RISC_SOL|
  88                                             BT848_RISC_EOL|bpl);
  89                         *(rp++)=cpu_to_le32(sg_dma_address(sg)+offset);
  90                         offset+=bpl;
  91                 } else {
  92                         /* scanline needs to be splitted */
  93                         todo = bpl;
  94                         *(rp++)=cpu_to_le32(BT848_RISC_WRITE|BT848_RISC_SOL|
  95                                             (sg_dma_len(sg)-offset));
  96                         *(rp++)=cpu_to_le32(sg_dma_address(sg)+offset);
  97                         todo -= (sg_dma_len(sg)-offset);
  98                         offset = 0;
  99                         sg++;
 100                         while (todo > sg_dma_len(sg)) {
 101                                 *(rp++)=cpu_to_le32(BT848_RISC_WRITE|
 102                                                     sg_dma_len(sg));
 103                                 *(rp++)=cpu_to_le32(sg_dma_address(sg));
 104                                 todo -= sg_dma_len(sg);
 105                                 sg++;
 106                         }
 107                         *(rp++)=cpu_to_le32(BT848_RISC_WRITE|BT848_RISC_EOL|
 108                                             todo);
 109                         *(rp++)=cpu_to_le32(sg_dma_address(sg));
 110                         offset += todo;
 111                 }
 112                 offset += padding;
 113         }
 114
 115         /* save pointer to jmp instruction address */
 116         risc->jmp = rp;
 117         BUG_ON((risc->jmp - risc->cpu + 2) * sizeof(*risc->cpu) > risc->size);
 118         return 0;
 119 }
 120
 121 static int
 122 bttv_risc_planar(struct bttv *btv, struct btcx_riscmem *risc,
 123                  struct scatterlist *sglist,
 124                  unsigned int yoffset,  unsigned int ybpl,
 125                  unsigned int ypadding, unsigned int ylines,
 126                  unsigned int uoffset,  unsigned int voffset,
 127                  unsigned int hshift,   unsigned int vshift,
 128                  unsigned int cpadding)
 129 {
 130         unsigned int instructions,line,todo,ylen,chroma;
 131         u32 *rp,ri;
 132         struct scatterlist *ysg;
 133         struct scatterlist *usg;
 134         struct scatterlist *vsg;
 135         int topfield = (0 == yoffset);
 136         int rc;
 137
 138         /* estimate risc mem: worst case is one write per page border +
 139            one write per scan line (5 dwords)
 140            plus sync + jump (2 dwords) */
 141         instructions  = ((3 + (ybpl + ypadding) * ylines * 2)
 142                          / PAGE_SIZE) + ylines;
 143         instructions += 2;
 144         if ((rc = btcx_riscmem_alloc(btv->c.pci,risc,instructions*4*5)) < 0)
 145                 return rc;
 146
 147         /* sync instruction */
 148         rp = risc->cpu;
 149         *(rp++) = cpu_to_le32(BT848_RISC_SYNC|BT848_FIFO_STATUS_FM3);
 150         *(rp++) = cpu_to_le32(0);
 151
 152         /* scan lines */
 153         ysg = sglist;
 154         usg = sglist;
 155         vsg = sglist;
 156         for (line = 0; line < ylines; line++) {
 157                 if ((btv->opt_vcr_hack) &&
 158                     (line >= (ylines - VCR_HACK_LINES)))
 159                         continue;
 160                 switch (vshift) {
 161                 case 0:
 162                         chroma = 1;
 163                         break;
 164                 case 1:
 165                         if (topfield)
 166                                 chroma = ((line & 1) == 0);
 167                         else
 168                                 chroma = ((line & 1) == 1);
 169                         break;
 170                 case 2:
 171                         if (topfield)
 172                                 chroma = ((line & 3) == 0);
 173                         else
 174                                 chroma = ((line & 3) == 2);
 175                         break;
 176                 default:
 177                         chroma = 0;
 178                         break;
 179                 }
 180
 181                 for (todo = ybpl; todo > 0; todo -= ylen) {
 182                         /* go to next sg entry if needed */
 183                         while (yoffset && yoffset >= sg_dma_len(ysg)) {
 184                                 yoffset -= sg_dma_len(ysg);
 185                                 ysg++;
 186                         }
 187                         while (uoffset && uoffset >= sg_dma_len(usg)) {
 188                                 uoffset -= sg_dma_len(usg);
 189                                 usg++;
 190                         }
 191                         while (voffset && voffset >= sg_dma_len(vsg)) {
 192                                 voffset -= sg_dma_len(vsg);
 193                                 vsg++;
 194                         }
 195
 196                         /* calculate max number of bytes we can write */
 197                         ylen = todo;
 198                         if (yoffset + ylen > sg_dma_len(ysg))
 199                                 ylen = sg_dma_len(ysg) - yoffset;
 200                         if (chroma) {
 201                                 if (uoffset + (ylen>>hshift) > sg_dma_len(usg))
 202                                         ylen = (sg_dma_len(usg) - uoffset) << hshift;
 203                                 if (voffset + (ylen>>hshift) > sg_dma_len(vsg))
 204                                         ylen = (sg_dma_len(vsg) - voffset) << hshift;
 205                                 ri = BT848_RISC_WRITE123;
 206                         } else {
 207                                 ri = BT848_RISC_WRITE1S23;
 208                         }
 209                         if (ybpl == todo)
 210                                 ri |= BT848_RISC_SOL;
 211                         if (ylen == todo)
 212                                 ri |= BT848_RISC_EOL;
 213
 214                         /* write risc instruction */
 215                         *(rp++)=cpu_to_le32(ri | ylen);
 216                         *(rp++)=cpu_to_le32(((ylen >> hshift) << 16) |
 217                                             (ylen >> hshift));
 218                         *(rp++)=cpu_to_le32(sg_dma_address(ysg)+yoffset);
 219                         yoffset += ylen;
 220                         if (chroma) {
 221                                 *(rp++)=cpu_to_le32(sg_dma_address(usg)+uoffset);
 222                                 uoffset += ylen >> hshift;
 223                                 *(rp++)=cpu_to_le32(sg_dma_address(vsg)+voffset);
 224                                 voffset += ylen >> hshift;
 225                         }
 226                 }
 227                 yoffset += ypadding;
 228                 if (chroma) {
 229                         uoffset += cpadding;
 230                         voffset += cpadding;
 231                 }
 232         }
 233
 234         /* save pointer to jmp instruction address */
 235         risc->jmp = rp;
 236         BUG_ON((risc->jmp - risc->cpu + 2) * sizeof(*risc->cpu) > risc->size);
 237         return 0;
 238 }
 239
 240 static int
 241 bttv_risc_overlay(struct bttv *btv, struct btcx_riscmem *risc,
 242                   const struct bttv_format *fmt, struct bttv_overlay *ov,
 243                   int skip_even, int skip_odd)
 244 {
 245         int dwords,rc,line,maxy,start,end,skip,nskips;
 246         struct btcx_skiplist *skips;
 247         u32 *rp,ri,ra;
 248         u32 addr;
 249
 250         /* skip list for window clipping */
 251         if (NULL == (skips = kmalloc(sizeof(*skips) * ov->nclips,GFP_KERNEL)))
 252                 return -ENOMEM;
 253
 254         /* estimate risc mem: worst case is (1.5*clip+1) * lines instructions
 255            + sync + jump (all 2 dwords) */
 256         dwords  = (3 * ov->nclips + 2) *
 257                 ((skip_even || skip_odd) ? (ov->w.height+1)>>1 :  ov->w.height);
 258         dwords += 4;
 259         if ((rc = btcx_riscmem_alloc(btv->c.pci,risc,dwords*4)) < 0) {
 260                 kfree(skips);
 261                 return rc;
 262         }
 263
 264         /* sync instruction */
 265         rp = risc->cpu;
 266         *(rp++) = cpu_to_le32(BT848_RISC_SYNC|BT848_FIFO_STATUS_FM1);
 267         *(rp++) = cpu_to_le32(0);
 268
 269         addr  = (unsigned long)btv->fbuf.base;
 270         addr += btv->fbuf.fmt.bytesperline * ov->w.top;
 271         addr += (fmt->depth >> 3)          * ov->w.left;
 272
 273         /* scan lines */
 274         for (maxy = -1, line = 0; line < ov->w.height;
 275              line++, addr += btv->fbuf.fmt.bytesperline) {
 276                 if ((btv->opt_vcr_hack) &&
 277                      (line >= (ov->w.height - VCR_HACK_LINES)))
 278                         continue;
 279                 if ((line%2) == 0  &&  skip_even)
 280                         continue;
 281                 if ((line%2) == 1  &&  skip_odd)
 282                         continue;
 283
 284                 /* calculate clipping */
 285                 if (line > maxy)
 286                         btcx_calc_skips(line, ov->w.width, &maxy,
 287                                         skips, &nskips, ov->clips, ov->nclips);
 288
 289                 /* write out risc code */
 290                 for (start = 0, skip = 0; start < ov->w.width; start = end) {
 291                         if (skip >= nskips) {
 292                                 ri  = BT848_RISC_WRITE;
 293                                 end = ov->w.width;
 294                         } else if (start < skips[skip].start) {
 295                                 ri  = BT848_RISC_WRITE;
 296                                 end = skips[skip].start;
 297                         } else {
 298                                 ri  = BT848_RISC_SKIP;
 299                                 end = skips[skip].end;
 300                                 skip++;
 301                         }
 302                         if (BT848_RISC_WRITE == ri)
 303                                 ra = addr + (fmt->depth>>3)*start;
 304                         else
 305                                 ra = 0;
 306
 307                         if (0 == start)
 308                                 ri |= BT848_RISC_SOL;
 309                         if (ov->w.width == end)
 310                                 ri |= BT848_RISC_EOL;
 311                         ri |= (fmt->depth>>3) * (end-start);
 312
 313                         *(rp++)=cpu_to_le32(ri);
 314                         if (0 != ra)
 315                                 *(rp++)=cpu_to_le32(ra);
 316                 }
 317         }
 318
 319         /* save pointer to jmp instruction address */
 320         risc->jmp = rp;
 321         BUG_ON((risc->jmp - risc->cpu + 2) * sizeof(*risc->cpu) > risc->size);
 322         kfree(skips);
 323         return 0;
 324 }
 325
 326 /* ---------------------------------------------------------- */
 327
 328 static void
 329 bttv_calc_geo_old(struct bttv *btv, struct bttv_geometry *geo,
 330                   int width, int height, int interleaved,
 331                   const struct bttv_tvnorm *tvnorm)
 332 {
 333         u32 xsf, sr;
 334         int vdelay;
 335
 336         int swidth       = tvnorm->swidth;
 337         int totalwidth   = tvnorm->totalwidth;
 338         int scaledtwidth = tvnorm->scaledtwidth;
 339
 340         if (bttv_tvcards[btv->c.type].muxsel[btv->input] < 0) {
 341                 swidth       = 720;
 342                 totalwidth   = 858;
 343                 scaledtwidth = 858;
 344         }
 345
 346         vdelay = tvnorm->vdelay;
 347
 348         xsf = (width*scaledtwidth)/swidth;
 349         geo->hscale =  ((totalwidth*4096UL)/xsf-4096);
 350         geo->hdelay =  tvnorm->hdelayx1;
 351         geo->hdelay =  (geo->hdelay*width)/swidth;
 352         geo->hdelay &= 0x3fe;
 353         sr = ((tvnorm->sheight >> (interleaved?0:1))*512)/height - 512;
 354         geo->vscale =  (0x10000UL-sr) & 0x1fff;
 355         geo->crop   =  ((width>>8)&0x03) | ((geo->hdelay>>6)&0x0c) |
 356                 ((tvnorm->sheight>>4)&0x30) | ((vdelay>>2)&0xc0);
 357         geo->vscale |= interleaved ? (BT848_VSCALE_INT<<8) : 0;
 358         geo->vdelay  =  vdelay;
 359         geo->width   =  width;
 360         geo->sheight =  tvnorm->sheight;
 361         geo->vtotal  =  tvnorm->vtotal;
 362
 363         if (btv->opt_combfilter) {
 364                 geo->vtc  = (width < 193) ? 2 : ((width < 385) ? 1 : 0);
 365                 geo->comb = (width < 769) ? 1 : 0;
 366         } else {
 367                 geo->vtc  = 0;
 368                 geo->comb = 0;
 369         }
 370 }
 371
 372 static void
 373 bttv_calc_geo           (struct bttv *                  btv,
 374                          struct bttv_geometry *         geo,
 375                          unsigned int                   width,
 376                          unsigned int                   height,
 377                          int                            both_fields,
 378                          const struct bttv_tvnorm *     tvnorm,
 379                          const struct v4l2_rect *       crop)
 380 {
 381         unsigned int c_width;
 382         unsigned int c_height;
 383         u32 sr;
 384
 385         if ((crop->left == tvnorm->cropcap.defrect.left
 386              && crop->top == tvnorm->cropcap.defrect.top
 387              && crop->width == tvnorm->cropcap.defrect.width
 388              && crop->height == tvnorm->cropcap.defrect.height
 389              && width <= tvnorm->swidth /* see PAL-Nc et al */)
 390             || bttv_tvcards[btv->c.type].muxsel[btv->input] < 0) {
 391                 bttv_calc_geo_old(btv, geo, width, height,
 392                                   both_fields, tvnorm);
 393                 return;
 394         }
 395
 396         /* For bug compatibility the image size checks permit scale
 397            factors > 16. See bttv_crop_calc_limits(). */
 398         c_width = min((unsigned int) crop->width, width * 16);
 399         c_height = min((unsigned int) crop->height, height * 16);
 400
 401         geo->width = width;
 402         geo->hscale = (c_width * 4096U + (width >> 1)) / width - 4096;
 403         /* Even to store Cb first, odd for Cr. */
 404         geo->hdelay = ((crop->left * width + c_width) / c_width) & ~1;
 405
 406         geo->sheight = c_height;
 407         geo->vdelay = crop->top - tvnorm->cropcap.bounds.top + MIN_VDELAY;
 408         sr = c_height >> !both_fields;
 409         sr = (sr * 512U + (height >> 1)) / height - 512;
 410         geo->vscale = (0x10000UL - sr) & 0x1fff;
 411         geo->vscale |= both_fields ? (BT848_VSCALE_INT << 8) : 0;
 412         geo->vtotal = tvnorm->vtotal;
 413
 414         geo->crop = (((geo->width   >> 8) & 0x03) |
 415                      ((geo->hdelay  >> 6) & 0x0c) |
 416                      ((geo->sheight >> 4) & 0x30) |
 417                      ((geo->vdelay  >> 2) & 0xc0));
 418
 419         if (btv->opt_combfilter) {
 420                 geo->vtc  = (width < 193) ? 2 : ((width < 385) ? 1 : 0);
 421                 geo->comb = (width < 769) ? 1 : 0;
 422         } else {
 423                 geo->vtc  = 0;
 424                 geo->comb = 0;
 425         }
 426 }
 427
 428 static void
 429 bttv_apply_geo(struct bttv *btv, struct bttv_geometry *geo, int odd)
 430 {
 431         int off = odd ? 0x80 : 0x00;
 432
 433         if (geo->comb)
 434                 btor(BT848_VSCALE_COMB, BT848_E_VSCALE_HI+off);
 435         else
 436                 btand(~BT848_VSCALE_COMB, BT848_E_VSCALE_HI+off);
 437
 438         btwrite(geo->vtc,             BT848_E_VTC+off);
 439         btwrite(geo->hscale >> 8,     BT848_E_HSCALE_HI+off);
 440         btwrite(geo->hscale & 0xff,   BT848_E_HSCALE_LO+off);
 441         btaor((geo->vscale>>8), 0xe0, BT848_E_VSCALE_HI+off);
 442         btwrite(geo->vscale & 0xff,   BT848_E_VSCALE_LO+off);
 443         btwrite(geo->width & 0xff,    BT848_E_HACTIVE_LO+off);
 444         btwrite(geo->hdelay & 0xff,   BT848_E_HDELAY_LO+off);
 445         btwrite(geo->sheight & 0xff,  BT848_E_VACTIVE_LO+off);
 446         btwrite(geo->vdelay & 0xff,   BT848_E_VDELAY_LO+off);
 447         btwrite(geo->crop,            BT848_E_CROP+off);
 448         btwrite(geo->vtotal>>8,       BT848_VTOTAL_HI);
 449         btwrite(geo->vtotal & 0xff,   BT848_VTOTAL_LO);
 450 }
 451
 452 /* ---------------------------------------------------------- */
 453 /* risc group / risc main loop / dma management               */
 454
 455 void
 456 bttv_set_dma(struct bttv *btv, int override)
 457 {
 458         unsigned long cmd;
 459         int capctl;
 460
 461         btv->cap_ctl = 0;
 462         if (NULL != btv->curr.top)      btv->cap_ctl |= 0x02;
 463         if (NULL != btv->curr.bottom)   btv->cap_ctl |= 0x01;
 464         if (NULL != btv->cvbi)          btv->cap_ctl |= 0x0c;
 465
 466         capctl  = 0;
 467         capctl |= (btv->cap_ctl & 0x03) ? 0x03 : 0x00;  /* capture  */
 468         capctl |= (btv->cap_ctl & 0x0c) ? 0x0c : 0x00;  /* vbi data */
 469         capctl |= override;
 470
 471         d2printk(KERN_DEBUG
 472                  "bttv%d: capctl=%x lirq=%d top=%08Lx/%08Lx even=%08Lx/%08Lx\n",
 473                  btv->c.nr,capctl,btv->loop_irq,
 474                  btv->cvbi         ? (unsigned long long)btv->cvbi->top.dma            : 0,
 475                  btv->curr.top     ? (unsigned long long)btv->curr.top->top.dma        : 0,
 476                  btv->cvbi         ? (unsigned long long)btv->cvbi->bottom.dma         : 0,
 477                  btv->curr.bottom  ? (unsigned long long)btv->curr.bottom->bottom.dma  : 0);
 478
 479         cmd = BT848_RISC_JUMP;
 480         if (btv->loop_irq) {
 481                 cmd |= BT848_RISC_IRQ;
 482                 cmd |= (btv->loop_irq  & 0x0f) << 16;
 483                 cmd |= (~btv->loop_irq & 0x0f) << 20;
 484         }
 485         if (btv->curr.frame_irq || btv->loop_irq || btv->cvbi) {
 486                 mod_timer(&btv->timeout, jiffies+BTTV_TIMEOUT);
 487         } else {
 488                 del_timer(&btv->timeout);
 489         }
 490         btv->main.cpu[RISC_SLOT_LOOP] = cpu_to_le32(cmd);
 491
 492         btaor(capctl, ~0x0f, BT848_CAP_CTL);
 493         if (capctl) {
 494                 if (btv->dma_on)
 495                         return;
 496                 btwrite(btv->main.dma, BT848_RISC_STRT_ADD);
 497                 btor(3, BT848_GPIO_DMA_CTL);
 498                 btv->dma_on = 1;
 499         } else {
 500                 if (!btv->dma_on)
 501                         return;
 502                 btand(~3, BT848_GPIO_DMA_CTL);
 503                 btv->dma_on = 0;
 504         }
 505         return;
 506 }
 507
 508 int
 509 bttv_risc_init_main(struct bttv *btv)
 510 {
 511         int rc;
 512
 513         if ((rc = btcx_riscmem_alloc(btv->c.pci,&btv->main,PAGE_SIZE)) < 0)
 514                 return rc;
 515         dprintk(KERN_DEBUG "bttv%d: risc main @ %08Lx\n",
 516                 btv->c.nr,(unsigned long long)btv->main.dma);
 517
 518         btv->main.cpu[0] = cpu_to_le32(BT848_RISC_SYNC | BT848_RISC_RESYNC |
 519                                        BT848_FIFO_STATUS_VRE);
 520         btv->main.cpu[1] = cpu_to_le32(0);
 521         btv->main.cpu[2] = cpu_to_le32(BT848_RISC_JUMP);
 522         btv->main.cpu[3] = cpu_to_le32(btv->main.dma + (4<<2));
 523
 524         /* top field */
 525         btv->main.cpu[4] = cpu_to_le32(BT848_RISC_JUMP);
 526         btv->main.cpu[5] = cpu_to_le32(btv->main.dma + (6<<2));
 527         btv->main.cpu[6] = cpu_to_le32(BT848_RISC_JUMP);
 528         btv->main.cpu[7] = cpu_to_le32(btv->main.dma + (8<<2));
 529
 530         btv->main.cpu[8] = cpu_to_le32(BT848_RISC_SYNC | BT848_RISC_RESYNC |
 531                                        BT848_FIFO_STATUS_VRO);
 532         btv->main.cpu[9] = cpu_to_le32(0);
 533
 534         /* bottom field */
 535         btv->main.cpu[10] = cpu_to_le32(BT848_RISC_JUMP);
 536         btv->main.cpu[11] = cpu_to_le32(btv->main.dma + (12<<2));
 537         btv->main.cpu[12] = cpu_to_le32(BT848_RISC_JUMP);
 538         btv->main.cpu[13] = cpu_to_le32(btv->main.dma + (14<<2));
 539
 540         /* jump back to top field */
 541         btv->main.cpu[14] = cpu_to_le32(BT848_RISC_JUMP);
 542         btv->main.cpu[15] = cpu_to_le32(btv->main.dma + (0<<2));
 543
 544         return 0;
 545 }
 546
 547 int
 548 bttv_risc_hook(struct bttv *btv, int slot, struct btcx_riscmem *risc,
 549                int irqflags)
 550 {
 551         unsigned long cmd;
 552         unsigned long next = btv->main.dma + ((slot+2) << 2);
 553
 554         if (NULL == risc) {
 555                 d2printk(KERN_DEBUG "bttv%d: risc=%p slot[%d]=NULL\n",
 556                          btv->c.nr,risc,slot);
 557                 btv->main.cpu[slot+1] = cpu_to_le32(next);
 558         } else {
 559                 d2printk(KERN_DEBUG "bttv%d: risc=%p slot[%d]=%08Lx irq=%d\n",
 560                          btv->c.nr,risc,slot,(unsigned long long)risc->dma,irqflags);
 561                 cmd = BT848_RISC_JUMP;
 562                 if (irqflags) {
 563                         cmd |= BT848_RISC_IRQ;
 564                         cmd |= (irqflags  & 0x0f) << 16;
 565                         cmd |= (~irqflags & 0x0f) << 20;
 566                 }
 567                 risc->jmp[0] = cpu_to_le32(cmd);
 568                 risc->jmp[1] = cpu_to_le32(next);
 569                 btv->main.cpu[slot+1] = cpu_to_le32(risc->dma);
 570         }
 571         return 0;
 572 }
 573
 574 void
 575 bttv_dma_free(struct videobuf_queue *q,struct bttv *btv, struct bttv_buffer *buf)
 576 {
 577         struct videobuf_dmabuf *dma=videobuf_to_dma(&buf->vb);
 578
 579         BUG_ON(in_interrupt());
 580         videobuf_waiton(&buf->vb,0,0);
 581         videobuf_dma_unmap(q, dma);
 582         videobuf_dma_free(dma);
 583         btcx_riscmem_free(btv->c.pci,&buf->bottom);
 584         btcx_riscmem_free(btv->c.pci,&buf->top);
 585         buf->vb.state = VIDEOBUF_NEEDS_INIT;
 586 }
 587
 588 int
 589 bttv_buffer_activate_vbi(struct bttv *btv,
 590                          struct bttv_buffer *vbi)
 591 {
 592         struct btcx_riscmem *top;
 593         struct btcx_riscmem *bottom;
 594         int top_irq_flags;
 595         int bottom_irq_flags;
 596
 597         top = NULL;
 598         bottom = NULL;
 599         top_irq_flags = 0;
 600         bottom_irq_flags = 0;
 601
 602         if (vbi) {
 603                 unsigned int crop, vdelay;
 604
 605                 vbi->vb.state = VIDEOBUF_ACTIVE;
 606                 list_del(&vbi->vb.queue);
 607
 608                 /* VDELAY is start of video, end of VBI capturing. */
 609                 crop = btread(BT848_E_CROP);
 610                 vdelay = btread(BT848_E_VDELAY_LO) + ((crop & 0xc0) << 2);
 611
 612                 if (vbi->geo.vdelay > vdelay) {
 613                         vdelay = vbi->geo.vdelay & 0xfe;
 614                         crop = (crop & 0x3f) | ((vbi->geo.vdelay >> 2) & 0xc0);
 615
 616                         btwrite(vdelay, BT848_E_VDELAY_LO);
 617                         btwrite(crop,   BT848_E_CROP);
 618                         btwrite(vdelay, BT848_O_VDELAY_LO);
 619                         btwrite(crop,   BT848_O_CROP);
 620                 }
 621
 622                 if (vbi->vbi_count[0] > 0) {
 623                         top = &vbi->top;
 624                         top_irq_flags = 4;
 625                 }
 626
 627                 if (vbi->vbi_count[1] > 0) {
 628                         top_irq_flags = 0;
 629                         bottom = &vbi->bottom;
 630                         bottom_irq_flags = 4;
 631                 }
 632         }
 633
 634         bttv_risc_hook(btv, RISC_SLOT_O_VBI, top, top_irq_flags);
 635         bttv_risc_hook(btv, RISC_SLOT_E_VBI, bottom, bottom_irq_flags);
 636
 637         return 0;
 638 }
 639
 640 int
 641 bttv_buffer_activate_video(struct bttv *btv,
 642                            struct bttv_buffer_set *set)
 643 {
 644         /* video capture */
 645         if (NULL != set->top  &&  NULL != set->bottom) {
 646                 if (set->top == set->bottom) {
 647                         set->top->vb.state    = VIDEOBUF_ACTIVE;
 648                         if (set->top->vb.queue.next)
 649                                 list_del(&set->top->vb.queue);
 650                 } else {
 651                         set->top->vb.state    = VIDEOBUF_ACTIVE;
 652                         set->bottom->vb.state = VIDEOBUF_ACTIVE;
 653                         if (set->top->vb.queue.next)
 654                                 list_del(&set->top->vb.queue);
 655                         if (set->bottom->vb.queue.next)
 656                                 list_del(&set->bottom->vb.queue);
 657                 }
 658                 bttv_apply_geo(btv, &set->top->geo, 1);
 659                 bttv_apply_geo(btv, &set->bottom->geo,0);
 660                 bttv_risc_hook(btv, RISC_SLOT_O_FIELD, &set->top->top,
 661                                set->top_irq);
 662                 bttv_risc_hook(btv, RISC_SLOT_E_FIELD, &set->bottom->bottom,
 663                                set->frame_irq);
 664                 btaor((set->top->btformat & 0xf0) | (set->bottom->btformat & 0x0f),
 665                       ~0xff, BT848_COLOR_FMT);
 666                 btaor((set->top->btswap & 0x0a) | (set->bottom->btswap & 0x05),
 667                       ~0x0f, BT848_COLOR_CTL);
 668         } else if (NULL != set->top) {
 669                 set->top->vb.state  = VIDEOBUF_ACTIVE;
 670                 if (set->top->vb.queue.next)
 671                         list_del(&set->top->vb.queue);
 672                 bttv_apply_geo(btv, &set->top->geo,1);
 673                 bttv_apply_geo(btv, &set->top->geo,0);
 674                 bttv_risc_hook(btv, RISC_SLOT_O_FIELD, &set->top->top,
 675                                set->frame_irq);
 676                 bttv_risc_hook(btv, RISC_SLOT_E_FIELD, NULL,           0);
 677                 btaor(set->top->btformat & 0xff, ~0xff, BT848_COLOR_FMT);
 678                 btaor(set->top->btswap & 0x0f,   ~0x0f, BT848_COLOR_CTL);
 679         } else if (NULL != set->bottom) {
 680                 set->bottom->vb.state = VIDEOBUF_ACTIVE;
 681                 if (set->bottom->vb.queue.next)
 682                         list_del(&set->bottom->vb.queue);
 683                 bttv_apply_geo(btv, &set->bottom->geo,1);
 684                 bttv_apply_geo(btv, &set->bottom->geo,0);
 685                 bttv_risc_hook(btv, RISC_SLOT_O_FIELD, NULL, 0);
 686                 bttv_risc_hook(btv, RISC_SLOT_E_FIELD, &set->bottom->bottom,
 687                                set->frame_irq);
 688                 btaor(set->bottom->btformat & 0xff, ~0xff, BT848_COLOR_FMT);
 689                 btaor(set->bottom->btswap & 0x0f,   ~0x0f, BT848_COLOR_CTL);
 690         } else {
 691                 bttv_risc_hook(btv, RISC_SLOT_O_FIELD, NULL, 0);
 692                 bttv_risc_hook(btv, RISC_SLOT_E_FIELD, NULL, 0);
 693         }
 694         return 0;
 695 }
 696
 697 /* ---------------------------------------------------------- */
 698
 699 /* calculate geometry, build risc code */
 700 int
 701 bttv_buffer_risc(struct bttv *btv, struct bttv_buffer *buf)
 702 {
 703         const struct bttv_tvnorm *tvnorm = bttv_tvnorms + buf->tvnorm;
 704         struct videobuf_dmabuf *dma=videobuf_to_dma(&buf->vb);
 705
 706         dprintk(KERN_DEBUG
 707                 "bttv%d: buffer field: %s  format: %s  size: %dx%d\n",
 708                 btv->c.nr, v4l2_field_names[buf->vb.field],
 709                 buf->fmt->name, buf->vb.width, buf->vb.height);
 710
 711         /* packed pixel modes */
 712         if (buf->fmt->flags & FORMAT_FLAGS_PACKED) {
 713                 int bpl = (buf->fmt->depth >> 3) * buf->vb.width;
 714                 int bpf = bpl * (buf->vb.height >> 1);
 715
 716                 bttv_calc_geo(btv,&buf->geo,buf->vb.width,buf->vb.height,
 717                               V4L2_FIELD_HAS_BOTH(buf->vb.field),
 718                               tvnorm,&buf->crop);
 719
 720                 switch (buf->vb.field) {
 721                 case V4L2_FIELD_TOP:
 722                         bttv_risc_packed(btv,&buf->top,dma->sglist,
 723                                          /* offset */ 0,bpl,
 724                                          /* padding */ 0,/* skip_lines */ 0,
 725                                          buf->vb.height);
 726                         break;
 727                 case V4L2_FIELD_BOTTOM:
 728                         bttv_risc_packed(btv,&buf->bottom,dma->sglist,
 729                                          0,bpl,0,0,buf->vb.height);
 730                         break;
 731                 case V4L2_FIELD_INTERLACED:
 732                         bttv_risc_packed(btv,&buf->top,dma->sglist,
 733                                          0,bpl,bpl,0,buf->vb.height >> 1);
 734                         bttv_risc_packed(btv,&buf->bottom,dma->sglist,
 735                                          bpl,bpl,bpl,0,buf->vb.height >> 1);
 736                         break;
 737                 case V4L2_FIELD_SEQ_TB:
 738                         bttv_risc_packed(btv,&buf->top,dma->sglist,
 739                                          0,bpl,0,0,buf->vb.height >> 1);
 740                         bttv_risc_packed(btv,&buf->bottom,dma->sglist,
 741                                          bpf,bpl,0,0,buf->vb.height >> 1);
 742                         break;
 743                 default:
 744                         BUG();
 745                 }
 746         }
 747
 748         /* planar modes */
 749         if (buf->fmt->flags & FORMAT_FLAGS_PLANAR) {
 750                 int uoffset, voffset;
 751                 int ypadding, cpadding, lines;
 752
 753                 /* calculate chroma offsets */
 754                 uoffset = buf->vb.width * buf->vb.height;
 755                 voffset = buf->vb.width * buf->vb.height;
 756                 if (buf->fmt->flags & FORMAT_FLAGS_CrCb) {
 757                         /* Y-Cr-Cb plane order */
 758                         uoffset >>= buf->fmt->hshift;
 759                         uoffset >>= buf->fmt->vshift;
 760                         uoffset  += voffset;
 761                 } else {
 762                         /* Y-Cb-Cr plane order */
 763                         voffset >>= buf->fmt->hshift;
 764                         voffset >>= buf->fmt->vshift;
 765                         voffset  += uoffset;
 766                 }
 767
 768                 switch (buf->vb.field) {
 769                 case V4L2_FIELD_TOP:
 770                         bttv_calc_geo(btv,&buf->geo,buf->vb.width,
 771                                       buf->vb.height,/* both_fields */ 0,
 772                                       tvnorm,&buf->crop);
 773                         bttv_risc_planar(btv, &buf->top, dma->sglist,
 774                                          0,buf->vb.width,0,buf->vb.height,
 775                                          uoffset,voffset,buf->fmt->hshift,
 776                                          buf->fmt->vshift,0);
 777                         break;
 778                 case V4L2_FIELD_BOTTOM:
 779                         bttv_calc_geo(btv,&buf->geo,buf->vb.width,
 780                                       buf->vb.height,0,
 781                                       tvnorm,&buf->crop);
 782                         bttv_risc_planar(btv, &buf->bottom, dma->sglist,
 783                                          0,buf->vb.width,0,buf->vb.height,
 784                                          uoffset,voffset,buf->fmt->hshift,
 785                                          buf->fmt->vshift,0);
 786                         break;
 787                 case V4L2_FIELD_INTERLACED:
 788                         bttv_calc_geo(btv,&buf->geo,buf->vb.width,
 789                                       buf->vb.height,1,
 790                                       tvnorm,&buf->crop);
 791                         lines    = buf->vb.height >> 1;
 792                         ypadding = buf->vb.width;
 793                         cpadding = buf->vb.width >> buf->fmt->hshift;
 794                         bttv_risc_planar(btv,&buf->top,
 795                                          dma->sglist,
 796                                          0,buf->vb.width,ypadding,lines,
 797                                          uoffset,voffset,
 798                                          buf->fmt->hshift,
 799                                          buf->fmt->vshift,
 800                                          cpadding);
 801                         bttv_risc_planar(btv,&buf->bottom,
 802                                          dma->sglist,
 803                                          ypadding,buf->vb.width,ypadding,lines,
 804                                          uoffset+cpadding,
 805                                          voffset+cpadding,
 806                                          buf->fmt->hshift,
 807                                          buf->fmt->vshift,
 808                                          cpadding);
 809                         break;
 810                 case V4L2_FIELD_SEQ_TB:
 811                         bttv_calc_geo(btv,&buf->geo,buf->vb.width,
 812                                       buf->vb.height,1,
 813                                       tvnorm,&buf->crop);
 814                         lines    = buf->vb.height >> 1;
 815                         ypadding = buf->vb.width;
 816                         cpadding = buf->vb.width >> buf->fmt->hshift;
 817                         bttv_risc_planar(btv,&buf->top,
 818                                          dma->sglist,
 819                                          0,buf->vb.width,0,lines,
 820                                          uoffset >> 1,
 821                                          voffset >> 1,
 822                                          buf->fmt->hshift,
 823                                          buf->fmt->vshift,
 824                                          0);
 825                         bttv_risc_planar(btv,&buf->bottom,
 826                                          dma->sglist,
 827                                          lines * ypadding,buf->vb.width,0,lines,
 828                                          lines * ypadding + (uoffset >> 1),
 829                                          lines * ypadding + (voffset >> 1),
 830                                          buf->fmt->hshift,
 831                                          buf->fmt->vshift,
 832                                          0);
 833                         break;
 834                 default:
 835                         BUG();
 836                 }
 837         }
 838
 839         /* raw data */
 840         if (buf->fmt->flags & FORMAT_FLAGS_RAW) {
 841                 /* build risc code */
 842                 buf->vb.field = V4L2_FIELD_SEQ_TB;
 843                 bttv_calc_geo(btv,&buf->geo,tvnorm->swidth,tvnorm->sheight,
 844                               1,tvnorm,&buf->crop);
 845                 bttv_risc_packed(btv, &buf->top,  dma->sglist,
 846                                  /* offset */ 0, RAW_BPL, /* padding */ 0,
 847                                  /* skip_lines */ 0, RAW_LINES);
 848                 bttv_risc_packed(btv, &buf->bottom, dma->sglist,
 849                                  buf->vb.size/2 , RAW_BPL, 0, 0, RAW_LINES);
 850         }
 851
 852         /* copy format info */
 853         buf->btformat = buf->fmt->btformat;
 854         buf->btswap   = buf->fmt->btswap;
 855         return 0;
 856 }
 857
 858 /* ---------------------------------------------------------- */
 859
 860 /* calculate geometry, build risc code */
 861 int
 862 bttv_overlay_risc(struct bttv *btv,
 863                   struct bttv_overlay *ov,
 864                   const struct bttv_format *fmt,
 865                   struct bttv_buffer *buf)
 866 {
 867         /* check interleave, bottom+top fields */
 868         dprintk(KERN_DEBUG
 869                 "bttv%d: overlay fields: %s format: %s  size: %dx%d\n",
 870                 btv->c.nr, v4l2_field_names[buf->vb.field],
 871                 fmt->name,ov->w.width,ov->w.height);
 872
 873         /* calculate geometry */
 874         bttv_calc_geo(btv,&buf->geo,ov->w.width,ov->w.height,
 875                       V4L2_FIELD_HAS_BOTH(ov->field),
 876                       &bttv_tvnorms[ov->tvnorm],&buf->crop);
 877
 878         /* build risc code */
 879         switch (ov->field) {
 880         case V4L2_FIELD_TOP:
 881                 bttv_risc_overlay(btv, &buf->top,    fmt, ov, 0, 0);
 882                 break;
 883         case V4L2_FIELD_BOTTOM:
 884                 bttv_risc_overlay(btv, &buf->bottom, fmt, ov, 0, 0);
 885                 break;
 886         case V4L2_FIELD_INTERLACED:
 887                 bttv_risc_overlay(btv, &buf->top,    fmt, ov, 0, 1);
 888                 bttv_risc_overlay(btv, &buf->bottom, fmt, ov, 1, 0);
 889                 break;
 890         default:
 891                 BUG();
 892         }
 893
 894         /* copy format info */
 895         buf->btformat = fmt->btformat;
 896         buf->btswap   = fmt->btswap;
 897         buf->vb.field = ov->field;
 898         return 0;
 899 }
 900
 901 /*
 902  * Local variables:
 903  * c-basic-offset: 8
 904  * End:
 905  */