libswscale/bfin/yuv2rgb_bfin.c

   1 /*
   2  * Copyright (C) 2007 Marc Hoffman <marc.hoffman@analog.com>
   3  *
   4  * Blackfin video color space converter operations
   5  * convert I420 YV12 to RGB in various formats
   6  *
   7  * This file is part of FFmpeg.
   8  *
   9  * FFmpeg is free software; you can redistribute it and/or
  10  * modify it under the terms of the GNU Lesser General Public
  11  * License as published by the Free Software Foundation; either
  12  * version 2.1 of the License, or (at your option) any later version.
  13  *
  14  * FFmpeg is distributed in the hope that it will be useful,
  15  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  16  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  17  * Lesser General Public License for more details.
  18  *
  19  * You should have received a copy of the GNU Lesser General Public
  20  * License along with FFmpeg; if not, write to the Free Software
  21  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
  22  */
  23
  24 #include <stdio.h>
  25 #include <stdlib.h>
  26 #include <string.h>
  27 #include <inttypes.h>
  28 #include <assert.h>
  29 #include "config.h"
  30 #include <unistd.h>
  31 #include "libswscale/rgb2rgb.h"
  32 #include "libswscale/swscale.h"
  33 #include "libswscale/swscale_internal.h"
  34
  35 #ifdef __FDPIC__
  36 #define L1CODE __attribute__ ((l1_text))
  37 #else
  38 #define L1CODE
  39 #endif
  40
  41 void ff_bfin_yuv2rgb555_line(uint8_t *Y, uint8_t *U, uint8_t *V, uint8_t *out,
  42                              int w, uint32_t *coeffs) L1CODE;
  43
  44 void ff_bfin_yuv2rgb565_line(uint8_t *Y, uint8_t *U, uint8_t *V, uint8_t *out,
  45                              int w, uint32_t *coeffs) L1CODE;
  46
  47 void ff_bfin_yuv2rgb24_line(uint8_t *Y, uint8_t *U, uint8_t *V, uint8_t *out,
  48                             int w, uint32_t *coeffs) L1CODE;
  49
  50 typedef void (* ltransform)(uint8_t *Y, uint8_t *U, uint8_t *V, uint8_t *out,
  51                             int w, uint32_t *coeffs);
  52
  53
  54 static void bfin_prepare_coefficients(SwsContext *c, int rgb, int masks)
  55 {
  56     int oy;
  57     oy      = c->yOffset&0xffff;
  58     oy      = oy >> 3; // keep everything U8.0 for offset calculation
  59
  60     c->oc   = 128*0x01010101U;
  61     c->oy   =  oy*0x01010101U;
  62
  63     /* copy 64bit vector coeffs down to 32bit vector coeffs */
  64     c->cy  = c->yCoeff;
  65     c->zero = 0;
  66
  67     if (rgb) {
  68         c->crv = c->vrCoeff;
  69         c->cbu = c->ubCoeff;
  70         c->cgu = c->ugCoeff;
  71         c->cgv = c->vgCoeff;
  72     } else {
  73         c->crv = c->ubCoeff;
  74         c->cbu = c->vrCoeff;
  75         c->cgu = c->vgCoeff;
  76         c->cgv = c->ugCoeff;
  77     }
  78
  79
  80     if (masks == 555) {
  81         c->rmask = 0x001f * 0x00010001U;
  82         c->gmask = 0x03e0 * 0x00010001U;
  83         c->bmask = 0x7c00 * 0x00010001U;
  84     } else if (masks == 565) {
  85         c->rmask = 0x001f * 0x00010001U;
  86         c->gmask = 0x07e0 * 0x00010001U;
  87         c->bmask = 0xf800 * 0x00010001U;
  88     }
  89 }
  90
  91 static int core_yuv420_rgb(SwsContext *c,
  92                            uint8_t **in, int *instrides,
  93                            int srcSliceY, int srcSliceH,
  94                            uint8_t **oplanes, int *outstrides,
  95                            ltransform lcscf, int rgb, int masks)
  96 {
  97     uint8_t *py,*pu,*pv,*op;
  98     int w  = instrides[0];
  99     int h2 = srcSliceH>>1;
 100     int i;
 101
 102     bfin_prepare_coefficients(c, rgb, masks);
 103
 104     py = in[0];
 105     pu = in[1+(1^rgb)];
 106     pv = in[1+(0^rgb)];
 107
 108     op = oplanes[0] + srcSliceY*outstrides[0];
 109
 110     for (i=0;i<h2;i++) {
 111
 112         lcscf(py, pu, pv, op, w, &c->oy);
 113
 114         py += instrides[0];
 115         op += outstrides[0];
 116
 117         lcscf(py, pu, pv, op, w, &c->oy);
 118
 119         py += instrides[0];
 120         pu += instrides[1];
 121         pv += instrides[2];
 122         op += outstrides[0];
 123     }
 124
 125     return srcSliceH;
 126 }
 127
 128
 129 static int bfin_yuv420_rgb555(SwsContext *c,
 130                               uint8_t **in, int *instrides,
 131                               int srcSliceY, int srcSliceH,
 132                               uint8_t **oplanes, int *outstrides)
 133 {
 134     return core_yuv420_rgb(c, in, instrides, srcSliceY, srcSliceH, oplanes,
 135                            outstrides, ff_bfin_yuv2rgb555_line, 1, 555);
 136 }
 137
 138 static int bfin_yuv420_bgr555(SwsContext *c,
 139                               uint8_t **in, int *instrides,
 140                               int srcSliceY, int srcSliceH,
 141                               uint8_t **oplanes, int *outstrides)
 142 {
 143     return core_yuv420_rgb(c, in, instrides, srcSliceY, srcSliceH, oplanes,
 144                            outstrides, ff_bfin_yuv2rgb555_line, 0, 555);
 145 }
 146
 147 static int bfin_yuv420_rgb24(SwsContext *c,
 148                              uint8_t **in, int *instrides,
 149                              int srcSliceY, int srcSliceH,
 150                              uint8_t **oplanes, int *outstrides)
 151 {
 152     return core_yuv420_rgb(c, in, instrides, srcSliceY, srcSliceH, oplanes,
 153                            outstrides, ff_bfin_yuv2rgb24_line, 1, 888);
 154 }
 155
 156 static int bfin_yuv420_bgr24(SwsContext *c,
 157                              uint8_t **in, int *instrides,
 158                              int srcSliceY, int srcSliceH,
 159                              uint8_t **oplanes, int *outstrides)
 160 {
 161     return core_yuv420_rgb(c, in, instrides, srcSliceY, srcSliceH, oplanes,
 162                            outstrides, ff_bfin_yuv2rgb24_line, 0, 888);
 163 }
 164
 165 static int bfin_yuv420_rgb565(SwsContext *c,
 166                               uint8_t **in, int *instrides,
 167                               int srcSliceY, int srcSliceH,
 168                               uint8_t **oplanes, int *outstrides)
 169 {
 170     return core_yuv420_rgb(c, in, instrides, srcSliceY, srcSliceH, oplanes,
 171                            outstrides, ff_bfin_yuv2rgb565_line, 1, 565);
 172 }
 173
 174 static int bfin_yuv420_bgr565(SwsContext *c,
 175                               uint8_t **in, int *instrides,
 176                               int srcSliceY, int srcSliceH,
 177                               uint8_t **oplanes, int *outstrides)
 178 {
 179     return core_yuv420_rgb(c, in, instrides, srcSliceY, srcSliceH, oplanes,
 180                            outstrides, ff_bfin_yuv2rgb565_line, 0, 565);
 181 }
 182
 183
 184 SwsFunc ff_yuv2rgb_get_func_ptr_bfin(SwsContext *c)
 185 {
 186     SwsFunc f;
 187
 188     switch(c->dstFormat) {
 189     case PIX_FMT_RGB555: f = bfin_yuv420_rgb555; break;
 190     case PIX_FMT_BGR555: f = bfin_yuv420_bgr555; break;
 191     case PIX_FMT_RGB565: f = bfin_yuv420_rgb565; break;
 192     case PIX_FMT_BGR565: f = bfin_yuv420_bgr565; break;
 193     case PIX_FMT_RGB24:  f = bfin_yuv420_rgb24;  break;
 194     case PIX_FMT_BGR24:  f = bfin_yuv420_bgr24;  break;
 195     default:
 196         return 0;
 197     }
 198
 199     av_log(c, AV_LOG_INFO, "BlackFin accelerated color space converter %s\n",
 200            sws_format_name (c->dstFormat));
 201
 202     return f;
 203 }