blit_arm_packed_yuv.c
上传用户:wstnjxml
上传日期:2014-04-03
资源大小:7248k
文件大小:6k
源码类别:

Windows CE

开发平台:

C/C++

  1. /*****************************************************************************
  2.  *
  3.  * This program is free software ; you can redistribute it and/or modify
  4.  * it under the terms of the GNU General Public License as published by
  5.  * the Free Software Foundation; either version 2 of the License, or
  6.  * (at your option) any later version.
  7.  *
  8.  * This program is distributed in the hope that it will be useful,
  9.  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  10.  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  11.  * GNU General Public License for more details.
  12.  *
  13.  * You should have received a copy of the GNU General Public License
  14.  * along with this program; if not, write to the Free Software
  15.  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA
  16.  *
  17.  * $Id: blit_arm_packed_yuv.c 339 2005-11-15 11:22:45Z picard $
  18.  *
  19.  * The Core Pocket Media Player
  20.  * Copyright (c) 2004-2005 Gabor Kovacs
  21.  *
  22.  ****************************************************************************/
  23. #include "../common.h"
  24. #include "../dyncode/dyncode.h"
  25. #include "blit_soft.h"
  26. #if defined(ARM) 
  27. typedef struct stack
  28. {
  29. int EndOfRect;
  30. int DstPitch; 
  31. int DstNext;
  32. int YNext;
  33. int UVNext;
  34. int StackFrame[STACKFRAME];
  35. //void* this   R0
  36. //char* Dst    R1
  37. //char* Src    R2
  38. //int DstPitch R3 can be signed
  39. int SrcPitch; //can be signed
  40. int Width; 
  41. int Height;
  42. int Src2SrcLast;
  43. } stack;
  44. static NOINLINE void PrepairUV(blit_soft* p,bool_t Swap)
  45. {
  46. I3S(ORR,R1,(reg)(Swap?R2:R1),(reg)(Swap?R1:R2),LSL,16);
  47. }
  48. static NOINLINE void PackYUV(blit_soft* p,reg RA,reg RB,bool_t Low)
  49. {
  50. if (p->FX.Brightness < 0)
  51. {
  52. S(); I2C(SUB,RA,RA,-p->FX.Brightness);
  53. C(LT); I2C(MOV,RA,NONE,0);
  54. S(); I2C(SUB,RB,RB,-p->FX.Brightness);
  55. C(LT); I2C(MOV,RB,NONE,0);
  56. }
  57. if (p->FX.Brightness > 0)
  58. {
  59. I2C(ADD,RA,RA,p->FX.Brightness);
  60. I2C(ADD,RB,RB,p->FX.Brightness);
  61. I2C(CMP,NONE,RA,255);
  62. C(GT); I2C(MOV,RA,NONE,255);
  63. I2C(CMP,NONE,RB,255);
  64. C(GT); I2C(MOV,RB,NONE,255);
  65. }
  66. I3S(ORR,R0,(reg)(p->DirX<0?RB:RA),(reg)(p->DirX<0?RA:RB),LSL,16);
  67. I3S(ORR,R0,(reg)(Low?R0:R1),(reg)(Low?R1:R0),LSL,8);
  68. }
  69. void Fix_PackedYUV_YUV(blit_soft* p)
  70. {
  71. pixel Dst;
  72. dyninst* LoopY;
  73. dyninst* LoopX;
  74. bool_t DoubleLine;
  75. p->Caps = VC_BRIGHTNESS;
  76. Dst = p->Dst;
  77. FillInfo(&Dst);
  78. p->DstStepX = p->DirX*4;
  79. p->DoubleX = (boolmem_t)(p->SrcUVX2==1);
  80. p->DoubleY = (boolmem_t)(p->SrcUVY2==1);
  81. DoubleLine = p->SwapXY?p->DoubleX:p->DoubleY;
  82. CodeBegin();
  83. I2C(SUB,SP,SP,OFS(stack,StackFrame));
  84. I2C(LDR,R9,R1,0); //Dst[0] RGB
  85. I2C(LDR,R10,R2,4); //Src[1] U
  86. I2C(LDR,R11,R2,8); //Src[2] V
  87. I2C(LDR,R12,R2,0); //Src[0] Y
  88. I2C(STR,R3,SP,OFS(stack,DstPitch));
  89. I3(MOV,R8,NONE,R3); //DstPitch
  90. I2C(LDR,R7,SP,OFS(stack,SrcPitch));
  91. I2C(LDR,R0,SP,OFS(stack,Height));
  92. I2C(LDR,R4,SP,OFS(stack,Width));
  93. //YNext = (Src->Pitch << DoubleLine) - Width
  94. I3S(RSB,R1,R4,R7,LSL,DoubleLine); 
  95. I2C(STR,R1,SP,OFS(stack,YNext));
  96. //UVNext = ((Src->Pitch >> p->SrcUVPitch2) << (p->SwapXY && !p->DoubleY) - (Width >> SrcUVX);
  97. I3S(MOV,R2,NONE,R7,ASR,p->SrcUVPitch2-(p->SwapXY && !p->DoubleY));
  98. I3S(SUB,R2,R2,R4,LSR,p->SrcUVX2); 
  99. I2C(STR,R2,SP,OFS(stack,UVNext));
  100. if (p->DirX<0) //adjust reversed destination for block size
  101. I2C(SUB,R9,R9,2);
  102. if ((Dst.BitMask[0] & 0xFF)==0) //adjust Y offset
  103. I2C(SUB,R9,R9,1);
  104. if (p->SwapXY)
  105. {
  106. // EndOfRect = Dst + ((Height * DstBPP * DirX) >> 3) - DstPitch
  107. I2C(MOV,R1,NONE,p->DstBPP * p->DirX);
  108. I3(MUL,R0,R1,R0);
  109. I3S(ADD,R0,R9,R0,ASR,3);
  110. I2C(STR,R0,SP,OFS(stack,EndOfRect));
  111. //DstNext = DstStepX - Width*DstPitch;
  112. MB(); I3(MUL,R2,R8,R4);
  113. I2C(MOV,R0,NONE,p->DstStepX); 
  114. I3(SUB,R0,R0,R2); 
  115. I2C(STR,R0,SP,OFS(stack,DstNext));
  116. }
  117. else
  118. {
  119. // EndOfRect = Dst + DstPitch * Height
  120. I3(MUL,R0,R8,R0);
  121. I3(ADD,R0,R9,R0);
  122. I2C(STR,R0,SP,OFS(stack,EndOfRect));
  123. //DstNext = (DstPitch << DoubleLine) - DirX * Width << DstBPP2;
  124. I3S(MOV,R2,NONE,R8,LSL,DoubleLine);
  125. I3S(p->DirX>0?SUB:ADD,R2,R2,R4,LSL,p->DstBPP2); 
  126. I2C(STR,R2,SP,OFS(stack,DstNext));
  127. }
  128. if (DoubleLine)
  129. I3(ADD,R14,R12,R7);
  130. LoopY = Label(1);
  131. if (p->SwapXY)
  132. {
  133. I3(MUL,R4,R8,R4);
  134. I3(ADD,R7,R9,R4);
  135. }
  136. else
  137. {
  138. if (p->DirX > 0)
  139. I3S(ADD,R7,R9,R4,LSL,p->DstBPP2);
  140. else
  141. I3S(SUB,R7,R9,R4,LSL,p->DstBPP2);
  142. }
  143. LoopX = Label(1);
  144. {
  145. //R0,R1,R2,R3,R4,R5,R6 temp
  146. //R7 endofline
  147. //R8 dstpitch
  148. //R9 dst
  149. //R10 src U
  150. //R11 src V
  151. //R12 src Y
  152. //R14 src Y next line (if DoubleY)
  153. //load UV
  154. Byte(); I2C(LDR_POST,R1,R10,(!p->SwapXY && !p->DoubleX)?2:1); //u
  155. Byte(); I2C(LDR_POST,R2,R11,(!p->SwapXY && !p->DoubleX)?2:1); //v
  156. if (DoubleLine)
  157. {
  158. if (p->SwapXY)
  159. {
  160. Byte(); I2C(LDR_POST,R3,R12,1);
  161. Byte(); I2C(LDR_POST,R4,R14,1);
  162. Byte(); I2C(LDR_POST,R5,R12,1);
  163. Byte(); I2C(LDR_POST,R6,R14,1);
  164. }
  165. else
  166. {
  167. Byte(); I2C(LDR_POST,R3,R14,1);
  168. Byte(); I2C(LDR_POST,R4,R14,1);
  169. Byte(); I2C(LDR_POST,R5,R12,1);
  170. Byte(); I2C(LDR_POST,R6,R12,1);
  171. }
  172. PrepairUV(p,Dst.BitMask[1] > Dst.BitMask[2]);
  173. PackYUV(p,R3,R4,(Dst.BitMask[0] & 0xFF)!=0);
  174. if (p->SwapXY)
  175. I3(STR_POST,R0,R9,R8);
  176. else
  177. I3(STR,R0,R9,R8);
  178. }
  179. else
  180. {
  181. Byte(); I2C(LDR_POST,R5,R12,1);
  182. Byte(); I2C(LDR_POST,R6,(reg)(p->SwapXY?R14:R12),1);
  183. PrepairUV(p,Dst.BitMask[1] > Dst.BitMask[2]);
  184. }
  185. PackYUV(p,R5,R6,(Dst.BitMask[0] & 0xFF)!=0);
  186. if (p->SwapXY)
  187. I3(STR_POST,R0,R9,R8);
  188. else
  189. I2C(STR_POST,R0,R9,p->DstStepX);
  190. I3(CMP,NONE,R9,R7);
  191. I0P(B,NE,LoopX);
  192. }
  193. I2C(LDR,R0,SP,OFS(stack,YNext));
  194. I2C(LDR,R4,SP,OFS(stack,DstNext));
  195. I2C(LDR,R6,SP,OFS(stack,UVNext));
  196. I2C(LDR,R5,SP,OFS(stack,EndOfRect));
  197. //increment pointers
  198. I3(ADD,R12,R12,R0);
  199. I3(ADD,R14,R14,R0);
  200. I3(ADD,R9,R9,R4);
  201. I3(ADD,R10,R10,R6);
  202. I3(ADD,R11,R11,R6);
  203. //prepare registers for next row
  204. I2C(LDR,R4,SP,OFS(stack,Width));
  205. I3(CMP,NONE,R9,R5);
  206. I0P(B,NE,LoopY);
  207. I2C(ADD,SP,SP,OFS(stack,StackFrame));
  208. CodeEnd();
  209. }
  210. #endif