开通博客赚积分
发布资源赚积分
分类

源码开发语言/平台
当前位置：首页 > 源码/资料 > 嵌入式/单片机编程 > Windows CE > 查看源码
dsputil_h264_template_mmx.c
资源名称：tcpmp.rar　[点击查看]
上传用户：wstnjxml
上传日期：2014-04-03
资源大小：7248k
文件大小：5k
源码类别：

Windows CE

开发平台：

C/C++

dsputil_h264_template_mmx.c：源码内容
  1. /*
  2.  * Copyright (c) 2005 Zoltan Hidvegi <hzoli -a- hzoli -d- com>
  3.  *
  4.  * This library is free software; you can redistribute it and/or
  5.  * modify it under the terms of the GNU Lesser General Public
  6.  * License as published by the Free Software Foundation; either
  7.  * version 2 of the License, or (at your option) any later version.
  8.  *
  9.  * This library is distributed in the hope that it will be useful,
  10.  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  11.  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  12.  * Lesser General Public License for more details.
  13.  *
  14.  * You should have received a copy of the GNU Lesser General Public
  15.  * License along with this library; if not, write to the Free Software
  16.  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  17.  */
  19. /**
  20.  * MMX optimized version of (put|avg)_h264_chroma_mc8.
  21.  * H264_CHROMA_MC8_TMPL must be defined to the desired function name and
  22.  * H264_CHROMA_OP must be defined to empty for put and pavgb/pavgusb for avg.
  23.  */
  24. static void H264_CHROMA_MC8_TMPL(uint8_t *dst/*align 8*/, uint8_t *src/*align 1*/, int stride, int h, int x, int y)
  25. {
  26.     uint64_t AA __align8;
  27.     uint64_t DD __align8;
  28.     unsigned long srcos = (long)src & 7;
  29.     uint64_t sh1 __align8 = srcos * 8;
  30.     uint64_t sh2 __align8 = 56 - sh1;
  31.     int i;
  33.     assert(x<8 && y<8 && x>=0 && y>=0);
  35.     asm volatile("movd %1, %%mm4nt"
  36.                  "movd %2, %%mm6nt"
  37.                  "punpcklwd %%mm4, %%mm4nt"
  38.                  "punpcklwd %%mm6, %%mm6nt"
  39.                  "punpckldq %%mm4, %%mm4nt" /* mm4 = x words */
  40.                  "punpckldq %%mm6, %%mm6nt" /* mm6 = y words */
  41.                  "movq %%mm4, %%mm5nt"
  42.                  "pmullw %%mm6, %%mm4nt"    /* mm4 = x * y */
  43.                  "psllw $3, %%mm5nt"
  44.                  "psllw $3, %%mm6nt"
  45.                  "movq %%mm5, %%mm7nt"
  46.                  "paddw %%mm6, %%mm7nt"
  47.                  "movq %%mm4, %0nt"         /* DD = x * y */
  48.                  "psubw %%mm4, %%mm5nt"     /* mm5 = B = 8x - xy */
  49.                  "psubw %%mm4, %%mm6nt"     /* mm6 = C = 8y - xy */
  50.                  "paddw %3, %%mm4nt"
  51.                  "psubw %%mm7, %%mm4nt"     /* mm4 = A = xy - (8x+8y) + 64 */
  52.                  "pxor %%mm7, %%mm7nt"
  53.                  : "=m" (DD) : "rm" (x), "rm" (y), "m" (ff_pw_64));
  55.     asm volatile("movq %%mm4, %0" : "=m" (AA));
  57.     src -= srcos;
  58.     asm volatile(
  59.         /* mm0 = src[0..7], mm1 = src[1..8] */
  60.         "movq %0, %%mm1nt"
  61.         "movq %1, %%mm0nt"
  62.         "psrlq %2, %%mm1nt"
  63.         "psllq %3, %%mm0nt"
  64.         "movq %%mm0, %%mm4nt"
  65.         "psllq $8, %%mm0nt"
  66.         "por %%mm1, %%mm0nt"
  67.         "psrlq $8, %%mm1nt"
  68.         "por %%mm4, %%mm1nt"
  69.         : : "m" (src[0]), "m" (src[8]), "m" (sh1), "m" (sh2));
  71.     for(i=0; i<h; i++) {
  72.         asm volatile(
  73.             /* [mm2,mm3] = A * src[0..7] */
  74.             "movq %%mm0, %%mm2nt"
  75.             "punpcklbw %%mm7, %%mm2nt"
  76.             "pmullw %0, %%mm2nt"
  77.             "movq %%mm0, %%mm3nt"
  78.             "punpckhbw %%mm7, %%mm3nt"
  79.             "pmullw %0, %%mm3nt"
  81.             /* [mm2,mm3] += B * src[1..8] */
  82.             "movq %%mm1, %%mm0nt"
  83.             "punpcklbw %%mm7, %%mm0nt"
  84.             "pmullw %%mm5, %%mm0nt"
  85.             "punpckhbw %%mm7, %%mm1nt"
  86.             "pmullw %%mm5, %%mm1nt"
  87.             "paddw %%mm0, %%mm2nt"
  88.             "paddw %%mm1, %%mm3nt"
  89.             : : "m" (AA));
  91.         src += stride;
  92.         asm volatile(
  93.             /* mm0 = src[0..7], mm1 = src[1..8] */
  94.             "movq %0, %%mm1nt"
  95.             "movq %1, %%mm0nt"
  96.             "psrlq %2, %%mm1nt"
  97.             "psllq %3, %%mm0nt"
  98.             "movq %%mm0, %%mm4nt"
  99.             "psllq $8, %%mm0nt"
  100.             "por %%mm1, %%mm0nt"
  101.             "psrlq $8, %%mm1nt"
  102.             "por %%mm4, %%mm1nt"
  103.             : : "m" (src[0]), "m" (src[8]), "m" (sh1), "m" (sh2));
  105.         asm volatile(
  106.             /* [mm2,mm3] += C *  src[0..7] */
  107.             "movq %mm0, %mm4nt"
  108.             "punpcklbw %mm7, %mm4nt"
  109.             "pmullw %mm6, %mm4nt"
  110.             "paddw %mm4, %mm2nt"
  111.             "movq %mm0, %mm4nt"
  112.             "punpckhbw %mm7, %mm4nt"
  113.             "pmullw %mm6, %mm4nt"
  114.             "paddw %mm4, %mm3nt");
  116.         asm volatile(
  117.             /* [mm2,mm3] += D *  src[1..8] */
  118.             "movq %%mm1, %%mm4nt"
  119.             "punpcklbw %%mm7, %%mm4nt"
  120.             "pmullw %0, %%mm4nt"
  121.             "paddw %%mm4, %%mm2nt"
  122.             "movq %%mm1, %%mm4nt"
  123.             "punpckhbw %%mm7, %%mm4nt"
  124.             "pmullw %0, %%mm4nt"
  125.             "paddw %%mm4, %%mm3nt"
  126.             : : "m" (DD));
  128.         asm volatile(
  129.             /* dst[0..7] = pack(([mm2,mm3] + 32) >> 6) */
  130.             "paddw %1, %%mm2nt"
  131.             "paddw %1, %%mm3nt"
  132.             "psrlw $6, %%mm2nt"
  133.             "psrlw $6, %%mm3nt"
  134.             "packuswb %%mm3, %%mm2nt"
  135.             H264_CHROMA_OP(%0, %%mm2)
  136.             "movq %%mm2, %0nt"
  137.             : "=m" (dst[0]) : "m" (ff_pw_32));
  138.         dst+= stride;
  139.     }
  140. }