swscale.c 107 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324232523262327232823292330233123322333233423352336233723382339234023412342234323442345234623472348234923502351235223532354235523562357235823592360236123622363236423652366236723682369237023712372237323742375237623772378237923802381238223832384238523862387238823892390239123922393239423952396239723982399240024012402240324042405240624072408240924102411241224132414241524162417241824192420242124222423242424252426242724282429243024312432243324342435243624372438243924402441244224432444244524462447244824492450245124522453245424552456245724582459246024612462246324642465246624672468246924702471247224732474247524762477247824792480248124822483248424852486248724882489249024912492249324942495249624972498249925002501250225032504250525062507250825092510251125122513251425152516251725182519252025212522252325242525252625272528252925302531253225332534253525362537253825392540254125422543254425452546254725482549255025512552255325542555255625572558255925602561256225632564256525662567256825692570257125722573257425752576257725782579258025812582258325842585258625872588258925902591259225932594259525962597259825992600260126022603260426052606260726082609261026112612261326142615261626172618261926202621262226232624262526262627262826292630263126322633263426352636263726382639264026412642264326442645264626472648264926502651265226532654265526562657265826592660266126622663266426652666266726682669267026712672267326742675267626772678267926802681268226832684268526862687268826892690269126922693269426952696269726982699270027012702270327042705270627072708270927102711271227132714271527162717271827192720272127222723272427252726272727282729273027312732273327342735273627372738273927402741274227432744274527462747274827492750275127522753275427552756275727582759276027612762276327642765276627672768276927702771277227732774277527762777277827792780278127822783278427852786278727882789279027912792279327942795279627972798279928002801280228032804280528062807280828092810281128122813281428152816281728182819282028212822282328242825282628272828282928302831283228332834283528362837283828392840284128422843284428452846284728482849285028512852285328542855285628572858285928602861286228632864286528662867286828692870287128722873287428752876287728782879288028812882288328842885288628872888288928902891289228932894289528962897289828992900290129022903290429052906290729082909291029112912291329142915291629172918291929202921292229232924292529262927292829292930293129322933293429352936293729382939294029412942294329442945294629472948294929502951295229532954295529562957295829592960296129622963296429652966296729682969297029712972297329742975297629772978297929802981298229832984298529862987298829892990299129922993299429952996299729982999300030013002300330043005300630073008300930103011301230133014301530163017301830193020302130223023302430253026302730283029303030313032303330343035303630373038303930403041304230433044304530463047304830493050305130523053305430553056305730583059306030613062306330643065306630673068306930703071307230733074307530763077307830793080308130823083308430853086308730883089309030913092309330943095309630973098309931003101310231033104310531063107310831093110311131123113311431153116311731183119312031213122312331243125312631273128312931303131313231333134313531363137313831393140314131423143314431453146314731483149315031513152315331543155315631573158315931603161316231633164316531663167316831693170317131723173317431753176317731783179318031813182318331843185318631873188318931903191319231933194319531963197
  1. /*
  2. * Copyright (C) 2001-2003 Michael Niedermayer <michaelni@gmx.at>
  3. *
  4. * This file is part of FFmpeg.
  5. *
  6. * FFmpeg is free software; you can redistribute it and/or modify
  7. * it under the terms of the GNU General Public License as published by
  8. * the Free Software Foundation; either version 2 of the License, or
  9. * (at your option) any later version.
  10. *
  11. * FFmpeg is distributed in the hope that it will be useful,
  12. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  14. * GNU General Public License for more details.
  15. *
  16. * You should have received a copy of the GNU General Public License
  17. * along with FFmpeg; if not, write to the Free Software
  18. * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
  19. *
  20. * the C code (not assembly, mmx, ...) of this file can be used
  21. * under the LGPL license too
  22. */
  23. /*
  24. supported Input formats: YV12, I420/IYUV, YUY2, UYVY, BGR32, BGR32_1, BGR24, BGR16, BGR15, RGB32, RGB32_1, RGB24, Y8/Y800, YVU9/IF09, PAL8
  25. supported output formats: YV12, I420/IYUV, YUY2, UYVY, {BGR,RGB}{1,4,8,15,16,24,32}, Y8/Y800, YVU9/IF09
  26. {BGR,RGB}{1,4,8,15,16} support dithering
  27. unscaled special converters (YV12=I420=IYUV, Y800=Y8)
  28. YV12 -> {BGR,RGB}{1,4,8,15,16,24,32}
  29. x -> x
  30. YUV9 -> YV12
  31. YUV9/YV12 -> Y800
  32. Y800 -> YUV9/YV12
  33. BGR24 -> BGR32 & RGB24 -> RGB32
  34. BGR32 -> BGR24 & RGB32 -> RGB24
  35. BGR15 -> BGR16
  36. */
  37. /*
  38. tested special converters (most are tested actually, but I did not write it down ...)
  39. YV12 -> BGR16
  40. YV12 -> YV12
  41. BGR15 -> BGR16
  42. BGR16 -> BGR16
  43. YVU9 -> YV12
  44. untested special converters
  45. YV12/I420 -> BGR15/BGR24/BGR32 (it is the yuv2rgb stuff, so it should be OK)
  46. YV12/I420 -> YV12/I420
  47. YUY2/BGR15/BGR24/BGR32/RGB24/RGB32 -> same format
  48. BGR24 -> BGR32 & RGB24 -> RGB32
  49. BGR32 -> BGR24 & RGB32 -> RGB24
  50. BGR24 -> YV12
  51. */
  52. #define _SVID_SOURCE //needed for MAP_ANONYMOUS
  53. #include <inttypes.h>
  54. #include <string.h>
  55. #include <math.h>
  56. #include <stdio.h>
  57. #include <unistd.h>
  58. #include "config.h"
  59. #include <assert.h>
  60. #if HAVE_SYS_MMAN_H
  61. #include <sys/mman.h>
  62. #if defined(MAP_ANON) && !defined(MAP_ANONYMOUS)
  63. #define MAP_ANONYMOUS MAP_ANON
  64. #endif
  65. #endif
  66. #include "swscale.h"
  67. #include "swscale_internal.h"
  68. #include "rgb2rgb.h"
  69. #include "libavutil/x86_cpu.h"
  70. #include "libavutil/bswap.h"
  71. unsigned swscale_version(void)
  72. {
  73. return LIBSWSCALE_VERSION_INT;
  74. }
  75. #undef MOVNTQ
  76. #undef PAVGB
  77. //#undef HAVE_MMX2
  78. //#define HAVE_AMD3DNOW
  79. //#undef HAVE_MMX
  80. //#undef ARCH_X86
  81. //#define WORDS_BIGENDIAN
  82. #define DITHER1XBPP
  83. #define FAST_BGR2YV12 // use 7 bit coefficients instead of 15 bit
  84. #define RET 0xC3 //near return opcode for x86
  85. #ifdef M_PI
  86. #define PI M_PI
  87. #else
  88. #define PI 3.14159265358979323846
  89. #endif
  90. #define isSupportedIn(x) ( \
  91. (x)==PIX_FMT_YUV420P \
  92. || (x)==PIX_FMT_YUVA420P \
  93. || (x)==PIX_FMT_YUYV422 \
  94. || (x)==PIX_FMT_UYVY422 \
  95. || (x)==PIX_FMT_RGB32 \
  96. || (x)==PIX_FMT_RGB32_1 \
  97. || (x)==PIX_FMT_BGR24 \
  98. || (x)==PIX_FMT_BGR565 \
  99. || (x)==PIX_FMT_BGR555 \
  100. || (x)==PIX_FMT_BGR32 \
  101. || (x)==PIX_FMT_BGR32_1 \
  102. || (x)==PIX_FMT_RGB24 \
  103. || (x)==PIX_FMT_RGB565 \
  104. || (x)==PIX_FMT_RGB555 \
  105. || (x)==PIX_FMT_GRAY8 \
  106. || (x)==PIX_FMT_YUV410P \
  107. || (x)==PIX_FMT_YUV440P \
  108. || (x)==PIX_FMT_GRAY16BE \
  109. || (x)==PIX_FMT_GRAY16LE \
  110. || (x)==PIX_FMT_YUV444P \
  111. || (x)==PIX_FMT_YUV422P \
  112. || (x)==PIX_FMT_YUV411P \
  113. || (x)==PIX_FMT_PAL8 \
  114. || (x)==PIX_FMT_BGR8 \
  115. || (x)==PIX_FMT_RGB8 \
  116. || (x)==PIX_FMT_BGR4_BYTE \
  117. || (x)==PIX_FMT_RGB4_BYTE \
  118. || (x)==PIX_FMT_YUV440P \
  119. || (x)==PIX_FMT_MONOWHITE \
  120. || (x)==PIX_FMT_MONOBLACK \
  121. )
  122. #define isSupportedOut(x) ( \
  123. (x)==PIX_FMT_YUV420P \
  124. || (x)==PIX_FMT_YUYV422 \
  125. || (x)==PIX_FMT_UYVY422 \
  126. || (x)==PIX_FMT_YUV444P \
  127. || (x)==PIX_FMT_YUV422P \
  128. || (x)==PIX_FMT_YUV411P \
  129. || isRGB(x) \
  130. || isBGR(x) \
  131. || (x)==PIX_FMT_NV12 \
  132. || (x)==PIX_FMT_NV21 \
  133. || (x)==PIX_FMT_GRAY16BE \
  134. || (x)==PIX_FMT_GRAY16LE \
  135. || (x)==PIX_FMT_GRAY8 \
  136. || (x)==PIX_FMT_YUV410P \
  137. || (x)==PIX_FMT_YUV440P \
  138. )
  139. #define isPacked(x) ( \
  140. (x)==PIX_FMT_PAL8 \
  141. || (x)==PIX_FMT_YUYV422 \
  142. || (x)==PIX_FMT_UYVY422 \
  143. || isRGB(x) \
  144. || isBGR(x) \
  145. )
  146. #define usePal(x) ( \
  147. (x)==PIX_FMT_PAL8 \
  148. || (x)==PIX_FMT_BGR4_BYTE \
  149. || (x)==PIX_FMT_RGB4_BYTE \
  150. || (x)==PIX_FMT_BGR8 \
  151. || (x)==PIX_FMT_RGB8 \
  152. )
  153. #define RGB2YUV_SHIFT 15
  154. #define BY ( (int)(0.114*219/255*(1<<RGB2YUV_SHIFT)+0.5))
  155. #define BV (-(int)(0.081*224/255*(1<<RGB2YUV_SHIFT)+0.5))
  156. #define BU ( (int)(0.500*224/255*(1<<RGB2YUV_SHIFT)+0.5))
  157. #define GY ( (int)(0.587*219/255*(1<<RGB2YUV_SHIFT)+0.5))
  158. #define GV (-(int)(0.419*224/255*(1<<RGB2YUV_SHIFT)+0.5))
  159. #define GU (-(int)(0.331*224/255*(1<<RGB2YUV_SHIFT)+0.5))
  160. #define RY ( (int)(0.299*219/255*(1<<RGB2YUV_SHIFT)+0.5))
  161. #define RV ( (int)(0.500*224/255*(1<<RGB2YUV_SHIFT)+0.5))
  162. #define RU (-(int)(0.169*224/255*(1<<RGB2YUV_SHIFT)+0.5))
  163. extern const int32_t ff_yuv2rgb_coeffs[8][4];
  164. static const double rgb2yuv_table[8][9]={
  165. {0.7152, 0.0722, 0.2126, -0.386, 0.5, -0.115, -0.454, -0.046, 0.5},
  166. {0.7152, 0.0722, 0.2126, -0.386, 0.5, -0.115, -0.454, -0.046, 0.5},
  167. {0.587 , 0.114 , 0.299 , -0.331, 0.5, -0.169, -0.419, -0.081, 0.5},
  168. {0.587 , 0.114 , 0.299 , -0.331, 0.5, -0.169, -0.419, -0.081, 0.5},
  169. {0.59 , 0.11 , 0.30 , -0.331, 0.5, -0.169, -0.421, -0.079, 0.5}, //FCC
  170. {0.587 , 0.114 , 0.299 , -0.331, 0.5, -0.169, -0.419, -0.081, 0.5},
  171. {0.587 , 0.114 , 0.299 , -0.331, 0.5, -0.169, -0.419, -0.081, 0.5}, //SMPTE 170M
  172. {0.701 , 0.087 , 0.212 , -0.384, 0.5 -0.116, -0.445, -0.055, 0.5}, //SMPTE 240M
  173. };
  174. /*
  175. NOTES
  176. Special versions: fast Y 1:1 scaling (no interpolation in y direction)
  177. TODO
  178. more intelligent misalignment avoidance for the horizontal scaler
  179. write special vertical cubic upscale version
  180. optimize C code (YV12 / minmax)
  181. add support for packed pixel YUV input & output
  182. add support for Y8 output
  183. optimize BGR24 & BGR32
  184. add BGR4 output support
  185. write special BGR->BGR scaler
  186. */
  187. #if ARCH_X86 && CONFIG_GPL
  188. DECLARE_ASM_CONST(8, uint64_t, bF8)= 0xF8F8F8F8F8F8F8F8LL;
  189. DECLARE_ASM_CONST(8, uint64_t, bFC)= 0xFCFCFCFCFCFCFCFCLL;
  190. DECLARE_ASM_CONST(8, uint64_t, w10)= 0x0010001000100010LL;
  191. DECLARE_ASM_CONST(8, uint64_t, w02)= 0x0002000200020002LL;
  192. DECLARE_ASM_CONST(8, uint64_t, bm00001111)=0x00000000FFFFFFFFLL;
  193. DECLARE_ASM_CONST(8, uint64_t, bm00000111)=0x0000000000FFFFFFLL;
  194. DECLARE_ASM_CONST(8, uint64_t, bm11111000)=0xFFFFFFFFFF000000LL;
  195. DECLARE_ASM_CONST(8, uint64_t, bm01010101)=0x00FF00FF00FF00FFLL;
  196. const DECLARE_ALIGNED(8, uint64_t, ff_dither4[2]) = {
  197. 0x0103010301030103LL,
  198. 0x0200020002000200LL,};
  199. const DECLARE_ALIGNED(8, uint64_t, ff_dither8[2]) = {
  200. 0x0602060206020602LL,
  201. 0x0004000400040004LL,};
  202. DECLARE_ASM_CONST(8, uint64_t, b16Mask)= 0x001F001F001F001FLL;
  203. DECLARE_ASM_CONST(8, uint64_t, g16Mask)= 0x07E007E007E007E0LL;
  204. DECLARE_ASM_CONST(8, uint64_t, r16Mask)= 0xF800F800F800F800LL;
  205. DECLARE_ASM_CONST(8, uint64_t, b15Mask)= 0x001F001F001F001FLL;
  206. DECLARE_ASM_CONST(8, uint64_t, g15Mask)= 0x03E003E003E003E0LL;
  207. DECLARE_ASM_CONST(8, uint64_t, r15Mask)= 0x7C007C007C007C00LL;
  208. DECLARE_ALIGNED(8, const uint64_t, ff_M24A) = 0x00FF0000FF0000FFLL;
  209. DECLARE_ALIGNED(8, const uint64_t, ff_M24B) = 0xFF0000FF0000FF00LL;
  210. DECLARE_ALIGNED(8, const uint64_t, ff_M24C) = 0x0000FF0000FF0000LL;
  211. #ifdef FAST_BGR2YV12
  212. DECLARE_ALIGNED(8, const uint64_t, ff_bgr2YCoeff) = 0x000000210041000DULL;
  213. DECLARE_ALIGNED(8, const uint64_t, ff_bgr2UCoeff) = 0x0000FFEEFFDC0038ULL;
  214. DECLARE_ALIGNED(8, const uint64_t, ff_bgr2VCoeff) = 0x00000038FFD2FFF8ULL;
  215. #else
  216. DECLARE_ALIGNED(8, const uint64_t, ff_bgr2YCoeff) = 0x000020E540830C8BULL;
  217. DECLARE_ALIGNED(8, const uint64_t, ff_bgr2UCoeff) = 0x0000ED0FDAC23831ULL;
  218. DECLARE_ALIGNED(8, const uint64_t, ff_bgr2VCoeff) = 0x00003831D0E6F6EAULL;
  219. #endif /* FAST_BGR2YV12 */
  220. DECLARE_ALIGNED(8, const uint64_t, ff_bgr2YOffset) = 0x1010101010101010ULL;
  221. DECLARE_ALIGNED(8, const uint64_t, ff_bgr2UVOffset) = 0x8080808080808080ULL;
  222. DECLARE_ALIGNED(8, const uint64_t, ff_w1111) = 0x0001000100010001ULL;
  223. DECLARE_ASM_CONST(8, uint64_t, ff_bgr24toY1Coeff) = 0x0C88000040870C88ULL;
  224. DECLARE_ASM_CONST(8, uint64_t, ff_bgr24toY2Coeff) = 0x20DE4087000020DEULL;
  225. DECLARE_ASM_CONST(8, uint64_t, ff_rgb24toY1Coeff) = 0x20DE0000408720DEULL;
  226. DECLARE_ASM_CONST(8, uint64_t, ff_rgb24toY2Coeff) = 0x0C88408700000C88ULL;
  227. DECLARE_ASM_CONST(8, uint64_t, ff_bgr24toYOffset) = 0x0008400000084000ULL;
  228. DECLARE_ASM_CONST(8, uint64_t, ff_bgr24toUV[2][4]) = {
  229. {0x38380000DAC83838ULL, 0xECFFDAC80000ECFFULL, 0xF6E40000D0E3F6E4ULL, 0x3838D0E300003838ULL},
  230. {0xECFF0000DAC8ECFFULL, 0x3838DAC800003838ULL, 0x38380000D0E33838ULL, 0xF6E4D0E30000F6E4ULL},
  231. };
  232. DECLARE_ASM_CONST(8, uint64_t, ff_bgr24toUVOffset)= 0x0040400000404000ULL;
  233. #endif /* ARCH_X86 && CONFIG_GPL */
  234. // clipping helper table for C implementations:
  235. static unsigned char clip_table[768];
  236. static SwsVector *sws_getConvVec(SwsVector *a, SwsVector *b);
  237. static const uint8_t __attribute__((aligned(8))) dither_2x2_4[2][8]={
  238. { 1, 3, 1, 3, 1, 3, 1, 3, },
  239. { 2, 0, 2, 0, 2, 0, 2, 0, },
  240. };
  241. static const uint8_t __attribute__((aligned(8))) dither_2x2_8[2][8]={
  242. { 6, 2, 6, 2, 6, 2, 6, 2, },
  243. { 0, 4, 0, 4, 0, 4, 0, 4, },
  244. };
  245. const uint8_t __attribute__((aligned(8))) dither_8x8_32[8][8]={
  246. { 17, 9, 23, 15, 16, 8, 22, 14, },
  247. { 5, 29, 3, 27, 4, 28, 2, 26, },
  248. { 21, 13, 19, 11, 20, 12, 18, 10, },
  249. { 0, 24, 6, 30, 1, 25, 7, 31, },
  250. { 16, 8, 22, 14, 17, 9, 23, 15, },
  251. { 4, 28, 2, 26, 5, 29, 3, 27, },
  252. { 20, 12, 18, 10, 21, 13, 19, 11, },
  253. { 1, 25, 7, 31, 0, 24, 6, 30, },
  254. };
  255. #if 0
  256. const uint8_t __attribute__((aligned(8))) dither_8x8_64[8][8]={
  257. { 0, 48, 12, 60, 3, 51, 15, 63, },
  258. { 32, 16, 44, 28, 35, 19, 47, 31, },
  259. { 8, 56, 4, 52, 11, 59, 7, 55, },
  260. { 40, 24, 36, 20, 43, 27, 39, 23, },
  261. { 2, 50, 14, 62, 1, 49, 13, 61, },
  262. { 34, 18, 46, 30, 33, 17, 45, 29, },
  263. { 10, 58, 6, 54, 9, 57, 5, 53, },
  264. { 42, 26, 38, 22, 41, 25, 37, 21, },
  265. };
  266. #endif
  267. const uint8_t __attribute__((aligned(8))) dither_8x8_73[8][8]={
  268. { 0, 55, 14, 68, 3, 58, 17, 72, },
  269. { 37, 18, 50, 32, 40, 22, 54, 35, },
  270. { 9, 64, 5, 59, 13, 67, 8, 63, },
  271. { 46, 27, 41, 23, 49, 31, 44, 26, },
  272. { 2, 57, 16, 71, 1, 56, 15, 70, },
  273. { 39, 21, 52, 34, 38, 19, 51, 33, },
  274. { 11, 66, 7, 62, 10, 65, 6, 60, },
  275. { 48, 30, 43, 25, 47, 29, 42, 24, },
  276. };
  277. #if 0
  278. const uint8_t __attribute__((aligned(8))) dither_8x8_128[8][8]={
  279. { 68, 36, 92, 60, 66, 34, 90, 58, },
  280. { 20, 116, 12, 108, 18, 114, 10, 106, },
  281. { 84, 52, 76, 44, 82, 50, 74, 42, },
  282. { 0, 96, 24, 120, 6, 102, 30, 126, },
  283. { 64, 32, 88, 56, 70, 38, 94, 62, },
  284. { 16, 112, 8, 104, 22, 118, 14, 110, },
  285. { 80, 48, 72, 40, 86, 54, 78, 46, },
  286. { 4, 100, 28, 124, 2, 98, 26, 122, },
  287. };
  288. #endif
  289. #if 1
  290. const uint8_t __attribute__((aligned(8))) dither_8x8_220[8][8]={
  291. {117, 62, 158, 103, 113, 58, 155, 100, },
  292. { 34, 199, 21, 186, 31, 196, 17, 182, },
  293. {144, 89, 131, 76, 141, 86, 127, 72, },
  294. { 0, 165, 41, 206, 10, 175, 52, 217, },
  295. {110, 55, 151, 96, 120, 65, 162, 107, },
  296. { 28, 193, 14, 179, 38, 203, 24, 189, },
  297. {138, 83, 124, 69, 148, 93, 134, 79, },
  298. { 7, 172, 48, 213, 3, 168, 45, 210, },
  299. };
  300. #elif 1
  301. // tries to correct a gamma of 1.5
  302. const uint8_t __attribute__((aligned(8))) dither_8x8_220[8][8]={
  303. { 0, 143, 18, 200, 2, 156, 25, 215, },
  304. { 78, 28, 125, 64, 89, 36, 138, 74, },
  305. { 10, 180, 3, 161, 16, 195, 8, 175, },
  306. {109, 51, 93, 38, 121, 60, 105, 47, },
  307. { 1, 152, 23, 210, 0, 147, 20, 205, },
  308. { 85, 33, 134, 71, 81, 30, 130, 67, },
  309. { 14, 190, 6, 171, 12, 185, 5, 166, },
  310. {117, 57, 101, 44, 113, 54, 97, 41, },
  311. };
  312. #elif 1
  313. // tries to correct a gamma of 2.0
  314. const uint8_t __attribute__((aligned(8))) dither_8x8_220[8][8]={
  315. { 0, 124, 8, 193, 0, 140, 12, 213, },
  316. { 55, 14, 104, 42, 66, 19, 119, 52, },
  317. { 3, 168, 1, 145, 6, 187, 3, 162, },
  318. { 86, 31, 70, 21, 99, 39, 82, 28, },
  319. { 0, 134, 11, 206, 0, 129, 9, 200, },
  320. { 62, 17, 114, 48, 58, 16, 109, 45, },
  321. { 5, 181, 2, 157, 4, 175, 1, 151, },
  322. { 95, 36, 78, 26, 90, 34, 74, 24, },
  323. };
  324. #else
  325. // tries to correct a gamma of 2.5
  326. const uint8_t __attribute__((aligned(8))) dither_8x8_220[8][8]={
  327. { 0, 107, 3, 187, 0, 125, 6, 212, },
  328. { 39, 7, 86, 28, 49, 11, 102, 36, },
  329. { 1, 158, 0, 131, 3, 180, 1, 151, },
  330. { 68, 19, 52, 12, 81, 25, 64, 17, },
  331. { 0, 119, 5, 203, 0, 113, 4, 195, },
  332. { 45, 9, 96, 33, 42, 8, 91, 30, },
  333. { 2, 172, 1, 144, 2, 165, 0, 137, },
  334. { 77, 23, 60, 15, 72, 21, 56, 14, },
  335. };
  336. #endif
  337. const char *sws_format_name(enum PixelFormat format)
  338. {
  339. switch (format) {
  340. case PIX_FMT_YUV420P:
  341. return "yuv420p";
  342. case PIX_FMT_YUVA420P:
  343. return "yuva420p";
  344. case PIX_FMT_YUYV422:
  345. return "yuyv422";
  346. case PIX_FMT_RGB24:
  347. return "rgb24";
  348. case PIX_FMT_BGR24:
  349. return "bgr24";
  350. case PIX_FMT_YUV422P:
  351. return "yuv422p";
  352. case PIX_FMT_YUV444P:
  353. return "yuv444p";
  354. case PIX_FMT_RGB32:
  355. return "rgb32";
  356. case PIX_FMT_YUV410P:
  357. return "yuv410p";
  358. case PIX_FMT_YUV411P:
  359. return "yuv411p";
  360. case PIX_FMT_RGB565:
  361. return "rgb565";
  362. case PIX_FMT_RGB555:
  363. return "rgb555";
  364. case PIX_FMT_GRAY16BE:
  365. return "gray16be";
  366. case PIX_FMT_GRAY16LE:
  367. return "gray16le";
  368. case PIX_FMT_GRAY8:
  369. return "gray8";
  370. case PIX_FMT_MONOWHITE:
  371. return "mono white";
  372. case PIX_FMT_MONOBLACK:
  373. return "mono black";
  374. case PIX_FMT_PAL8:
  375. return "Palette";
  376. case PIX_FMT_YUVJ420P:
  377. return "yuvj420p";
  378. case PIX_FMT_YUVJ422P:
  379. return "yuvj422p";
  380. case PIX_FMT_YUVJ444P:
  381. return "yuvj444p";
  382. case PIX_FMT_XVMC_MPEG2_MC:
  383. return "xvmc_mpeg2_mc";
  384. case PIX_FMT_XVMC_MPEG2_IDCT:
  385. return "xvmc_mpeg2_idct";
  386. case PIX_FMT_UYVY422:
  387. return "uyvy422";
  388. case PIX_FMT_UYYVYY411:
  389. return "uyyvyy411";
  390. case PIX_FMT_RGB32_1:
  391. return "rgb32x";
  392. case PIX_FMT_BGR32_1:
  393. return "bgr32x";
  394. case PIX_FMT_BGR32:
  395. return "bgr32";
  396. case PIX_FMT_BGR565:
  397. return "bgr565";
  398. case PIX_FMT_BGR555:
  399. return "bgr555";
  400. case PIX_FMT_BGR8:
  401. return "bgr8";
  402. case PIX_FMT_BGR4:
  403. return "bgr4";
  404. case PIX_FMT_BGR4_BYTE:
  405. return "bgr4 byte";
  406. case PIX_FMT_RGB8:
  407. return "rgb8";
  408. case PIX_FMT_RGB4:
  409. return "rgb4";
  410. case PIX_FMT_RGB4_BYTE:
  411. return "rgb4 byte";
  412. case PIX_FMT_NV12:
  413. return "nv12";
  414. case PIX_FMT_NV21:
  415. return "nv21";
  416. case PIX_FMT_YUV440P:
  417. return "yuv440p";
  418. case PIX_FMT_VDPAU_H264:
  419. return "vdpau_h264";
  420. case PIX_FMT_VDPAU_MPEG1:
  421. return "vdpau_mpeg1";
  422. case PIX_FMT_VDPAU_MPEG2:
  423. return "vdpau_mpeg2";
  424. case PIX_FMT_VDPAU_WMV3:
  425. return "vdpau_wmv3";
  426. case PIX_FMT_VDPAU_VC1:
  427. return "vdpau_vc1";
  428. default:
  429. return "Unknown format";
  430. }
  431. }
  432. static inline void yuv2yuvXinC(int16_t *lumFilter, int16_t **lumSrc, int lumFilterSize,
  433. int16_t *chrFilter, int16_t **chrSrc, int chrFilterSize,
  434. uint8_t *dest, uint8_t *uDest, uint8_t *vDest, int dstW, int chrDstW)
  435. {
  436. //FIXME Optimize (just quickly written not optimized..)
  437. int i;
  438. for (i=0; i<dstW; i++)
  439. {
  440. int val=1<<18;
  441. int j;
  442. for (j=0; j<lumFilterSize; j++)
  443. val += lumSrc[j][i] * lumFilter[j];
  444. dest[i]= av_clip_uint8(val>>19);
  445. }
  446. if (uDest)
  447. for (i=0; i<chrDstW; i++)
  448. {
  449. int u=1<<18;
  450. int v=1<<18;
  451. int j;
  452. for (j=0; j<chrFilterSize; j++)
  453. {
  454. u += chrSrc[j][i] * chrFilter[j];
  455. v += chrSrc[j][i + VOFW] * chrFilter[j];
  456. }
  457. uDest[i]= av_clip_uint8(u>>19);
  458. vDest[i]= av_clip_uint8(v>>19);
  459. }
  460. }
  461. static inline void yuv2nv12XinC(int16_t *lumFilter, int16_t **lumSrc, int lumFilterSize,
  462. int16_t *chrFilter, int16_t **chrSrc, int chrFilterSize,
  463. uint8_t *dest, uint8_t *uDest, int dstW, int chrDstW, int dstFormat)
  464. {
  465. //FIXME Optimize (just quickly written not optimized..)
  466. int i;
  467. for (i=0; i<dstW; i++)
  468. {
  469. int val=1<<18;
  470. int j;
  471. for (j=0; j<lumFilterSize; j++)
  472. val += lumSrc[j][i] * lumFilter[j];
  473. dest[i]= av_clip_uint8(val>>19);
  474. }
  475. if (!uDest)
  476. return;
  477. if (dstFormat == PIX_FMT_NV12)
  478. for (i=0; i<chrDstW; i++)
  479. {
  480. int u=1<<18;
  481. int v=1<<18;
  482. int j;
  483. for (j=0; j<chrFilterSize; j++)
  484. {
  485. u += chrSrc[j][i] * chrFilter[j];
  486. v += chrSrc[j][i + VOFW] * chrFilter[j];
  487. }
  488. uDest[2*i]= av_clip_uint8(u>>19);
  489. uDest[2*i+1]= av_clip_uint8(v>>19);
  490. }
  491. else
  492. for (i=0; i<chrDstW; i++)
  493. {
  494. int u=1<<18;
  495. int v=1<<18;
  496. int j;
  497. for (j=0; j<chrFilterSize; j++)
  498. {
  499. u += chrSrc[j][i] * chrFilter[j];
  500. v += chrSrc[j][i + VOFW] * chrFilter[j];
  501. }
  502. uDest[2*i]= av_clip_uint8(v>>19);
  503. uDest[2*i+1]= av_clip_uint8(u>>19);
  504. }
  505. }
  506. #define YSCALE_YUV_2_PACKEDX_NOCLIP_C(type) \
  507. for (i=0; i<(dstW>>1); i++){\
  508. int j;\
  509. int Y1 = 1<<18;\
  510. int Y2 = 1<<18;\
  511. int U = 1<<18;\
  512. int V = 1<<18;\
  513. type av_unused *r, *b, *g;\
  514. const int i2= 2*i;\
  515. \
  516. for (j=0; j<lumFilterSize; j++)\
  517. {\
  518. Y1 += lumSrc[j][i2] * lumFilter[j];\
  519. Y2 += lumSrc[j][i2+1] * lumFilter[j];\
  520. }\
  521. for (j=0; j<chrFilterSize; j++)\
  522. {\
  523. U += chrSrc[j][i] * chrFilter[j];\
  524. V += chrSrc[j][i+VOFW] * chrFilter[j];\
  525. }\
  526. Y1>>=19;\
  527. Y2>>=19;\
  528. U >>=19;\
  529. V >>=19;\
  530. #define YSCALE_YUV_2_PACKEDX_C(type) \
  531. YSCALE_YUV_2_PACKEDX_NOCLIP_C(type)\
  532. if ((Y1|Y2|U|V)&256)\
  533. {\
  534. if (Y1>255) Y1=255; \
  535. else if (Y1<0)Y1=0; \
  536. if (Y2>255) Y2=255; \
  537. else if (Y2<0)Y2=0; \
  538. if (U>255) U=255; \
  539. else if (U<0) U=0; \
  540. if (V>255) V=255; \
  541. else if (V<0) V=0; \
  542. }
  543. #define YSCALE_YUV_2_PACKEDX_FULL_C \
  544. for (i=0; i<dstW; i++){\
  545. int j;\
  546. int Y = 0;\
  547. int U = -128<<19;\
  548. int V = -128<<19;\
  549. int R,G,B;\
  550. \
  551. for (j=0; j<lumFilterSize; j++){\
  552. Y += lumSrc[j][i ] * lumFilter[j];\
  553. }\
  554. for (j=0; j<chrFilterSize; j++){\
  555. U += chrSrc[j][i ] * chrFilter[j];\
  556. V += chrSrc[j][i+VOFW] * chrFilter[j];\
  557. }\
  558. Y >>=10;\
  559. U >>=10;\
  560. V >>=10;\
  561. #define YSCALE_YUV_2_RGBX_FULL_C(rnd) \
  562. YSCALE_YUV_2_PACKEDX_FULL_C\
  563. Y-= c->yuv2rgb_y_offset;\
  564. Y*= c->yuv2rgb_y_coeff;\
  565. Y+= rnd;\
  566. R= Y + V*c->yuv2rgb_v2r_coeff;\
  567. G= Y + V*c->yuv2rgb_v2g_coeff + U*c->yuv2rgb_u2g_coeff;\
  568. B= Y + U*c->yuv2rgb_u2b_coeff;\
  569. if ((R|G|B)&(0xC0000000)){\
  570. if (R>=(256<<22)) R=(256<<22)-1; \
  571. else if (R<0)R=0; \
  572. if (G>=(256<<22)) G=(256<<22)-1; \
  573. else if (G<0)G=0; \
  574. if (B>=(256<<22)) B=(256<<22)-1; \
  575. else if (B<0)B=0; \
  576. }\
  577. #define YSCALE_YUV_2_GRAY16_C \
  578. for (i=0; i<(dstW>>1); i++){\
  579. int j;\
  580. int Y1 = 1<<18;\
  581. int Y2 = 1<<18;\
  582. int U = 1<<18;\
  583. int V = 1<<18;\
  584. \
  585. const int i2= 2*i;\
  586. \
  587. for (j=0; j<lumFilterSize; j++)\
  588. {\
  589. Y1 += lumSrc[j][i2] * lumFilter[j];\
  590. Y2 += lumSrc[j][i2+1] * lumFilter[j];\
  591. }\
  592. Y1>>=11;\
  593. Y2>>=11;\
  594. if ((Y1|Y2|U|V)&65536)\
  595. {\
  596. if (Y1>65535) Y1=65535; \
  597. else if (Y1<0)Y1=0; \
  598. if (Y2>65535) Y2=65535; \
  599. else if (Y2<0)Y2=0; \
  600. }
  601. #define YSCALE_YUV_2_RGBX_C(type) \
  602. YSCALE_YUV_2_PACKEDX_C(type) /* FIXME fix tables so that clipping is not needed and then use _NOCLIP*/\
  603. r = (type *)c->table_rV[V]; \
  604. g = (type *)(c->table_gU[U] + c->table_gV[V]); \
  605. b = (type *)c->table_bU[U]; \
  606. #define YSCALE_YUV_2_PACKED2_C \
  607. for (i=0; i<(dstW>>1); i++){ \
  608. const int i2= 2*i; \
  609. int Y1= (buf0[i2 ]*yalpha1+buf1[i2 ]*yalpha)>>19; \
  610. int Y2= (buf0[i2+1]*yalpha1+buf1[i2+1]*yalpha)>>19; \
  611. int U= (uvbuf0[i ]*uvalpha1+uvbuf1[i ]*uvalpha)>>19; \
  612. int V= (uvbuf0[i+VOFW]*uvalpha1+uvbuf1[i+VOFW]*uvalpha)>>19; \
  613. #define YSCALE_YUV_2_GRAY16_2_C \
  614. for (i=0; i<(dstW>>1); i++){ \
  615. const int i2= 2*i; \
  616. int Y1= (buf0[i2 ]*yalpha1+buf1[i2 ]*yalpha)>>11; \
  617. int Y2= (buf0[i2+1]*yalpha1+buf1[i2+1]*yalpha)>>11; \
  618. #define YSCALE_YUV_2_RGB2_C(type) \
  619. YSCALE_YUV_2_PACKED2_C\
  620. type *r, *b, *g;\
  621. r = (type *)c->table_rV[V];\
  622. g = (type *)(c->table_gU[U] + c->table_gV[V]);\
  623. b = (type *)c->table_bU[U];\
  624. #define YSCALE_YUV_2_PACKED1_C \
  625. for (i=0; i<(dstW>>1); i++){\
  626. const int i2= 2*i;\
  627. int Y1= buf0[i2 ]>>7;\
  628. int Y2= buf0[i2+1]>>7;\
  629. int U= (uvbuf1[i ])>>7;\
  630. int V= (uvbuf1[i+VOFW])>>7;\
  631. #define YSCALE_YUV_2_GRAY16_1_C \
  632. for (i=0; i<(dstW>>1); i++){\
  633. const int i2= 2*i;\
  634. int Y1= buf0[i2 ]<<1;\
  635. int Y2= buf0[i2+1]<<1;\
  636. #define YSCALE_YUV_2_RGB1_C(type) \
  637. YSCALE_YUV_2_PACKED1_C\
  638. type *r, *b, *g;\
  639. r = (type *)c->table_rV[V];\
  640. g = (type *)(c->table_gU[U] + c->table_gV[V]);\
  641. b = (type *)c->table_bU[U];\
  642. #define YSCALE_YUV_2_PACKED1B_C \
  643. for (i=0; i<(dstW>>1); i++){\
  644. const int i2= 2*i;\
  645. int Y1= buf0[i2 ]>>7;\
  646. int Y2= buf0[i2+1]>>7;\
  647. int U= (uvbuf0[i ] + uvbuf1[i ])>>8;\
  648. int V= (uvbuf0[i+VOFW] + uvbuf1[i+VOFW])>>8;\
  649. #define YSCALE_YUV_2_RGB1B_C(type) \
  650. YSCALE_YUV_2_PACKED1B_C\
  651. type *r, *b, *g;\
  652. r = (type *)c->table_rV[V];\
  653. g = (type *)(c->table_gU[U] + c->table_gV[V]);\
  654. b = (type *)c->table_bU[U];\
  655. #define YSCALE_YUV_2_MONO2_C \
  656. const uint8_t * const d128=dither_8x8_220[y&7];\
  657. uint8_t *g= c->table_gU[128] + c->table_gV[128];\
  658. for (i=0; i<dstW-7; i+=8){\
  659. int acc;\
  660. acc = g[((buf0[i ]*yalpha1+buf1[i ]*yalpha)>>19) + d128[0]];\
  661. acc+= acc + g[((buf0[i+1]*yalpha1+buf1[i+1]*yalpha)>>19) + d128[1]];\
  662. acc+= acc + g[((buf0[i+2]*yalpha1+buf1[i+2]*yalpha)>>19) + d128[2]];\
  663. acc+= acc + g[((buf0[i+3]*yalpha1+buf1[i+3]*yalpha)>>19) + d128[3]];\
  664. acc+= acc + g[((buf0[i+4]*yalpha1+buf1[i+4]*yalpha)>>19) + d128[4]];\
  665. acc+= acc + g[((buf0[i+5]*yalpha1+buf1[i+5]*yalpha)>>19) + d128[5]];\
  666. acc+= acc + g[((buf0[i+6]*yalpha1+buf1[i+6]*yalpha)>>19) + d128[6]];\
  667. acc+= acc + g[((buf0[i+7]*yalpha1+buf1[i+7]*yalpha)>>19) + d128[7]];\
  668. ((uint8_t*)dest)[0]= c->dstFormat == PIX_FMT_MONOBLACK ? acc : ~acc;\
  669. dest++;\
  670. }\
  671. #define YSCALE_YUV_2_MONOX_C \
  672. const uint8_t * const d128=dither_8x8_220[y&7];\
  673. uint8_t *g= c->table_gU[128] + c->table_gV[128];\
  674. int acc=0;\
  675. for (i=0; i<dstW-1; i+=2){\
  676. int j;\
  677. int Y1=1<<18;\
  678. int Y2=1<<18;\
  679. \
  680. for (j=0; j<lumFilterSize; j++)\
  681. {\
  682. Y1 += lumSrc[j][i] * lumFilter[j];\
  683. Y2 += lumSrc[j][i+1] * lumFilter[j];\
  684. }\
  685. Y1>>=19;\
  686. Y2>>=19;\
  687. if ((Y1|Y2)&256)\
  688. {\
  689. if (Y1>255) Y1=255;\
  690. else if (Y1<0)Y1=0;\
  691. if (Y2>255) Y2=255;\
  692. else if (Y2<0)Y2=0;\
  693. }\
  694. acc+= acc + g[Y1+d128[(i+0)&7]];\
  695. acc+= acc + g[Y2+d128[(i+1)&7]];\
  696. if ((i&7)==6){\
  697. ((uint8_t*)dest)[0]= c->dstFormat == PIX_FMT_MONOBLACK ? acc : ~acc;\
  698. dest++;\
  699. }\
  700. }
  701. #define YSCALE_YUV_2_ANYRGB_C(func, func2, func_g16, func_monoblack)\
  702. switch(c->dstFormat)\
  703. {\
  704. case PIX_FMT_RGB32:\
  705. case PIX_FMT_BGR32:\
  706. case PIX_FMT_RGB32_1:\
  707. case PIX_FMT_BGR32_1:\
  708. func(uint32_t)\
  709. ((uint32_t*)dest)[i2+0]= r[Y1] + g[Y1] + b[Y1];\
  710. ((uint32_t*)dest)[i2+1]= r[Y2] + g[Y2] + b[Y2];\
  711. } \
  712. break;\
  713. case PIX_FMT_RGB24:\
  714. func(uint8_t)\
  715. ((uint8_t*)dest)[0]= r[Y1];\
  716. ((uint8_t*)dest)[1]= g[Y1];\
  717. ((uint8_t*)dest)[2]= b[Y1];\
  718. ((uint8_t*)dest)[3]= r[Y2];\
  719. ((uint8_t*)dest)[4]= g[Y2];\
  720. ((uint8_t*)dest)[5]= b[Y2];\
  721. dest+=6;\
  722. }\
  723. break;\
  724. case PIX_FMT_BGR24:\
  725. func(uint8_t)\
  726. ((uint8_t*)dest)[0]= b[Y1];\
  727. ((uint8_t*)dest)[1]= g[Y1];\
  728. ((uint8_t*)dest)[2]= r[Y1];\
  729. ((uint8_t*)dest)[3]= b[Y2];\
  730. ((uint8_t*)dest)[4]= g[Y2];\
  731. ((uint8_t*)dest)[5]= r[Y2];\
  732. dest+=6;\
  733. }\
  734. break;\
  735. case PIX_FMT_RGB565:\
  736. case PIX_FMT_BGR565:\
  737. {\
  738. const int dr1= dither_2x2_8[y&1 ][0];\
  739. const int dg1= dither_2x2_4[y&1 ][0];\
  740. const int db1= dither_2x2_8[(y&1)^1][0];\
  741. const int dr2= dither_2x2_8[y&1 ][1];\
  742. const int dg2= dither_2x2_4[y&1 ][1];\
  743. const int db2= dither_2x2_8[(y&1)^1][1];\
  744. func(uint16_t)\
  745. ((uint16_t*)dest)[i2+0]= r[Y1+dr1] + g[Y1+dg1] + b[Y1+db1];\
  746. ((uint16_t*)dest)[i2+1]= r[Y2+dr2] + g[Y2+dg2] + b[Y2+db2];\
  747. }\
  748. }\
  749. break;\
  750. case PIX_FMT_RGB555:\
  751. case PIX_FMT_BGR555:\
  752. {\
  753. const int dr1= dither_2x2_8[y&1 ][0];\
  754. const int dg1= dither_2x2_8[y&1 ][1];\
  755. const int db1= dither_2x2_8[(y&1)^1][0];\
  756. const int dr2= dither_2x2_8[y&1 ][1];\
  757. const int dg2= dither_2x2_8[y&1 ][0];\
  758. const int db2= dither_2x2_8[(y&1)^1][1];\
  759. func(uint16_t)\
  760. ((uint16_t*)dest)[i2+0]= r[Y1+dr1] + g[Y1+dg1] + b[Y1+db1];\
  761. ((uint16_t*)dest)[i2+1]= r[Y2+dr2] + g[Y2+dg2] + b[Y2+db2];\
  762. }\
  763. }\
  764. break;\
  765. case PIX_FMT_RGB8:\
  766. case PIX_FMT_BGR8:\
  767. {\
  768. const uint8_t * const d64= dither_8x8_73[y&7];\
  769. const uint8_t * const d32= dither_8x8_32[y&7];\
  770. func(uint8_t)\
  771. ((uint8_t*)dest)[i2+0]= r[Y1+d32[(i2+0)&7]] + g[Y1+d32[(i2+0)&7]] + b[Y1+d64[(i2+0)&7]];\
  772. ((uint8_t*)dest)[i2+1]= r[Y2+d32[(i2+1)&7]] + g[Y2+d32[(i2+1)&7]] + b[Y2+d64[(i2+1)&7]];\
  773. }\
  774. }\
  775. break;\
  776. case PIX_FMT_RGB4:\
  777. case PIX_FMT_BGR4:\
  778. {\
  779. const uint8_t * const d64= dither_8x8_73 [y&7];\
  780. const uint8_t * const d128=dither_8x8_220[y&7];\
  781. func(uint8_t)\
  782. ((uint8_t*)dest)[i]= r[Y1+d128[(i2+0)&7]] + g[Y1+d64[(i2+0)&7]] + b[Y1+d128[(i2+0)&7]]\
  783. + ((r[Y2+d128[(i2+1)&7]] + g[Y2+d64[(i2+1)&7]] + b[Y2+d128[(i2+1)&7]])<<4);\
  784. }\
  785. }\
  786. break;\
  787. case PIX_FMT_RGB4_BYTE:\
  788. case PIX_FMT_BGR4_BYTE:\
  789. {\
  790. const uint8_t * const d64= dither_8x8_73 [y&7];\
  791. const uint8_t * const d128=dither_8x8_220[y&7];\
  792. func(uint8_t)\
  793. ((uint8_t*)dest)[i2+0]= r[Y1+d128[(i2+0)&7]] + g[Y1+d64[(i2+0)&7]] + b[Y1+d128[(i2+0)&7]];\
  794. ((uint8_t*)dest)[i2+1]= r[Y2+d128[(i2+1)&7]] + g[Y2+d64[(i2+1)&7]] + b[Y2+d128[(i2+1)&7]];\
  795. }\
  796. }\
  797. break;\
  798. case PIX_FMT_MONOBLACK:\
  799. case PIX_FMT_MONOWHITE:\
  800. {\
  801. func_monoblack\
  802. }\
  803. break;\
  804. case PIX_FMT_YUYV422:\
  805. func2\
  806. ((uint8_t*)dest)[2*i2+0]= Y1;\
  807. ((uint8_t*)dest)[2*i2+1]= U;\
  808. ((uint8_t*)dest)[2*i2+2]= Y2;\
  809. ((uint8_t*)dest)[2*i2+3]= V;\
  810. } \
  811. break;\
  812. case PIX_FMT_UYVY422:\
  813. func2\
  814. ((uint8_t*)dest)[2*i2+0]= U;\
  815. ((uint8_t*)dest)[2*i2+1]= Y1;\
  816. ((uint8_t*)dest)[2*i2+2]= V;\
  817. ((uint8_t*)dest)[2*i2+3]= Y2;\
  818. } \
  819. break;\
  820. case PIX_FMT_GRAY16BE:\
  821. func_g16\
  822. ((uint8_t*)dest)[2*i2+0]= Y1>>8;\
  823. ((uint8_t*)dest)[2*i2+1]= Y1;\
  824. ((uint8_t*)dest)[2*i2+2]= Y2>>8;\
  825. ((uint8_t*)dest)[2*i2+3]= Y2;\
  826. } \
  827. break;\
  828. case PIX_FMT_GRAY16LE:\
  829. func_g16\
  830. ((uint8_t*)dest)[2*i2+0]= Y1;\
  831. ((uint8_t*)dest)[2*i2+1]= Y1>>8;\
  832. ((uint8_t*)dest)[2*i2+2]= Y2;\
  833. ((uint8_t*)dest)[2*i2+3]= Y2>>8;\
  834. } \
  835. break;\
  836. }\
  837. static inline void yuv2packedXinC(SwsContext *c, int16_t *lumFilter, int16_t **lumSrc, int lumFilterSize,
  838. int16_t *chrFilter, int16_t **chrSrc, int chrFilterSize,
  839. uint8_t *dest, int dstW, int y)
  840. {
  841. int i;
  842. YSCALE_YUV_2_ANYRGB_C(YSCALE_YUV_2_RGBX_C, YSCALE_YUV_2_PACKEDX_C(void), YSCALE_YUV_2_GRAY16_C, YSCALE_YUV_2_MONOX_C)
  843. }
  844. static inline void yuv2rgbXinC_full(SwsContext *c, int16_t *lumFilter, int16_t **lumSrc, int lumFilterSize,
  845. int16_t *chrFilter, int16_t **chrSrc, int chrFilterSize,
  846. uint8_t *dest, int dstW, int y)
  847. {
  848. int i;
  849. int step= fmt_depth(c->dstFormat)/8;
  850. int aidx= 3;
  851. switch(c->dstFormat){
  852. case PIX_FMT_ARGB:
  853. dest++;
  854. aidx= -1;
  855. case PIX_FMT_RGB24:
  856. aidx--;
  857. case PIX_FMT_RGBA:
  858. YSCALE_YUV_2_RGBX_FULL_C(1<<21)
  859. dest[aidx]= 255;
  860. dest[0]= R>>22;
  861. dest[1]= G>>22;
  862. dest[2]= B>>22;
  863. dest+= step;
  864. }
  865. break;
  866. case PIX_FMT_ABGR:
  867. dest++;
  868. aidx= -1;
  869. case PIX_FMT_BGR24:
  870. aidx--;
  871. case PIX_FMT_BGRA:
  872. YSCALE_YUV_2_RGBX_FULL_C(1<<21)
  873. dest[aidx]= 255;
  874. dest[0]= B>>22;
  875. dest[1]= G>>22;
  876. dest[2]= R>>22;
  877. dest+= step;
  878. }
  879. break;
  880. default:
  881. assert(0);
  882. }
  883. }
  884. //Note: we have C, X86, MMX, MMX2, 3DNOW versions, there is no 3DNOW+MMX2 one
  885. //Plain C versions
  886. #if ((!HAVE_MMX || !CONFIG_GPL) && !HAVE_ALTIVEC) || CONFIG_RUNTIME_CPUDETECT
  887. #define COMPILE_C
  888. #endif
  889. #if ARCH_PPC
  890. #if HAVE_ALTIVEC
  891. #define COMPILE_ALTIVEC
  892. #endif
  893. #endif //ARCH_PPC
  894. #if ARCH_X86
  895. #if ((HAVE_MMX && !HAVE_AMD3DNOW && !HAVE_MMX2) || CONFIG_RUNTIME_CPUDETECT) && CONFIG_GPL
  896. #define COMPILE_MMX
  897. #endif
  898. #if (HAVE_MMX2 || CONFIG_RUNTIME_CPUDETECT) && CONFIG_GPL
  899. #define COMPILE_MMX2
  900. #endif
  901. #if ((HAVE_AMD3DNOW && !HAVE_MMX2) || CONFIG_RUNTIME_CPUDETECT) && CONFIG_GPL
  902. #define COMPILE_3DNOW
  903. #endif
  904. #endif //ARCH_X86
  905. #undef HAVE_MMX
  906. #undef HAVE_MMX2
  907. #undef HAVE_AMD3DNOW
  908. #undef HAVE_ALTIVEC
  909. #define HAVE_MMX 0
  910. #define HAVE_MMX2 0
  911. #define HAVE_AMD3DNOW 0
  912. #define HAVE_ALTIVEC 0
  913. #ifdef COMPILE_C
  914. #define RENAME(a) a ## _C
  915. #include "swscale_template.c"
  916. #endif
  917. #ifdef COMPILE_ALTIVEC
  918. #undef RENAME
  919. #undef HAVE_ALTIVEC
  920. #define HAVE_ALTIVEC 1
  921. #define RENAME(a) a ## _altivec
  922. #include "swscale_template.c"
  923. #endif
  924. #if ARCH_X86
  925. //x86 versions
  926. /*
  927. #undef RENAME
  928. #undef HAVE_MMX
  929. #undef HAVE_MMX2
  930. #undef HAVE_AMD3DNOW
  931. #define ARCH_X86
  932. #define RENAME(a) a ## _X86
  933. #include "swscale_template.c"
  934. */
  935. //MMX versions
  936. #ifdef COMPILE_MMX
  937. #undef RENAME
  938. #undef HAVE_MMX
  939. #undef HAVE_MMX2
  940. #undef HAVE_AMD3DNOW
  941. #define HAVE_MMX 1
  942. #define HAVE_MMX2 0
  943. #define HAVE_AMD3DNOW 0
  944. #define RENAME(a) a ## _MMX
  945. #include "swscale_template.c"
  946. #endif
  947. //MMX2 versions
  948. #ifdef COMPILE_MMX2
  949. #undef RENAME
  950. #undef HAVE_MMX
  951. #undef HAVE_MMX2
  952. #undef HAVE_AMD3DNOW
  953. #define HAVE_MMX 1
  954. #define HAVE_MMX2 1
  955. #define HAVE_AMD3DNOW 0
  956. #define RENAME(a) a ## _MMX2
  957. #include "swscale_template.c"
  958. #endif
  959. //3DNOW versions
  960. #ifdef COMPILE_3DNOW
  961. #undef RENAME
  962. #undef HAVE_MMX
  963. #undef HAVE_MMX2
  964. #undef HAVE_AMD3DNOW
  965. #define HAVE_MMX 1
  966. #define HAVE_MMX2 0
  967. #define HAVE_AMD3DNOW 1
  968. #define RENAME(a) a ## _3DNow
  969. #include "swscale_template.c"
  970. #endif
  971. #endif //ARCH_X86
  972. // minor note: the HAVE_xyz are messed up after this line so don't use them
  973. static double getSplineCoeff(double a, double b, double c, double d, double dist)
  974. {
  975. // printf("%f %f %f %f %f\n", a,b,c,d,dist);
  976. if (dist<=1.0) return ((d*dist + c)*dist + b)*dist +a;
  977. else return getSplineCoeff( 0.0,
  978. b+ 2.0*c + 3.0*d,
  979. c + 3.0*d,
  980. -b- 3.0*c - 6.0*d,
  981. dist-1.0);
  982. }
  983. static inline int initFilter(int16_t **outFilter, int16_t **filterPos, int *outFilterSize, int xInc,
  984. int srcW, int dstW, int filterAlign, int one, int flags,
  985. SwsVector *srcFilter, SwsVector *dstFilter, double param[2])
  986. {
  987. int i;
  988. int filterSize;
  989. int filter2Size;
  990. int minFilterSize;
  991. int64_t *filter=NULL;
  992. int64_t *filter2=NULL;
  993. const int64_t fone= 1LL<<54;
  994. int ret= -1;
  995. #if ARCH_X86
  996. if (flags & SWS_CPU_CAPS_MMX)
  997. __asm__ volatile("emms\n\t"::: "memory"); //FIXME this should not be required but it IS (even for non-MMX versions)
  998. #endif
  999. // NOTE: the +1 is for the MMX scaler which reads over the end
  1000. *filterPos = av_malloc((dstW+1)*sizeof(int16_t));
  1001. if (FFABS(xInc - 0x10000) <10) // unscaled
  1002. {
  1003. int i;
  1004. filterSize= 1;
  1005. filter= av_mallocz(dstW*sizeof(*filter)*filterSize);
  1006. for (i=0; i<dstW; i++)
  1007. {
  1008. filter[i*filterSize]= fone;
  1009. (*filterPos)[i]=i;
  1010. }
  1011. }
  1012. else if (flags&SWS_POINT) // lame looking point sampling mode
  1013. {
  1014. int i;
  1015. int xDstInSrc;
  1016. filterSize= 1;
  1017. filter= av_malloc(dstW*sizeof(*filter)*filterSize);
  1018. xDstInSrc= xInc/2 - 0x8000;
  1019. for (i=0; i<dstW; i++)
  1020. {
  1021. int xx= (xDstInSrc - ((filterSize-1)<<15) + (1<<15))>>16;
  1022. (*filterPos)[i]= xx;
  1023. filter[i]= fone;
  1024. xDstInSrc+= xInc;
  1025. }
  1026. }
  1027. else if ((xInc <= (1<<16) && (flags&SWS_AREA)) || (flags&SWS_FAST_BILINEAR)) // bilinear upscale
  1028. {
  1029. int i;
  1030. int xDstInSrc;
  1031. if (flags&SWS_BICUBIC) filterSize= 4;
  1032. else if (flags&SWS_X ) filterSize= 4;
  1033. else filterSize= 2; // SWS_BILINEAR / SWS_AREA
  1034. filter= av_malloc(dstW*sizeof(*filter)*filterSize);
  1035. xDstInSrc= xInc/2 - 0x8000;
  1036. for (i=0; i<dstW; i++)
  1037. {
  1038. int xx= (xDstInSrc - ((filterSize-1)<<15) + (1<<15))>>16;
  1039. int j;
  1040. (*filterPos)[i]= xx;
  1041. //bilinear upscale / linear interpolate / area averaging
  1042. for (j=0; j<filterSize; j++)
  1043. {
  1044. int64_t coeff= fone - FFABS((xx<<16) - xDstInSrc)*(fone>>16);
  1045. if (coeff<0) coeff=0;
  1046. filter[i*filterSize + j]= coeff;
  1047. xx++;
  1048. }
  1049. xDstInSrc+= xInc;
  1050. }
  1051. }
  1052. else
  1053. {
  1054. int xDstInSrc;
  1055. int sizeFactor;
  1056. if (flags&SWS_BICUBIC) sizeFactor= 4;
  1057. else if (flags&SWS_X) sizeFactor= 8;
  1058. else if (flags&SWS_AREA) sizeFactor= 1; //downscale only, for upscale it is bilinear
  1059. else if (flags&SWS_GAUSS) sizeFactor= 8; // infinite ;)
  1060. else if (flags&SWS_LANCZOS) sizeFactor= param[0] != SWS_PARAM_DEFAULT ? ceil(2*param[0]) : 6;
  1061. else if (flags&SWS_SINC) sizeFactor= 20; // infinite ;)
  1062. else if (flags&SWS_SPLINE) sizeFactor= 20; // infinite ;)
  1063. else if (flags&SWS_BILINEAR) sizeFactor= 2;
  1064. else {
  1065. sizeFactor= 0; //GCC warning killer
  1066. assert(0);
  1067. }
  1068. if (xInc <= 1<<16) filterSize= 1 + sizeFactor; // upscale
  1069. else filterSize= 1 + (sizeFactor*srcW + dstW - 1)/ dstW;
  1070. if (filterSize > srcW-2) filterSize=srcW-2;
  1071. filter= av_malloc(dstW*sizeof(*filter)*filterSize);
  1072. xDstInSrc= xInc - 0x10000;
  1073. for (i=0; i<dstW; i++)
  1074. {
  1075. int xx= (xDstInSrc - ((filterSize-2)<<16)) / (1<<17);
  1076. int j;
  1077. (*filterPos)[i]= xx;
  1078. for (j=0; j<filterSize; j++)
  1079. {
  1080. int64_t d= ((int64_t)FFABS((xx<<17) - xDstInSrc))<<13;
  1081. double floatd;
  1082. int64_t coeff;
  1083. if (xInc > 1<<16)
  1084. d= d*dstW/srcW;
  1085. floatd= d * (1.0/(1<<30));
  1086. if (flags & SWS_BICUBIC)
  1087. {
  1088. int64_t B= (param[0] != SWS_PARAM_DEFAULT ? param[0] : 0) * (1<<24);
  1089. int64_t C= (param[1] != SWS_PARAM_DEFAULT ? param[1] : 0.6) * (1<<24);
  1090. int64_t dd = ( d*d)>>30;
  1091. int64_t ddd= (dd*d)>>30;
  1092. if (d < 1LL<<30)
  1093. coeff = (12*(1<<24)-9*B-6*C)*ddd + (-18*(1<<24)+12*B+6*C)*dd + (6*(1<<24)-2*B)*(1<<30);
  1094. else if (d < 1LL<<31)
  1095. coeff = (-B-6*C)*ddd + (6*B+30*C)*dd + (-12*B-48*C)*d + (8*B+24*C)*(1<<30);
  1096. else
  1097. coeff=0.0;
  1098. coeff *= fone>>(30+24);
  1099. }
  1100. /* else if (flags & SWS_X)
  1101. {
  1102. double p= param ? param*0.01 : 0.3;
  1103. coeff = d ? sin(d*PI)/(d*PI) : 1.0;
  1104. coeff*= pow(2.0, - p*d*d);
  1105. }*/
  1106. else if (flags & SWS_X)
  1107. {
  1108. double A= param[0] != SWS_PARAM_DEFAULT ? param[0] : 1.0;
  1109. double c;
  1110. if (floatd<1.0)
  1111. c = cos(floatd*PI);
  1112. else
  1113. c=-1.0;
  1114. if (c<0.0) c= -pow(-c, A);
  1115. else c= pow( c, A);
  1116. coeff= (c*0.5 + 0.5)*fone;
  1117. }
  1118. else if (flags & SWS_AREA)
  1119. {
  1120. int64_t d2= d - (1<<29);
  1121. if (d2*xInc < -(1LL<<(29+16))) coeff= 1.0 * (1LL<<(30+16));
  1122. else if (d2*xInc < (1LL<<(29+16))) coeff= -d2*xInc + (1LL<<(29+16));
  1123. else coeff=0.0;
  1124. coeff *= fone>>(30+16);
  1125. }
  1126. else if (flags & SWS_GAUSS)
  1127. {
  1128. double p= param[0] != SWS_PARAM_DEFAULT ? param[0] : 3.0;
  1129. coeff = (pow(2.0, - p*floatd*floatd))*fone;
  1130. }
  1131. else if (flags & SWS_SINC)
  1132. {
  1133. coeff = (d ? sin(floatd*PI)/(floatd*PI) : 1.0)*fone;
  1134. }
  1135. else if (flags & SWS_LANCZOS)
  1136. {
  1137. double p= param[0] != SWS_PARAM_DEFAULT ? param[0] : 3.0;
  1138. coeff = (d ? sin(floatd*PI)*sin(floatd*PI/p)/(floatd*floatd*PI*PI/p) : 1.0)*fone;
  1139. if (floatd>p) coeff=0;
  1140. }
  1141. else if (flags & SWS_BILINEAR)
  1142. {
  1143. coeff= (1<<30) - d;
  1144. if (coeff<0) coeff=0;
  1145. coeff *= fone >> 30;
  1146. }
  1147. else if (flags & SWS_SPLINE)
  1148. {
  1149. double p=-2.196152422706632;
  1150. coeff = getSplineCoeff(1.0, 0.0, p, -p-1.0, floatd) * fone;
  1151. }
  1152. else {
  1153. coeff= 0.0; //GCC warning killer
  1154. assert(0);
  1155. }
  1156. filter[i*filterSize + j]= coeff;
  1157. xx++;
  1158. }
  1159. xDstInSrc+= 2*xInc;
  1160. }
  1161. }
  1162. /* apply src & dst Filter to filter -> filter2
  1163. av_free(filter);
  1164. */
  1165. assert(filterSize>0);
  1166. filter2Size= filterSize;
  1167. if (srcFilter) filter2Size+= srcFilter->length - 1;
  1168. if (dstFilter) filter2Size+= dstFilter->length - 1;
  1169. assert(filter2Size>0);
  1170. filter2= av_mallocz(filter2Size*dstW*sizeof(*filter2));
  1171. for (i=0; i<dstW; i++)
  1172. {
  1173. int j, k;
  1174. if(srcFilter){
  1175. for (k=0; k<srcFilter->length; k++){
  1176. for (j=0; j<filterSize; j++)
  1177. filter2[i*filter2Size + k + j] += srcFilter->coeff[k]*filter[i*filterSize + j];
  1178. }
  1179. }else{
  1180. for (j=0; j<filterSize; j++)
  1181. filter2[i*filter2Size + j]= filter[i*filterSize + j];
  1182. }
  1183. //FIXME dstFilter
  1184. (*filterPos)[i]+= (filterSize-1)/2 - (filter2Size-1)/2;
  1185. }
  1186. av_freep(&filter);
  1187. /* try to reduce the filter-size (step1 find size and shift left) */
  1188. // Assume it is near normalized (*0.5 or *2.0 is OK but * 0.001 is not).
  1189. minFilterSize= 0;
  1190. for (i=dstW-1; i>=0; i--)
  1191. {
  1192. int min= filter2Size;
  1193. int j;
  1194. int64_t cutOff=0.0;
  1195. /* get rid off near zero elements on the left by shifting left */
  1196. for (j=0; j<filter2Size; j++)
  1197. {
  1198. int k;
  1199. cutOff += FFABS(filter2[i*filter2Size]);
  1200. if (cutOff > SWS_MAX_REDUCE_CUTOFF*fone) break;
  1201. /* preserve monotonicity because the core can't handle the filter otherwise */
  1202. if (i<dstW-1 && (*filterPos)[i] >= (*filterPos)[i+1]) break;
  1203. // move filter coefficients left
  1204. for (k=1; k<filter2Size; k++)
  1205. filter2[i*filter2Size + k - 1]= filter2[i*filter2Size + k];
  1206. filter2[i*filter2Size + k - 1]= 0;
  1207. (*filterPos)[i]++;
  1208. }
  1209. cutOff=0;
  1210. /* count near zeros on the right */
  1211. for (j=filter2Size-1; j>0; j--)
  1212. {
  1213. cutOff += FFABS(filter2[i*filter2Size + j]);
  1214. if (cutOff > SWS_MAX_REDUCE_CUTOFF*fone) break;
  1215. min--;
  1216. }
  1217. if (min>minFilterSize) minFilterSize= min;
  1218. }
  1219. if (flags & SWS_CPU_CAPS_ALTIVEC) {
  1220. // we can handle the special case 4,
  1221. // so we don't want to go to the full 8
  1222. if (minFilterSize < 5)
  1223. filterAlign = 4;
  1224. // We really don't want to waste our time
  1225. // doing useless computation, so fall back on
  1226. // the scalar C code for very small filters.
  1227. // Vectorizing is worth it only if you have a
  1228. // decent-sized vector.
  1229. if (minFilterSize < 3)
  1230. filterAlign = 1;
  1231. }
  1232. if (flags & SWS_CPU_CAPS_MMX) {
  1233. // special case for unscaled vertical filtering
  1234. if (minFilterSize == 1 && filterAlign == 2)
  1235. filterAlign= 1;
  1236. }
  1237. assert(minFilterSize > 0);
  1238. filterSize= (minFilterSize +(filterAlign-1)) & (~(filterAlign-1));
  1239. assert(filterSize > 0);
  1240. filter= av_malloc(filterSize*dstW*sizeof(*filter));
  1241. if (filterSize >= MAX_FILTER_SIZE*16/((flags&SWS_ACCURATE_RND) ? APCK_SIZE : 16) || !filter)
  1242. goto error;
  1243. *outFilterSize= filterSize;
  1244. if (flags&SWS_PRINT_INFO)
  1245. av_log(NULL, AV_LOG_VERBOSE, "SwScaler: reducing / aligning filtersize %d -> %d\n", filter2Size, filterSize);
  1246. /* try to reduce the filter-size (step2 reduce it) */
  1247. for (i=0; i<dstW; i++)
  1248. {
  1249. int j;
  1250. for (j=0; j<filterSize; j++)
  1251. {
  1252. if (j>=filter2Size) filter[i*filterSize + j]= 0;
  1253. else filter[i*filterSize + j]= filter2[i*filter2Size + j];
  1254. if((flags & SWS_BITEXACT) && j>=minFilterSize)
  1255. filter[i*filterSize + j]= 0;
  1256. }
  1257. }
  1258. //FIXME try to align filterPos if possible
  1259. //fix borders
  1260. for (i=0; i<dstW; i++)
  1261. {
  1262. int j;
  1263. if ((*filterPos)[i] < 0)
  1264. {
  1265. // move filter coefficients left to compensate for filterPos
  1266. for (j=1; j<filterSize; j++)
  1267. {
  1268. int left= FFMAX(j + (*filterPos)[i], 0);
  1269. filter[i*filterSize + left] += filter[i*filterSize + j];
  1270. filter[i*filterSize + j]=0;
  1271. }
  1272. (*filterPos)[i]= 0;
  1273. }
  1274. if ((*filterPos)[i] + filterSize > srcW)
  1275. {
  1276. int shift= (*filterPos)[i] + filterSize - srcW;
  1277. // move filter coefficients right to compensate for filterPos
  1278. for (j=filterSize-2; j>=0; j--)
  1279. {
  1280. int right= FFMIN(j + shift, filterSize-1);
  1281. filter[i*filterSize +right] += filter[i*filterSize +j];
  1282. filter[i*filterSize +j]=0;
  1283. }
  1284. (*filterPos)[i]= srcW - filterSize;
  1285. }
  1286. }
  1287. // Note the +1 is for the MMX scaler which reads over the end
  1288. /* align at 16 for AltiVec (needed by hScale_altivec_real) */
  1289. *outFilter= av_mallocz(*outFilterSize*(dstW+1)*sizeof(int16_t));
  1290. /* normalize & store in outFilter */
  1291. for (i=0; i<dstW; i++)
  1292. {
  1293. int j;
  1294. int64_t error=0;
  1295. int64_t sum=0;
  1296. for (j=0; j<filterSize; j++)
  1297. {
  1298. sum+= filter[i*filterSize + j];
  1299. }
  1300. sum= (sum + one/2)/ one;
  1301. for (j=0; j<*outFilterSize; j++)
  1302. {
  1303. int64_t v= filter[i*filterSize + j] + error;
  1304. int intV= ROUNDED_DIV(v, sum);
  1305. (*outFilter)[i*(*outFilterSize) + j]= intV;
  1306. error= v - intV*sum;
  1307. }
  1308. }
  1309. (*filterPos)[dstW]= (*filterPos)[dstW-1]; // the MMX scaler will read over the end
  1310. for (i=0; i<*outFilterSize; i++)
  1311. {
  1312. int j= dstW*(*outFilterSize);
  1313. (*outFilter)[j + i]= (*outFilter)[j + i - (*outFilterSize)];
  1314. }
  1315. ret=0;
  1316. error:
  1317. av_free(filter);
  1318. av_free(filter2);
  1319. return ret;
  1320. }
  1321. #ifdef COMPILE_MMX2
  1322. static void initMMX2HScaler(int dstW, int xInc, uint8_t *funnyCode, int16_t *filter, int32_t *filterPos, int numSplits)
  1323. {
  1324. uint8_t *fragmentA;
  1325. long imm8OfPShufW1A;
  1326. long imm8OfPShufW2A;
  1327. long fragmentLengthA;
  1328. uint8_t *fragmentB;
  1329. long imm8OfPShufW1B;
  1330. long imm8OfPShufW2B;
  1331. long fragmentLengthB;
  1332. int fragmentPos;
  1333. int xpos, i;
  1334. // create an optimized horizontal scaling routine
  1335. //code fragment
  1336. __asm__ volatile(
  1337. "jmp 9f \n\t"
  1338. // Begin
  1339. "0: \n\t"
  1340. "movq (%%"REG_d", %%"REG_a"), %%mm3 \n\t"
  1341. "movd (%%"REG_c", %%"REG_S"), %%mm0 \n\t"
  1342. "movd 1(%%"REG_c", %%"REG_S"), %%mm1 \n\t"
  1343. "punpcklbw %%mm7, %%mm1 \n\t"
  1344. "punpcklbw %%mm7, %%mm0 \n\t"
  1345. "pshufw $0xFF, %%mm1, %%mm1 \n\t"
  1346. "1: \n\t"
  1347. "pshufw $0xFF, %%mm0, %%mm0 \n\t"
  1348. "2: \n\t"
  1349. "psubw %%mm1, %%mm0 \n\t"
  1350. "movl 8(%%"REG_b", %%"REG_a"), %%esi \n\t"
  1351. "pmullw %%mm3, %%mm0 \n\t"
  1352. "psllw $7, %%mm1 \n\t"
  1353. "paddw %%mm1, %%mm0 \n\t"
  1354. "movq %%mm0, (%%"REG_D", %%"REG_a") \n\t"
  1355. "add $8, %%"REG_a" \n\t"
  1356. // End
  1357. "9: \n\t"
  1358. // "int $3 \n\t"
  1359. "lea " LOCAL_MANGLE(0b) ", %0 \n\t"
  1360. "lea " LOCAL_MANGLE(1b) ", %1 \n\t"
  1361. "lea " LOCAL_MANGLE(2b) ", %2 \n\t"
  1362. "dec %1 \n\t"
  1363. "dec %2 \n\t"
  1364. "sub %0, %1 \n\t"
  1365. "sub %0, %2 \n\t"
  1366. "lea " LOCAL_MANGLE(9b) ", %3 \n\t"
  1367. "sub %0, %3 \n\t"
  1368. :"=r" (fragmentA), "=r" (imm8OfPShufW1A), "=r" (imm8OfPShufW2A),
  1369. "=r" (fragmentLengthA)
  1370. );
  1371. __asm__ volatile(
  1372. "jmp 9f \n\t"
  1373. // Begin
  1374. "0: \n\t"
  1375. "movq (%%"REG_d", %%"REG_a"), %%mm3 \n\t"
  1376. "movd (%%"REG_c", %%"REG_S"), %%mm0 \n\t"
  1377. "punpcklbw %%mm7, %%mm0 \n\t"
  1378. "pshufw $0xFF, %%mm0, %%mm1 \n\t"
  1379. "1: \n\t"
  1380. "pshufw $0xFF, %%mm0, %%mm0 \n\t"
  1381. "2: \n\t"
  1382. "psubw %%mm1, %%mm0 \n\t"
  1383. "movl 8(%%"REG_b", %%"REG_a"), %%esi \n\t"
  1384. "pmullw %%mm3, %%mm0 \n\t"
  1385. "psllw $7, %%mm1 \n\t"
  1386. "paddw %%mm1, %%mm0 \n\t"
  1387. "movq %%mm0, (%%"REG_D", %%"REG_a") \n\t"
  1388. "add $8, %%"REG_a" \n\t"
  1389. // End
  1390. "9: \n\t"
  1391. // "int $3 \n\t"
  1392. "lea " LOCAL_MANGLE(0b) ", %0 \n\t"
  1393. "lea " LOCAL_MANGLE(1b) ", %1 \n\t"
  1394. "lea " LOCAL_MANGLE(2b) ", %2 \n\t"
  1395. "dec %1 \n\t"
  1396. "dec %2 \n\t"
  1397. "sub %0, %1 \n\t"
  1398. "sub %0, %2 \n\t"
  1399. "lea " LOCAL_MANGLE(9b) ", %3 \n\t"
  1400. "sub %0, %3 \n\t"
  1401. :"=r" (fragmentB), "=r" (imm8OfPShufW1B), "=r" (imm8OfPShufW2B),
  1402. "=r" (fragmentLengthB)
  1403. );
  1404. xpos= 0; //lumXInc/2 - 0x8000; // difference between pixel centers
  1405. fragmentPos=0;
  1406. for (i=0; i<dstW/numSplits; i++)
  1407. {
  1408. int xx=xpos>>16;
  1409. if ((i&3) == 0)
  1410. {
  1411. int a=0;
  1412. int b=((xpos+xInc)>>16) - xx;
  1413. int c=((xpos+xInc*2)>>16) - xx;
  1414. int d=((xpos+xInc*3)>>16) - xx;
  1415. filter[i ] = (( xpos & 0xFFFF) ^ 0xFFFF)>>9;
  1416. filter[i+1] = (((xpos+xInc ) & 0xFFFF) ^ 0xFFFF)>>9;
  1417. filter[i+2] = (((xpos+xInc*2) & 0xFFFF) ^ 0xFFFF)>>9;
  1418. filter[i+3] = (((xpos+xInc*3) & 0xFFFF) ^ 0xFFFF)>>9;
  1419. filterPos[i/2]= xx;
  1420. if (d+1<4)
  1421. {
  1422. int maxShift= 3-(d+1);
  1423. int shift=0;
  1424. memcpy(funnyCode + fragmentPos, fragmentB, fragmentLengthB);
  1425. funnyCode[fragmentPos + imm8OfPShufW1B]=
  1426. (a+1) | ((b+1)<<2) | ((c+1)<<4) | ((d+1)<<6);
  1427. funnyCode[fragmentPos + imm8OfPShufW2B]=
  1428. a | (b<<2) | (c<<4) | (d<<6);
  1429. if (i+3>=dstW) shift=maxShift; //avoid overread
  1430. else if ((filterPos[i/2]&3) <= maxShift) shift=filterPos[i/2]&3; //Align
  1431. if (shift && i>=shift)
  1432. {
  1433. funnyCode[fragmentPos + imm8OfPShufW1B]+= 0x55*shift;
  1434. funnyCode[fragmentPos + imm8OfPShufW2B]+= 0x55*shift;
  1435. filterPos[i/2]-=shift;
  1436. }
  1437. fragmentPos+= fragmentLengthB;
  1438. }
  1439. else
  1440. {
  1441. int maxShift= 3-d;
  1442. int shift=0;
  1443. memcpy(funnyCode + fragmentPos, fragmentA, fragmentLengthA);
  1444. funnyCode[fragmentPos + imm8OfPShufW1A]=
  1445. funnyCode[fragmentPos + imm8OfPShufW2A]=
  1446. a | (b<<2) | (c<<4) | (d<<6);
  1447. if (i+4>=dstW) shift=maxShift; //avoid overread
  1448. else if ((filterPos[i/2]&3) <= maxShift) shift=filterPos[i/2]&3; //partial align
  1449. if (shift && i>=shift)
  1450. {
  1451. funnyCode[fragmentPos + imm8OfPShufW1A]+= 0x55*shift;
  1452. funnyCode[fragmentPos + imm8OfPShufW2A]+= 0x55*shift;
  1453. filterPos[i/2]-=shift;
  1454. }
  1455. fragmentPos+= fragmentLengthA;
  1456. }
  1457. funnyCode[fragmentPos]= RET;
  1458. }
  1459. xpos+=xInc;
  1460. }
  1461. filterPos[i/2]= xpos>>16; // needed to jump to the next part
  1462. }
  1463. #endif /* COMPILE_MMX2 */
  1464. static void globalInit(void){
  1465. // generating tables:
  1466. int i;
  1467. for (i=0; i<768; i++){
  1468. int c= av_clip_uint8(i-256);
  1469. clip_table[i]=c;
  1470. }
  1471. }
  1472. static SwsFunc getSwsFunc(int flags){
  1473. #if CONFIG_RUNTIME_CPUDETECT
  1474. #if ARCH_X86 && CONFIG_GPL
  1475. // ordered per speed fastest first
  1476. if (flags & SWS_CPU_CAPS_MMX2)
  1477. return swScale_MMX2;
  1478. else if (flags & SWS_CPU_CAPS_3DNOW)
  1479. return swScale_3DNow;
  1480. else if (flags & SWS_CPU_CAPS_MMX)
  1481. return swScale_MMX;
  1482. else
  1483. return swScale_C;
  1484. #else
  1485. #if ARCH_PPC && defined COMPILE_ALTIVEC
  1486. if (flags & SWS_CPU_CAPS_ALTIVEC)
  1487. return swScale_altivec;
  1488. else
  1489. return swScale_C;
  1490. #endif
  1491. return swScale_C;
  1492. #endif /* ARCH_X86 && CONFIG_GPL */
  1493. #else //CONFIG_RUNTIME_CPUDETECT
  1494. #if HAVE_MMX2
  1495. return swScale_MMX2;
  1496. #elif HAVE_AMD3DNOW
  1497. return swScale_3DNow;
  1498. #elif HAVE_MMX
  1499. return swScale_MMX;
  1500. #elif HAVE_ALTIVEC
  1501. return swScale_altivec;
  1502. #else
  1503. return swScale_C;
  1504. #endif
  1505. #endif //!CONFIG_RUNTIME_CPUDETECT
  1506. }
  1507. static int PlanarToNV12Wrapper(SwsContext *c, uint8_t* src[], int srcStride[], int srcSliceY,
  1508. int srcSliceH, uint8_t* dstParam[], int dstStride[]){
  1509. uint8_t *dst=dstParam[0] + dstStride[0]*srcSliceY;
  1510. /* Copy Y plane */
  1511. if (dstStride[0]==srcStride[0] && srcStride[0] > 0)
  1512. memcpy(dst, src[0], srcSliceH*dstStride[0]);
  1513. else
  1514. {
  1515. int i;
  1516. uint8_t *srcPtr= src[0];
  1517. uint8_t *dstPtr= dst;
  1518. for (i=0; i<srcSliceH; i++)
  1519. {
  1520. memcpy(dstPtr, srcPtr, c->srcW);
  1521. srcPtr+= srcStride[0];
  1522. dstPtr+= dstStride[0];
  1523. }
  1524. }
  1525. dst = dstParam[1] + dstStride[1]*srcSliceY/2;
  1526. if (c->dstFormat == PIX_FMT_NV12)
  1527. interleaveBytes(src[1], src[2], dst, c->srcW/2, srcSliceH/2, srcStride[1], srcStride[2], dstStride[0]);
  1528. else
  1529. interleaveBytes(src[2], src[1], dst, c->srcW/2, srcSliceH/2, srcStride[2], srcStride[1], dstStride[0]);
  1530. return srcSliceH;
  1531. }
  1532. static int PlanarToYuy2Wrapper(SwsContext *c, uint8_t* src[], int srcStride[], int srcSliceY,
  1533. int srcSliceH, uint8_t* dstParam[], int dstStride[]){
  1534. uint8_t *dst=dstParam[0] + dstStride[0]*srcSliceY;
  1535. yv12toyuy2(src[0], src[1], src[2], dst, c->srcW, srcSliceH, srcStride[0], srcStride[1], dstStride[0]);
  1536. return srcSliceH;
  1537. }
  1538. static int PlanarToUyvyWrapper(SwsContext *c, uint8_t* src[], int srcStride[], int srcSliceY,
  1539. int srcSliceH, uint8_t* dstParam[], int dstStride[]){
  1540. uint8_t *dst=dstParam[0] + dstStride[0]*srcSliceY;
  1541. yv12touyvy(src[0], src[1], src[2], dst, c->srcW, srcSliceH, srcStride[0], srcStride[1], dstStride[0]);
  1542. return srcSliceH;
  1543. }
  1544. static int YUV422PToYuy2Wrapper(SwsContext *c, uint8_t* src[], int srcStride[], int srcSliceY,
  1545. int srcSliceH, uint8_t* dstParam[], int dstStride[]){
  1546. uint8_t *dst=dstParam[0] + dstStride[0]*srcSliceY;
  1547. yuv422ptoyuy2(src[0],src[1],src[2],dst,c->srcW,srcSliceH,srcStride[0],srcStride[1],dstStride[0]);
  1548. return srcSliceH;
  1549. }
  1550. static int YUV422PToUyvyWrapper(SwsContext *c, uint8_t* src[], int srcStride[], int srcSliceY,
  1551. int srcSliceH, uint8_t* dstParam[], int dstStride[]){
  1552. uint8_t *dst=dstParam[0] + dstStride[0]*srcSliceY;
  1553. yuv422ptouyvy(src[0],src[1],src[2],dst,c->srcW,srcSliceH,srcStride[0],srcStride[1],dstStride[0]);
  1554. return srcSliceH;
  1555. }
  1556. static int pal2rgbWrapper(SwsContext *c, uint8_t* src[], int srcStride[], int srcSliceY,
  1557. int srcSliceH, uint8_t* dst[], int dstStride[]){
  1558. const enum PixelFormat srcFormat= c->srcFormat;
  1559. const enum PixelFormat dstFormat= c->dstFormat;
  1560. void (*conv)(const uint8_t *src, uint8_t *dst, long num_pixels,
  1561. const uint8_t *palette)=NULL;
  1562. int i;
  1563. uint8_t *dstPtr= dst[0] + dstStride[0]*srcSliceY;
  1564. uint8_t *srcPtr= src[0];
  1565. if (!usePal(srcFormat))
  1566. av_log(c, AV_LOG_ERROR, "internal error %s -> %s converter\n",
  1567. sws_format_name(srcFormat), sws_format_name(dstFormat));
  1568. switch(dstFormat){
  1569. case PIX_FMT_RGB32 : conv = palette8topacked32; break;
  1570. case PIX_FMT_BGR32 : conv = palette8topacked32; break;
  1571. case PIX_FMT_BGR32_1: conv = palette8topacked32; break;
  1572. case PIX_FMT_RGB32_1: conv = palette8topacked32; break;
  1573. case PIX_FMT_RGB24 : conv = palette8topacked24; break;
  1574. case PIX_FMT_BGR24 : conv = palette8topacked24; break;
  1575. default: av_log(c, AV_LOG_ERROR, "internal error %s -> %s converter\n",
  1576. sws_format_name(srcFormat), sws_format_name(dstFormat)); break;
  1577. }
  1578. for (i=0; i<srcSliceH; i++) {
  1579. conv(srcPtr, dstPtr, c->srcW, (uint8_t *) c->pal_rgb);
  1580. srcPtr+= srcStride[0];
  1581. dstPtr+= dstStride[0];
  1582. }
  1583. return srcSliceH;
  1584. }
  1585. /* {RGB,BGR}{15,16,24,32,32_1} -> {RGB,BGR}{15,16,24,32} */
  1586. static int rgb2rgbWrapper(SwsContext *c, uint8_t* src[], int srcStride[], int srcSliceY,
  1587. int srcSliceH, uint8_t* dst[], int dstStride[]){
  1588. const enum PixelFormat srcFormat= c->srcFormat;
  1589. const enum PixelFormat dstFormat= c->dstFormat;
  1590. const int srcBpp= (fmt_depth(srcFormat) + 7) >> 3;
  1591. const int dstBpp= (fmt_depth(dstFormat) + 7) >> 3;
  1592. const int srcId= fmt_depth(srcFormat) >> 2; /* 1:0, 4:1, 8:2, 15:3, 16:4, 24:6, 32:8 */
  1593. const int dstId= fmt_depth(dstFormat) >> 2;
  1594. void (*conv)(const uint8_t *src, uint8_t *dst, long src_size)=NULL;
  1595. /* BGR -> BGR */
  1596. if ( (isBGR(srcFormat) && isBGR(dstFormat))
  1597. || (isRGB(srcFormat) && isRGB(dstFormat))){
  1598. switch(srcId | (dstId<<4)){
  1599. case 0x34: conv= rgb16to15; break;
  1600. case 0x36: conv= rgb24to15; break;
  1601. case 0x38: conv= rgb32to15; break;
  1602. case 0x43: conv= rgb15to16; break;
  1603. case 0x46: conv= rgb24to16; break;
  1604. case 0x48: conv= rgb32to16; break;
  1605. case 0x63: conv= rgb15to24; break;
  1606. case 0x64: conv= rgb16to24; break;
  1607. case 0x68: conv= rgb32to24; break;
  1608. case 0x83: conv= rgb15to32; break;
  1609. case 0x84: conv= rgb16to32; break;
  1610. case 0x86: conv= rgb24to32; break;
  1611. default: av_log(c, AV_LOG_ERROR, "internal error %s -> %s converter\n",
  1612. sws_format_name(srcFormat), sws_format_name(dstFormat)); break;
  1613. }
  1614. }else if ( (isBGR(srcFormat) && isRGB(dstFormat))
  1615. || (isRGB(srcFormat) && isBGR(dstFormat))){
  1616. switch(srcId | (dstId<<4)){
  1617. case 0x33: conv= rgb15tobgr15; break;
  1618. case 0x34: conv= rgb16tobgr15; break;
  1619. case 0x36: conv= rgb24tobgr15; break;
  1620. case 0x38: conv= rgb32tobgr15; break;
  1621. case 0x43: conv= rgb15tobgr16; break;
  1622. case 0x44: conv= rgb16tobgr16; break;
  1623. case 0x46: conv= rgb24tobgr16; break;
  1624. case 0x48: conv= rgb32tobgr16; break;
  1625. case 0x63: conv= rgb15tobgr24; break;
  1626. case 0x64: conv= rgb16tobgr24; break;
  1627. case 0x66: conv= rgb24tobgr24; break;
  1628. case 0x68: conv= rgb32tobgr24; break;
  1629. case 0x83: conv= rgb15tobgr32; break;
  1630. case 0x84: conv= rgb16tobgr32; break;
  1631. case 0x86: conv= rgb24tobgr32; break;
  1632. case 0x88: conv= rgb32tobgr32; break;
  1633. default: av_log(c, AV_LOG_ERROR, "internal error %s -> %s converter\n",
  1634. sws_format_name(srcFormat), sws_format_name(dstFormat)); break;
  1635. }
  1636. }else{
  1637. av_log(c, AV_LOG_ERROR, "internal error %s -> %s converter\n",
  1638. sws_format_name(srcFormat), sws_format_name(dstFormat));
  1639. }
  1640. if(conv)
  1641. {
  1642. uint8_t *srcPtr= src[0];
  1643. if(srcFormat == PIX_FMT_RGB32_1 || srcFormat == PIX_FMT_BGR32_1)
  1644. srcPtr += ALT32_CORR;
  1645. if (dstStride[0]*srcBpp == srcStride[0]*dstBpp && srcStride[0] > 0)
  1646. conv(srcPtr, dst[0] + dstStride[0]*srcSliceY, srcSliceH*srcStride[0]);
  1647. else
  1648. {
  1649. int i;
  1650. uint8_t *dstPtr= dst[0] + dstStride[0]*srcSliceY;
  1651. for (i=0; i<srcSliceH; i++)
  1652. {
  1653. conv(srcPtr, dstPtr, c->srcW*srcBpp);
  1654. srcPtr+= srcStride[0];
  1655. dstPtr+= dstStride[0];
  1656. }
  1657. }
  1658. }
  1659. return srcSliceH;
  1660. }
  1661. static int bgr24toyv12Wrapper(SwsContext *c, uint8_t* src[], int srcStride[], int srcSliceY,
  1662. int srcSliceH, uint8_t* dst[], int dstStride[]){
  1663. rgb24toyv12(
  1664. src[0],
  1665. dst[0]+ srcSliceY *dstStride[0],
  1666. dst[1]+(srcSliceY>>1)*dstStride[1],
  1667. dst[2]+(srcSliceY>>1)*dstStride[2],
  1668. c->srcW, srcSliceH,
  1669. dstStride[0], dstStride[1], srcStride[0]);
  1670. return srcSliceH;
  1671. }
  1672. static int yvu9toyv12Wrapper(SwsContext *c, uint8_t* src[], int srcStride[], int srcSliceY,
  1673. int srcSliceH, uint8_t* dst[], int dstStride[]){
  1674. int i;
  1675. /* copy Y */
  1676. if (srcStride[0]==dstStride[0] && srcStride[0] > 0)
  1677. memcpy(dst[0]+ srcSliceY*dstStride[0], src[0], srcStride[0]*srcSliceH);
  1678. else{
  1679. uint8_t *srcPtr= src[0];
  1680. uint8_t *dstPtr= dst[0] + dstStride[0]*srcSliceY;
  1681. for (i=0; i<srcSliceH; i++)
  1682. {
  1683. memcpy(dstPtr, srcPtr, c->srcW);
  1684. srcPtr+= srcStride[0];
  1685. dstPtr+= dstStride[0];
  1686. }
  1687. }
  1688. if (c->dstFormat==PIX_FMT_YUV420P){
  1689. planar2x(src[1], dst[1], c->chrSrcW, c->chrSrcH, srcStride[1], dstStride[1]);
  1690. planar2x(src[2], dst[2], c->chrSrcW, c->chrSrcH, srcStride[2], dstStride[2]);
  1691. }else{
  1692. planar2x(src[1], dst[2], c->chrSrcW, c->chrSrcH, srcStride[1], dstStride[2]);
  1693. planar2x(src[2], dst[1], c->chrSrcW, c->chrSrcH, srcStride[2], dstStride[1]);
  1694. }
  1695. return srcSliceH;
  1696. }
  1697. /* unscaled copy like stuff (assumes nearly identical formats) */
  1698. static int packedCopy(SwsContext *c, uint8_t* src[], int srcStride[], int srcSliceY,
  1699. int srcSliceH, uint8_t* dst[], int dstStride[])
  1700. {
  1701. if (dstStride[0]==srcStride[0] && srcStride[0] > 0)
  1702. memcpy(dst[0] + dstStride[0]*srcSliceY, src[0], srcSliceH*dstStride[0]);
  1703. else
  1704. {
  1705. int i;
  1706. uint8_t *srcPtr= src[0];
  1707. uint8_t *dstPtr= dst[0] + dstStride[0]*srcSliceY;
  1708. int length=0;
  1709. /* universal length finder */
  1710. while(length+c->srcW <= FFABS(dstStride[0])
  1711. && length+c->srcW <= FFABS(srcStride[0])) length+= c->srcW;
  1712. assert(length!=0);
  1713. for (i=0; i<srcSliceH; i++)
  1714. {
  1715. memcpy(dstPtr, srcPtr, length);
  1716. srcPtr+= srcStride[0];
  1717. dstPtr+= dstStride[0];
  1718. }
  1719. }
  1720. return srcSliceH;
  1721. }
  1722. static int planarCopy(SwsContext *c, uint8_t* src[], int srcStride[], int srcSliceY,
  1723. int srcSliceH, uint8_t* dst[], int dstStride[])
  1724. {
  1725. int plane;
  1726. for (plane=0; plane<3; plane++)
  1727. {
  1728. int length= plane==0 ? c->srcW : -((-c->srcW )>>c->chrDstHSubSample);
  1729. int y= plane==0 ? srcSliceY: -((-srcSliceY)>>c->chrDstVSubSample);
  1730. int height= plane==0 ? srcSliceH: -((-srcSliceH)>>c->chrDstVSubSample);
  1731. if ((isGray(c->srcFormat) || isGray(c->dstFormat)) && plane>0)
  1732. {
  1733. if (!isGray(c->dstFormat))
  1734. memset(dst[plane], 128, dstStride[plane]*height);
  1735. }
  1736. else
  1737. {
  1738. if (dstStride[plane]==srcStride[plane] && srcStride[plane] > 0)
  1739. memcpy(dst[plane] + dstStride[plane]*y, src[plane], height*dstStride[plane]);
  1740. else
  1741. {
  1742. int i;
  1743. uint8_t *srcPtr= src[plane];
  1744. uint8_t *dstPtr= dst[plane] + dstStride[plane]*y;
  1745. for (i=0; i<height; i++)
  1746. {
  1747. memcpy(dstPtr, srcPtr, length);
  1748. srcPtr+= srcStride[plane];
  1749. dstPtr+= dstStride[plane];
  1750. }
  1751. }
  1752. }
  1753. }
  1754. return srcSliceH;
  1755. }
  1756. static int gray16togray(SwsContext *c, uint8_t* src[], int srcStride[], int srcSliceY,
  1757. int srcSliceH, uint8_t* dst[], int dstStride[]){
  1758. int length= c->srcW;
  1759. int y= srcSliceY;
  1760. int height= srcSliceH;
  1761. int i, j;
  1762. uint8_t *srcPtr= src[0];
  1763. uint8_t *dstPtr= dst[0] + dstStride[0]*y;
  1764. if (!isGray(c->dstFormat)){
  1765. int height= -((-srcSliceH)>>c->chrDstVSubSample);
  1766. memset(dst[1], 128, dstStride[1]*height);
  1767. memset(dst[2], 128, dstStride[2]*height);
  1768. }
  1769. if (c->srcFormat == PIX_FMT_GRAY16LE) srcPtr++;
  1770. for (i=0; i<height; i++)
  1771. {
  1772. for (j=0; j<length; j++) dstPtr[j] = srcPtr[j<<1];
  1773. srcPtr+= srcStride[0];
  1774. dstPtr+= dstStride[0];
  1775. }
  1776. return srcSliceH;
  1777. }
  1778. static int graytogray16(SwsContext *c, uint8_t* src[], int srcStride[], int srcSliceY,
  1779. int srcSliceH, uint8_t* dst[], int dstStride[]){
  1780. int length= c->srcW;
  1781. int y= srcSliceY;
  1782. int height= srcSliceH;
  1783. int i, j;
  1784. uint8_t *srcPtr= src[0];
  1785. uint8_t *dstPtr= dst[0] + dstStride[0]*y;
  1786. for (i=0; i<height; i++)
  1787. {
  1788. for (j=0; j<length; j++)
  1789. {
  1790. dstPtr[j<<1] = srcPtr[j];
  1791. dstPtr[(j<<1)+1] = srcPtr[j];
  1792. }
  1793. srcPtr+= srcStride[0];
  1794. dstPtr+= dstStride[0];
  1795. }
  1796. return srcSliceH;
  1797. }
  1798. static int gray16swap(SwsContext *c, uint8_t* src[], int srcStride[], int srcSliceY,
  1799. int srcSliceH, uint8_t* dst[], int dstStride[]){
  1800. int length= c->srcW;
  1801. int y= srcSliceY;
  1802. int height= srcSliceH;
  1803. int i, j;
  1804. uint16_t *srcPtr= (uint16_t*)src[0];
  1805. uint16_t *dstPtr= (uint16_t*)(dst[0] + dstStride[0]*y/2);
  1806. for (i=0; i<height; i++)
  1807. {
  1808. for (j=0; j<length; j++) dstPtr[j] = bswap_16(srcPtr[j]);
  1809. srcPtr+= srcStride[0]/2;
  1810. dstPtr+= dstStride[0]/2;
  1811. }
  1812. return srcSliceH;
  1813. }
  1814. static void getSubSampleFactors(int *h, int *v, int format){
  1815. switch(format){
  1816. case PIX_FMT_UYVY422:
  1817. case PIX_FMT_YUYV422:
  1818. *h=1;
  1819. *v=0;
  1820. break;
  1821. case PIX_FMT_YUV420P:
  1822. case PIX_FMT_YUVA420P:
  1823. case PIX_FMT_GRAY16BE:
  1824. case PIX_FMT_GRAY16LE:
  1825. case PIX_FMT_GRAY8: //FIXME remove after different subsamplings are fully implemented
  1826. case PIX_FMT_NV12:
  1827. case PIX_FMT_NV21:
  1828. *h=1;
  1829. *v=1;
  1830. break;
  1831. case PIX_FMT_YUV440P:
  1832. *h=0;
  1833. *v=1;
  1834. break;
  1835. case PIX_FMT_YUV410P:
  1836. *h=2;
  1837. *v=2;
  1838. break;
  1839. case PIX_FMT_YUV444P:
  1840. *h=0;
  1841. *v=0;
  1842. break;
  1843. case PIX_FMT_YUV422P:
  1844. *h=1;
  1845. *v=0;
  1846. break;
  1847. case PIX_FMT_YUV411P:
  1848. *h=2;
  1849. *v=0;
  1850. break;
  1851. default:
  1852. *h=0;
  1853. *v=0;
  1854. break;
  1855. }
  1856. }
  1857. static uint16_t roundToInt16(int64_t f){
  1858. int r= (f + (1<<15))>>16;
  1859. if (r<-0x7FFF) return 0x8000;
  1860. else if (r> 0x7FFF) return 0x7FFF;
  1861. else return r;
  1862. }
  1863. /**
  1864. * @param inv_table the yuv2rgb coefficients, normally ff_yuv2rgb_coeffs[x]
  1865. * @param fullRange if 1 then the luma range is 0..255 if 0 it is 16..235
  1866. * @return -1 if not supported
  1867. */
  1868. int sws_setColorspaceDetails(SwsContext *c, const int inv_table[4], int srcRange, const int table[4], int dstRange, int brightness, int contrast, int saturation){
  1869. int64_t crv = inv_table[0];
  1870. int64_t cbu = inv_table[1];
  1871. int64_t cgu = -inv_table[2];
  1872. int64_t cgv = -inv_table[3];
  1873. int64_t cy = 1<<16;
  1874. int64_t oy = 0;
  1875. memcpy(c->srcColorspaceTable, inv_table, sizeof(int)*4);
  1876. memcpy(c->dstColorspaceTable, table, sizeof(int)*4);
  1877. c->brightness= brightness;
  1878. c->contrast = contrast;
  1879. c->saturation= saturation;
  1880. c->srcRange = srcRange;
  1881. c->dstRange = dstRange;
  1882. if (isYUV(c->dstFormat) || isGray(c->dstFormat)) return 0;
  1883. c->uOffset= 0x0400040004000400LL;
  1884. c->vOffset= 0x0400040004000400LL;
  1885. if (!srcRange){
  1886. cy= (cy*255) / 219;
  1887. oy= 16<<16;
  1888. }else{
  1889. crv= (crv*224) / 255;
  1890. cbu= (cbu*224) / 255;
  1891. cgu= (cgu*224) / 255;
  1892. cgv= (cgv*224) / 255;
  1893. }
  1894. cy = (cy *contrast )>>16;
  1895. crv= (crv*contrast * saturation)>>32;
  1896. cbu= (cbu*contrast * saturation)>>32;
  1897. cgu= (cgu*contrast * saturation)>>32;
  1898. cgv= (cgv*contrast * saturation)>>32;
  1899. oy -= 256*brightness;
  1900. c->yCoeff= roundToInt16(cy *8192) * 0x0001000100010001ULL;
  1901. c->vrCoeff= roundToInt16(crv*8192) * 0x0001000100010001ULL;
  1902. c->ubCoeff= roundToInt16(cbu*8192) * 0x0001000100010001ULL;
  1903. c->vgCoeff= roundToInt16(cgv*8192) * 0x0001000100010001ULL;
  1904. c->ugCoeff= roundToInt16(cgu*8192) * 0x0001000100010001ULL;
  1905. c->yOffset= roundToInt16(oy * 8) * 0x0001000100010001ULL;
  1906. c->yuv2rgb_y_coeff = (int16_t)roundToInt16(cy <<13);
  1907. c->yuv2rgb_y_offset = (int16_t)roundToInt16(oy << 9);
  1908. c->yuv2rgb_v2r_coeff= (int16_t)roundToInt16(crv<<13);
  1909. c->yuv2rgb_v2g_coeff= (int16_t)roundToInt16(cgv<<13);
  1910. c->yuv2rgb_u2g_coeff= (int16_t)roundToInt16(cgu<<13);
  1911. c->yuv2rgb_u2b_coeff= (int16_t)roundToInt16(cbu<<13);
  1912. sws_yuv2rgb_c_init_tables(c, inv_table, srcRange, brightness, contrast, saturation);
  1913. //FIXME factorize
  1914. #ifdef COMPILE_ALTIVEC
  1915. if (c->flags & SWS_CPU_CAPS_ALTIVEC)
  1916. sws_yuv2rgb_altivec_init_tables (c, inv_table, brightness, contrast, saturation);
  1917. #endif
  1918. return 0;
  1919. }
  1920. /**
  1921. * @return -1 if not supported
  1922. */
  1923. int sws_getColorspaceDetails(SwsContext *c, int **inv_table, int *srcRange, int **table, int *dstRange, int *brightness, int *contrast, int *saturation){
  1924. if (isYUV(c->dstFormat) || isGray(c->dstFormat)) return -1;
  1925. *inv_table = c->srcColorspaceTable;
  1926. *table = c->dstColorspaceTable;
  1927. *srcRange = c->srcRange;
  1928. *dstRange = c->dstRange;
  1929. *brightness= c->brightness;
  1930. *contrast = c->contrast;
  1931. *saturation= c->saturation;
  1932. return 0;
  1933. }
  1934. static int handle_jpeg(enum PixelFormat *format)
  1935. {
  1936. switch (*format) {
  1937. case PIX_FMT_YUVJ420P:
  1938. *format = PIX_FMT_YUV420P;
  1939. return 1;
  1940. case PIX_FMT_YUVJ422P:
  1941. *format = PIX_FMT_YUV422P;
  1942. return 1;
  1943. case PIX_FMT_YUVJ444P:
  1944. *format = PIX_FMT_YUV444P;
  1945. return 1;
  1946. case PIX_FMT_YUVJ440P:
  1947. *format = PIX_FMT_YUV440P;
  1948. return 1;
  1949. default:
  1950. return 0;
  1951. }
  1952. }
  1953. SwsContext *sws_getContext(int srcW, int srcH, enum PixelFormat srcFormat, int dstW, int dstH, enum PixelFormat dstFormat, int flags,
  1954. SwsFilter *srcFilter, SwsFilter *dstFilter, double *param){
  1955. SwsContext *c;
  1956. int i;
  1957. int usesVFilter, usesHFilter;
  1958. int unscaled, needsDither;
  1959. int srcRange, dstRange;
  1960. SwsFilter dummyFilter= {NULL, NULL, NULL, NULL};
  1961. #if ARCH_X86
  1962. if (flags & SWS_CPU_CAPS_MMX)
  1963. __asm__ volatile("emms\n\t"::: "memory");
  1964. #endif
  1965. #if !CONFIG_RUNTIME_CPUDETECT //ensure that the flags match the compiled variant if cpudetect is off
  1966. flags &= ~(SWS_CPU_CAPS_MMX|SWS_CPU_CAPS_MMX2|SWS_CPU_CAPS_3DNOW|SWS_CPU_CAPS_ALTIVEC|SWS_CPU_CAPS_BFIN);
  1967. #if HAVE_MMX2
  1968. flags |= SWS_CPU_CAPS_MMX|SWS_CPU_CAPS_MMX2;
  1969. #elif HAVE_AMD3DNOW
  1970. flags |= SWS_CPU_CAPS_MMX|SWS_CPU_CAPS_3DNOW;
  1971. #elif HAVE_MMX
  1972. flags |= SWS_CPU_CAPS_MMX;
  1973. #elif HAVE_ALTIVEC
  1974. flags |= SWS_CPU_CAPS_ALTIVEC;
  1975. #elif ARCH_BFIN
  1976. flags |= SWS_CPU_CAPS_BFIN;
  1977. #endif
  1978. #endif /* CONFIG_RUNTIME_CPUDETECT */
  1979. if (clip_table[512] != 255) globalInit();
  1980. if (!rgb15to16) sws_rgb2rgb_init(flags);
  1981. unscaled = (srcW == dstW && srcH == dstH);
  1982. needsDither= (isBGR(dstFormat) || isRGB(dstFormat))
  1983. && (fmt_depth(dstFormat))<24
  1984. && ((fmt_depth(dstFormat))<(fmt_depth(srcFormat)) || (!(isRGB(srcFormat) || isBGR(srcFormat))));
  1985. srcRange = handle_jpeg(&srcFormat);
  1986. dstRange = handle_jpeg(&dstFormat);
  1987. if (!isSupportedIn(srcFormat))
  1988. {
  1989. av_log(NULL, AV_LOG_ERROR, "swScaler: %s is not supported as input pixel format\n", sws_format_name(srcFormat));
  1990. return NULL;
  1991. }
  1992. if (!isSupportedOut(dstFormat))
  1993. {
  1994. av_log(NULL, AV_LOG_ERROR, "swScaler: %s is not supported as output pixel format\n", sws_format_name(dstFormat));
  1995. return NULL;
  1996. }
  1997. i= flags & ( SWS_POINT
  1998. |SWS_AREA
  1999. |SWS_BILINEAR
  2000. |SWS_FAST_BILINEAR
  2001. |SWS_BICUBIC
  2002. |SWS_X
  2003. |SWS_GAUSS
  2004. |SWS_LANCZOS
  2005. |SWS_SINC
  2006. |SWS_SPLINE
  2007. |SWS_BICUBLIN);
  2008. if(!i || (i & (i-1)))
  2009. {
  2010. av_log(NULL, AV_LOG_ERROR, "swScaler: Exactly one scaler algorithm must be chosen\n");
  2011. return NULL;
  2012. }
  2013. /* sanity check */
  2014. if (srcW<4 || srcH<1 || dstW<8 || dstH<1) //FIXME check if these are enough and try to lowwer them after fixing the relevant parts of the code
  2015. {
  2016. av_log(NULL, AV_LOG_ERROR, "swScaler: %dx%d -> %dx%d is invalid scaling dimension\n",
  2017. srcW, srcH, dstW, dstH);
  2018. return NULL;
  2019. }
  2020. if(srcW > VOFW || dstW > VOFW){
  2021. av_log(NULL, AV_LOG_ERROR, "swScaler: Compile-time maximum width is "AV_STRINGIFY(VOFW)" change VOF/VOFW and recompile\n");
  2022. return NULL;
  2023. }
  2024. if (!dstFilter) dstFilter= &dummyFilter;
  2025. if (!srcFilter) srcFilter= &dummyFilter;
  2026. c= av_mallocz(sizeof(SwsContext));
  2027. c->av_class = &sws_context_class;
  2028. c->srcW= srcW;
  2029. c->srcH= srcH;
  2030. c->dstW= dstW;
  2031. c->dstH= dstH;
  2032. c->lumXInc= ((srcW<<16) + (dstW>>1))/dstW;
  2033. c->lumYInc= ((srcH<<16) + (dstH>>1))/dstH;
  2034. c->flags= flags;
  2035. c->dstFormat= dstFormat;
  2036. c->srcFormat= srcFormat;
  2037. c->vRounder= 4* 0x0001000100010001ULL;
  2038. usesHFilter= usesVFilter= 0;
  2039. if (dstFilter->lumV && dstFilter->lumV->length>1) usesVFilter=1;
  2040. if (dstFilter->lumH && dstFilter->lumH->length>1) usesHFilter=1;
  2041. if (dstFilter->chrV && dstFilter->chrV->length>1) usesVFilter=1;
  2042. if (dstFilter->chrH && dstFilter->chrH->length>1) usesHFilter=1;
  2043. if (srcFilter->lumV && srcFilter->lumV->length>1) usesVFilter=1;
  2044. if (srcFilter->lumH && srcFilter->lumH->length>1) usesHFilter=1;
  2045. if (srcFilter->chrV && srcFilter->chrV->length>1) usesVFilter=1;
  2046. if (srcFilter->chrH && srcFilter->chrH->length>1) usesHFilter=1;
  2047. getSubSampleFactors(&c->chrSrcHSubSample, &c->chrSrcVSubSample, srcFormat);
  2048. getSubSampleFactors(&c->chrDstHSubSample, &c->chrDstVSubSample, dstFormat);
  2049. // reuse chroma for 2 pixels RGB/BGR unless user wants full chroma interpolation
  2050. if ((isBGR(dstFormat) || isRGB(dstFormat)) && !(flags&SWS_FULL_CHR_H_INT)) c->chrDstHSubSample=1;
  2051. // drop some chroma lines if the user wants it
  2052. c->vChrDrop= (flags&SWS_SRC_V_CHR_DROP_MASK)>>SWS_SRC_V_CHR_DROP_SHIFT;
  2053. c->chrSrcVSubSample+= c->vChrDrop;
  2054. // drop every other pixel for chroma calculation unless user wants full chroma
  2055. if ((isBGR(srcFormat) || isRGB(srcFormat)) && !(flags&SWS_FULL_CHR_H_INP)
  2056. && srcFormat!=PIX_FMT_RGB8 && srcFormat!=PIX_FMT_BGR8
  2057. && srcFormat!=PIX_FMT_RGB4 && srcFormat!=PIX_FMT_BGR4
  2058. && srcFormat!=PIX_FMT_RGB4_BYTE && srcFormat!=PIX_FMT_BGR4_BYTE
  2059. && ((dstW>>c->chrDstHSubSample) <= (srcW>>1) || (flags&(SWS_FAST_BILINEAR|SWS_POINT))))
  2060. c->chrSrcHSubSample=1;
  2061. if (param){
  2062. c->param[0] = param[0];
  2063. c->param[1] = param[1];
  2064. }else{
  2065. c->param[0] =
  2066. c->param[1] = SWS_PARAM_DEFAULT;
  2067. }
  2068. c->chrIntHSubSample= c->chrDstHSubSample;
  2069. c->chrIntVSubSample= c->chrSrcVSubSample;
  2070. // Note the -((-x)>>y) is so that we always round toward +inf.
  2071. c->chrSrcW= -((-srcW) >> c->chrSrcHSubSample);
  2072. c->chrSrcH= -((-srcH) >> c->chrSrcVSubSample);
  2073. c->chrDstW= -((-dstW) >> c->chrDstHSubSample);
  2074. c->chrDstH= -((-dstH) >> c->chrDstVSubSample);
  2075. sws_setColorspaceDetails(c, ff_yuv2rgb_coeffs[SWS_CS_DEFAULT], srcRange, ff_yuv2rgb_coeffs[SWS_CS_DEFAULT] /* FIXME*/, dstRange, 0, 1<<16, 1<<16);
  2076. /* unscaled special cases */
  2077. if (unscaled && !usesHFilter && !usesVFilter && (srcRange == dstRange || isBGR(dstFormat) || isRGB(dstFormat)))
  2078. {
  2079. /* yv12_to_nv12 */
  2080. if ((srcFormat == PIX_FMT_YUV420P || srcFormat == PIX_FMT_YUVA420P) && (dstFormat == PIX_FMT_NV12 || dstFormat == PIX_FMT_NV21))
  2081. {
  2082. c->swScale= PlanarToNV12Wrapper;
  2083. }
  2084. /* yuv2bgr */
  2085. if ((srcFormat==PIX_FMT_YUV420P || srcFormat==PIX_FMT_YUV422P || srcFormat==PIX_FMT_YUVA420P) && (isBGR(dstFormat) || isRGB(dstFormat))
  2086. && !(flags & SWS_ACCURATE_RND) && !(dstH&1))
  2087. {
  2088. c->swScale= sws_yuv2rgb_get_func_ptr(c);
  2089. }
  2090. if (srcFormat==PIX_FMT_YUV410P && dstFormat==PIX_FMT_YUV420P && !(flags & SWS_BITEXACT))
  2091. {
  2092. c->swScale= yvu9toyv12Wrapper;
  2093. }
  2094. /* bgr24toYV12 */
  2095. if (srcFormat==PIX_FMT_BGR24 && dstFormat==PIX_FMT_YUV420P && !(flags & SWS_ACCURATE_RND))
  2096. c->swScale= bgr24toyv12Wrapper;
  2097. /* RGB/BGR -> RGB/BGR (no dither needed forms) */
  2098. if ( (isBGR(srcFormat) || isRGB(srcFormat))
  2099. && (isBGR(dstFormat) || isRGB(dstFormat))
  2100. && srcFormat != PIX_FMT_BGR8 && dstFormat != PIX_FMT_BGR8
  2101. && srcFormat != PIX_FMT_RGB8 && dstFormat != PIX_FMT_RGB8
  2102. && srcFormat != PIX_FMT_BGR4 && dstFormat != PIX_FMT_BGR4
  2103. && srcFormat != PIX_FMT_RGB4 && dstFormat != PIX_FMT_RGB4
  2104. && srcFormat != PIX_FMT_BGR4_BYTE && dstFormat != PIX_FMT_BGR4_BYTE
  2105. && srcFormat != PIX_FMT_RGB4_BYTE && dstFormat != PIX_FMT_RGB4_BYTE
  2106. && srcFormat != PIX_FMT_MONOBLACK && dstFormat != PIX_FMT_MONOBLACK
  2107. && srcFormat != PIX_FMT_MONOWHITE && dstFormat != PIX_FMT_MONOWHITE
  2108. && dstFormat != PIX_FMT_RGB32_1
  2109. && dstFormat != PIX_FMT_BGR32_1
  2110. && (!needsDither || (c->flags&(SWS_FAST_BILINEAR|SWS_POINT))))
  2111. c->swScale= rgb2rgbWrapper;
  2112. if ((usePal(srcFormat) && (
  2113. dstFormat == PIX_FMT_RGB32 ||
  2114. dstFormat == PIX_FMT_RGB32_1 ||
  2115. dstFormat == PIX_FMT_RGB24 ||
  2116. dstFormat == PIX_FMT_BGR32 ||
  2117. dstFormat == PIX_FMT_BGR32_1 ||
  2118. dstFormat == PIX_FMT_BGR24)))
  2119. c->swScale= pal2rgbWrapper;
  2120. if (srcFormat == PIX_FMT_YUV422P)
  2121. {
  2122. if (dstFormat == PIX_FMT_YUYV422)
  2123. c->swScale= YUV422PToYuy2Wrapper;
  2124. else if (dstFormat == PIX_FMT_UYVY422)
  2125. c->swScale= YUV422PToUyvyWrapper;
  2126. }
  2127. /* LQ converters if -sws 0 or -sws 4*/
  2128. if (c->flags&(SWS_FAST_BILINEAR|SWS_POINT)){
  2129. /* yv12_to_yuy2 */
  2130. if (srcFormat == PIX_FMT_YUV420P || srcFormat == PIX_FMT_YUVA420P)
  2131. {
  2132. if (dstFormat == PIX_FMT_YUYV422)
  2133. c->swScale= PlanarToYuy2Wrapper;
  2134. else if (dstFormat == PIX_FMT_UYVY422)
  2135. c->swScale= PlanarToUyvyWrapper;
  2136. }
  2137. }
  2138. #ifdef COMPILE_ALTIVEC
  2139. if ((c->flags & SWS_CPU_CAPS_ALTIVEC) &&
  2140. !(c->flags & SWS_BITEXACT) &&
  2141. srcFormat == PIX_FMT_YUV420P) {
  2142. // unscaled YV12 -> packed YUV, we want speed
  2143. if (dstFormat == PIX_FMT_YUYV422)
  2144. c->swScale= yv12toyuy2_unscaled_altivec;
  2145. else if (dstFormat == PIX_FMT_UYVY422)
  2146. c->swScale= yv12touyvy_unscaled_altivec;
  2147. }
  2148. #endif
  2149. /* simple copy */
  2150. if ( srcFormat == dstFormat
  2151. || (srcFormat == PIX_FMT_YUVA420P && dstFormat == PIX_FMT_YUV420P)
  2152. || (isPlanarYUV(srcFormat) && isGray(dstFormat))
  2153. || (isPlanarYUV(dstFormat) && isGray(srcFormat)))
  2154. {
  2155. if (isPacked(c->srcFormat))
  2156. c->swScale= packedCopy;
  2157. else /* Planar YUV or gray */
  2158. c->swScale= planarCopy;
  2159. }
  2160. /* gray16{le,be} conversions */
  2161. if (isGray16(srcFormat) && (isPlanarYUV(dstFormat) || (dstFormat == PIX_FMT_GRAY8)))
  2162. {
  2163. c->swScale= gray16togray;
  2164. }
  2165. if ((isPlanarYUV(srcFormat) || (srcFormat == PIX_FMT_GRAY8)) && isGray16(dstFormat))
  2166. {
  2167. c->swScale= graytogray16;
  2168. }
  2169. if (srcFormat != dstFormat && isGray16(srcFormat) && isGray16(dstFormat))
  2170. {
  2171. c->swScale= gray16swap;
  2172. }
  2173. #if ARCH_BFIN
  2174. if (flags & SWS_CPU_CAPS_BFIN)
  2175. ff_bfin_get_unscaled_swscale (c);
  2176. #endif
  2177. if (c->swScale){
  2178. if (flags&SWS_PRINT_INFO)
  2179. av_log(c, AV_LOG_INFO, "using unscaled %s -> %s special converter\n",
  2180. sws_format_name(srcFormat), sws_format_name(dstFormat));
  2181. return c;
  2182. }
  2183. }
  2184. if (flags & SWS_CPU_CAPS_MMX2)
  2185. {
  2186. c->canMMX2BeUsed= (dstW >=srcW && (dstW&31)==0 && (srcW&15)==0) ? 1 : 0;
  2187. if (!c->canMMX2BeUsed && dstW >=srcW && (srcW&15)==0 && (flags&SWS_FAST_BILINEAR))
  2188. {
  2189. if (flags&SWS_PRINT_INFO)
  2190. av_log(c, AV_LOG_INFO, "output width is not a multiple of 32 -> no MMX2 scaler\n");
  2191. }
  2192. if (usesHFilter) c->canMMX2BeUsed=0;
  2193. }
  2194. else
  2195. c->canMMX2BeUsed=0;
  2196. c->chrXInc= ((c->chrSrcW<<16) + (c->chrDstW>>1))/c->chrDstW;
  2197. c->chrYInc= ((c->chrSrcH<<16) + (c->chrDstH>>1))/c->chrDstH;
  2198. // match pixel 0 of the src to pixel 0 of dst and match pixel n-2 of src to pixel n-2 of dst
  2199. // but only for the FAST_BILINEAR mode otherwise do correct scaling
  2200. // n-2 is the last chrominance sample available
  2201. // this is not perfect, but no one should notice the difference, the more correct variant
  2202. // would be like the vertical one, but that would require some special code for the
  2203. // first and last pixel
  2204. if (flags&SWS_FAST_BILINEAR)
  2205. {
  2206. if (c->canMMX2BeUsed)
  2207. {
  2208. c->lumXInc+= 20;
  2209. c->chrXInc+= 20;
  2210. }
  2211. //we don't use the x86 asm scaler if MMX is available
  2212. else if (flags & SWS_CPU_CAPS_MMX)
  2213. {
  2214. c->lumXInc = ((srcW-2)<<16)/(dstW-2) - 20;
  2215. c->chrXInc = ((c->chrSrcW-2)<<16)/(c->chrDstW-2) - 20;
  2216. }
  2217. }
  2218. /* precalculate horizontal scaler filter coefficients */
  2219. {
  2220. const int filterAlign=
  2221. (flags & SWS_CPU_CAPS_MMX) ? 4 :
  2222. (flags & SWS_CPU_CAPS_ALTIVEC) ? 8 :
  2223. 1;
  2224. initFilter(&c->hLumFilter, &c->hLumFilterPos, &c->hLumFilterSize, c->lumXInc,
  2225. srcW , dstW, filterAlign, 1<<14,
  2226. (flags&SWS_BICUBLIN) ? (flags|SWS_BICUBIC) : flags,
  2227. srcFilter->lumH, dstFilter->lumH, c->param);
  2228. initFilter(&c->hChrFilter, &c->hChrFilterPos, &c->hChrFilterSize, c->chrXInc,
  2229. c->chrSrcW, c->chrDstW, filterAlign, 1<<14,
  2230. (flags&SWS_BICUBLIN) ? (flags|SWS_BILINEAR) : flags,
  2231. srcFilter->chrH, dstFilter->chrH, c->param);
  2232. #define MAX_FUNNY_CODE_SIZE 10000
  2233. #if defined(COMPILE_MMX2)
  2234. // can't downscale !!!
  2235. if (c->canMMX2BeUsed && (flags & SWS_FAST_BILINEAR))
  2236. {
  2237. #ifdef MAP_ANONYMOUS
  2238. c->funnyYCode = (uint8_t*)mmap(NULL, MAX_FUNNY_CODE_SIZE, PROT_EXEC | PROT_READ | PROT_WRITE, MAP_PRIVATE | MAP_ANONYMOUS, 0, 0);
  2239. c->funnyUVCode = (uint8_t*)mmap(NULL, MAX_FUNNY_CODE_SIZE, PROT_EXEC | PROT_READ | PROT_WRITE, MAP_PRIVATE | MAP_ANONYMOUS, 0, 0);
  2240. #else
  2241. c->funnyYCode = av_malloc(MAX_FUNNY_CODE_SIZE);
  2242. c->funnyUVCode = av_malloc(MAX_FUNNY_CODE_SIZE);
  2243. #endif
  2244. c->lumMmx2Filter = av_malloc((dstW /8+8)*sizeof(int16_t));
  2245. c->chrMmx2Filter = av_malloc((c->chrDstW /4+8)*sizeof(int16_t));
  2246. c->lumMmx2FilterPos= av_malloc((dstW /2/8+8)*sizeof(int32_t));
  2247. c->chrMmx2FilterPos= av_malloc((c->chrDstW/2/4+8)*sizeof(int32_t));
  2248. initMMX2HScaler( dstW, c->lumXInc, c->funnyYCode , c->lumMmx2Filter, c->lumMmx2FilterPos, 8);
  2249. initMMX2HScaler(c->chrDstW, c->chrXInc, c->funnyUVCode, c->chrMmx2Filter, c->chrMmx2FilterPos, 4);
  2250. }
  2251. #endif /* defined(COMPILE_MMX2) */
  2252. } // initialize horizontal stuff
  2253. /* precalculate vertical scaler filter coefficients */
  2254. {
  2255. const int filterAlign=
  2256. (flags & SWS_CPU_CAPS_MMX) && (flags & SWS_ACCURATE_RND) ? 2 :
  2257. (flags & SWS_CPU_CAPS_ALTIVEC) ? 8 :
  2258. 1;
  2259. initFilter(&c->vLumFilter, &c->vLumFilterPos, &c->vLumFilterSize, c->lumYInc,
  2260. srcH , dstH, filterAlign, (1<<12),
  2261. (flags&SWS_BICUBLIN) ? (flags|SWS_BICUBIC) : flags,
  2262. srcFilter->lumV, dstFilter->lumV, c->param);
  2263. initFilter(&c->vChrFilter, &c->vChrFilterPos, &c->vChrFilterSize, c->chrYInc,
  2264. c->chrSrcH, c->chrDstH, filterAlign, (1<<12),
  2265. (flags&SWS_BICUBLIN) ? (flags|SWS_BILINEAR) : flags,
  2266. srcFilter->chrV, dstFilter->chrV, c->param);
  2267. #if HAVE_ALTIVEC
  2268. c->vYCoeffsBank = av_malloc(sizeof (vector signed short)*c->vLumFilterSize*c->dstH);
  2269. c->vCCoeffsBank = av_malloc(sizeof (vector signed short)*c->vChrFilterSize*c->chrDstH);
  2270. for (i=0;i<c->vLumFilterSize*c->dstH;i++) {
  2271. int j;
  2272. short *p = (short *)&c->vYCoeffsBank[i];
  2273. for (j=0;j<8;j++)
  2274. p[j] = c->vLumFilter[i];
  2275. }
  2276. for (i=0;i<c->vChrFilterSize*c->chrDstH;i++) {
  2277. int j;
  2278. short *p = (short *)&c->vCCoeffsBank[i];
  2279. for (j=0;j<8;j++)
  2280. p[j] = c->vChrFilter[i];
  2281. }
  2282. #endif
  2283. }
  2284. // calculate buffer sizes so that they won't run out while handling these damn slices
  2285. c->vLumBufSize= c->vLumFilterSize;
  2286. c->vChrBufSize= c->vChrFilterSize;
  2287. for (i=0; i<dstH; i++)
  2288. {
  2289. int chrI= i*c->chrDstH / dstH;
  2290. int nextSlice= FFMAX(c->vLumFilterPos[i ] + c->vLumFilterSize - 1,
  2291. ((c->vChrFilterPos[chrI] + c->vChrFilterSize - 1)<<c->chrSrcVSubSample));
  2292. nextSlice>>= c->chrSrcVSubSample;
  2293. nextSlice<<= c->chrSrcVSubSample;
  2294. if (c->vLumFilterPos[i ] + c->vLumBufSize < nextSlice)
  2295. c->vLumBufSize= nextSlice - c->vLumFilterPos[i];
  2296. if (c->vChrFilterPos[chrI] + c->vChrBufSize < (nextSlice>>c->chrSrcVSubSample))
  2297. c->vChrBufSize= (nextSlice>>c->chrSrcVSubSample) - c->vChrFilterPos[chrI];
  2298. }
  2299. // allocate pixbufs (we use dynamic allocation because otherwise we would need to
  2300. c->lumPixBuf= av_malloc(c->vLumBufSize*2*sizeof(int16_t*));
  2301. c->chrPixBuf= av_malloc(c->vChrBufSize*2*sizeof(int16_t*));
  2302. //Note we need at least one pixel more at the end because of the MMX code (just in case someone wanna replace the 4000/8000)
  2303. /* align at 16 bytes for AltiVec */
  2304. for (i=0; i<c->vLumBufSize; i++)
  2305. c->lumPixBuf[i]= c->lumPixBuf[i+c->vLumBufSize]= av_mallocz(VOF+1);
  2306. for (i=0; i<c->vChrBufSize; i++)
  2307. c->chrPixBuf[i]= c->chrPixBuf[i+c->vChrBufSize]= av_malloc((VOF+1)*2);
  2308. //try to avoid drawing green stuff between the right end and the stride end
  2309. for (i=0; i<c->vChrBufSize; i++) memset(c->chrPixBuf[i], 64, (VOF+1)*2);
  2310. assert(2*VOFW == VOF);
  2311. assert(c->chrDstH <= dstH);
  2312. if (flags&SWS_PRINT_INFO)
  2313. {
  2314. #ifdef DITHER1XBPP
  2315. const char *dither= " dithered";
  2316. #else
  2317. const char *dither= "";
  2318. #endif
  2319. if (flags&SWS_FAST_BILINEAR)
  2320. av_log(c, AV_LOG_INFO, "FAST_BILINEAR scaler, ");
  2321. else if (flags&SWS_BILINEAR)
  2322. av_log(c, AV_LOG_INFO, "BILINEAR scaler, ");
  2323. else if (flags&SWS_BICUBIC)
  2324. av_log(c, AV_LOG_INFO, "BICUBIC scaler, ");
  2325. else if (flags&SWS_X)
  2326. av_log(c, AV_LOG_INFO, "Experimental scaler, ");
  2327. else if (flags&SWS_POINT)
  2328. av_log(c, AV_LOG_INFO, "Nearest Neighbor / POINT scaler, ");
  2329. else if (flags&SWS_AREA)
  2330. av_log(c, AV_LOG_INFO, "Area Averageing scaler, ");
  2331. else if (flags&SWS_BICUBLIN)
  2332. av_log(c, AV_LOG_INFO, "luma BICUBIC / chroma BILINEAR scaler, ");
  2333. else if (flags&SWS_GAUSS)
  2334. av_log(c, AV_LOG_INFO, "Gaussian scaler, ");
  2335. else if (flags&SWS_SINC)
  2336. av_log(c, AV_LOG_INFO, "Sinc scaler, ");
  2337. else if (flags&SWS_LANCZOS)
  2338. av_log(c, AV_LOG_INFO, "Lanczos scaler, ");
  2339. else if (flags&SWS_SPLINE)
  2340. av_log(c, AV_LOG_INFO, "Bicubic spline scaler, ");
  2341. else
  2342. av_log(c, AV_LOG_INFO, "ehh flags invalid?! ");
  2343. if (dstFormat==PIX_FMT_BGR555 || dstFormat==PIX_FMT_BGR565)
  2344. av_log(c, AV_LOG_INFO, "from %s to%s %s ",
  2345. sws_format_name(srcFormat), dither, sws_format_name(dstFormat));
  2346. else
  2347. av_log(c, AV_LOG_INFO, "from %s to %s ",
  2348. sws_format_name(srcFormat), sws_format_name(dstFormat));
  2349. if (flags & SWS_CPU_CAPS_MMX2)
  2350. av_log(c, AV_LOG_INFO, "using MMX2\n");
  2351. else if (flags & SWS_CPU_CAPS_3DNOW)
  2352. av_log(c, AV_LOG_INFO, "using 3DNOW\n");
  2353. else if (flags & SWS_CPU_CAPS_MMX)
  2354. av_log(c, AV_LOG_INFO, "using MMX\n");
  2355. else if (flags & SWS_CPU_CAPS_ALTIVEC)
  2356. av_log(c, AV_LOG_INFO, "using AltiVec\n");
  2357. else
  2358. av_log(c, AV_LOG_INFO, "using C\n");
  2359. }
  2360. if (flags & SWS_PRINT_INFO)
  2361. {
  2362. if (flags & SWS_CPU_CAPS_MMX)
  2363. {
  2364. if (c->canMMX2BeUsed && (flags&SWS_FAST_BILINEAR))
  2365. av_log(c, AV_LOG_VERBOSE, "using FAST_BILINEAR MMX2 scaler for horizontal scaling\n");
  2366. else
  2367. {
  2368. if (c->hLumFilterSize==4)
  2369. av_log(c, AV_LOG_VERBOSE, "using 4-tap MMX scaler for horizontal luminance scaling\n");
  2370. else if (c->hLumFilterSize==8)
  2371. av_log(c, AV_LOG_VERBOSE, "using 8-tap MMX scaler for horizontal luminance scaling\n");
  2372. else
  2373. av_log(c, AV_LOG_VERBOSE, "using n-tap MMX scaler for horizontal luminance scaling\n");
  2374. if (c->hChrFilterSize==4)
  2375. av_log(c, AV_LOG_VERBOSE, "using 4-tap MMX scaler for horizontal chrominance scaling\n");
  2376. else if (c->hChrFilterSize==8)
  2377. av_log(c, AV_LOG_VERBOSE, "using 8-tap MMX scaler for horizontal chrominance scaling\n");
  2378. else
  2379. av_log(c, AV_LOG_VERBOSE, "using n-tap MMX scaler for horizontal chrominance scaling\n");
  2380. }
  2381. }
  2382. else
  2383. {
  2384. #if ARCH_X86
  2385. av_log(c, AV_LOG_VERBOSE, "using x86 asm scaler for horizontal scaling\n");
  2386. #else
  2387. if (flags & SWS_FAST_BILINEAR)
  2388. av_log(c, AV_LOG_VERBOSE, "using FAST_BILINEAR C scaler for horizontal scaling\n");
  2389. else
  2390. av_log(c, AV_LOG_VERBOSE, "using C scaler for horizontal scaling\n");
  2391. #endif
  2392. }
  2393. if (isPlanarYUV(dstFormat))
  2394. {
  2395. if (c->vLumFilterSize==1)
  2396. av_log(c, AV_LOG_VERBOSE, "using 1-tap %s \"scaler\" for vertical scaling (YV12 like)\n", (flags & SWS_CPU_CAPS_MMX) ? "MMX" : "C");
  2397. else
  2398. av_log(c, AV_LOG_VERBOSE, "using n-tap %s scaler for vertical scaling (YV12 like)\n", (flags & SWS_CPU_CAPS_MMX) ? "MMX" : "C");
  2399. }
  2400. else
  2401. {
  2402. if (c->vLumFilterSize==1 && c->vChrFilterSize==2)
  2403. av_log(c, AV_LOG_VERBOSE, "using 1-tap %s \"scaler\" for vertical luminance scaling (BGR)\n"
  2404. " 2-tap scaler for vertical chrominance scaling (BGR)\n", (flags & SWS_CPU_CAPS_MMX) ? "MMX" : "C");
  2405. else if (c->vLumFilterSize==2 && c->vChrFilterSize==2)
  2406. av_log(c, AV_LOG_VERBOSE, "using 2-tap linear %s scaler for vertical scaling (BGR)\n", (flags & SWS_CPU_CAPS_MMX) ? "MMX" : "C");
  2407. else
  2408. av_log(c, AV_LOG_VERBOSE, "using n-tap %s scaler for vertical scaling (BGR)\n", (flags & SWS_CPU_CAPS_MMX) ? "MMX" : "C");
  2409. }
  2410. if (dstFormat==PIX_FMT_BGR24)
  2411. av_log(c, AV_LOG_VERBOSE, "using %s YV12->BGR24 converter\n",
  2412. (flags & SWS_CPU_CAPS_MMX2) ? "MMX2" : ((flags & SWS_CPU_CAPS_MMX) ? "MMX" : "C"));
  2413. else if (dstFormat==PIX_FMT_RGB32)
  2414. av_log(c, AV_LOG_VERBOSE, "using %s YV12->BGR32 converter\n", (flags & SWS_CPU_CAPS_MMX) ? "MMX" : "C");
  2415. else if (dstFormat==PIX_FMT_BGR565)
  2416. av_log(c, AV_LOG_VERBOSE, "using %s YV12->BGR16 converter\n", (flags & SWS_CPU_CAPS_MMX) ? "MMX" : "C");
  2417. else if (dstFormat==PIX_FMT_BGR555)
  2418. av_log(c, AV_LOG_VERBOSE, "using %s YV12->BGR15 converter\n", (flags & SWS_CPU_CAPS_MMX) ? "MMX" : "C");
  2419. av_log(c, AV_LOG_VERBOSE, "%dx%d -> %dx%d\n", srcW, srcH, dstW, dstH);
  2420. }
  2421. if (flags & SWS_PRINT_INFO)
  2422. {
  2423. av_log(c, AV_LOG_DEBUG, "lum srcW=%d srcH=%d dstW=%d dstH=%d xInc=%d yInc=%d\n",
  2424. c->srcW, c->srcH, c->dstW, c->dstH, c->lumXInc, c->lumYInc);
  2425. av_log(c, AV_LOG_DEBUG, "chr srcW=%d srcH=%d dstW=%d dstH=%d xInc=%d yInc=%d\n",
  2426. c->chrSrcW, c->chrSrcH, c->chrDstW, c->chrDstH, c->chrXInc, c->chrYInc);
  2427. }
  2428. c->swScale= getSwsFunc(flags);
  2429. return c;
  2430. }
  2431. /**
  2432. * swscale wrapper, so we don't need to export the SwsContext.
  2433. * Assumes planar YUV to be in YUV order instead of YVU.
  2434. */
  2435. int sws_scale(SwsContext *c, uint8_t* src[], int srcStride[], int srcSliceY,
  2436. int srcSliceH, uint8_t* dst[], int dstStride[]){
  2437. int i;
  2438. uint8_t* src2[4]= {src[0], src[1], src[2]};
  2439. if (c->sliceDir == 0 && srcSliceY != 0 && srcSliceY + srcSliceH != c->srcH) {
  2440. av_log(c, AV_LOG_ERROR, "Slices start in the middle!\n");
  2441. return 0;
  2442. }
  2443. if (c->sliceDir == 0) {
  2444. if (srcSliceY == 0) c->sliceDir = 1; else c->sliceDir = -1;
  2445. }
  2446. if (usePal(c->srcFormat)){
  2447. for (i=0; i<256; i++){
  2448. int p, r, g, b,y,u,v;
  2449. if(c->srcFormat == PIX_FMT_PAL8){
  2450. p=((uint32_t*)(src[1]))[i];
  2451. r= (p>>16)&0xFF;
  2452. g= (p>> 8)&0xFF;
  2453. b= p &0xFF;
  2454. }else if(c->srcFormat == PIX_FMT_RGB8){
  2455. r= (i>>5 )*36;
  2456. g= ((i>>2)&7)*36;
  2457. b= (i&3 )*85;
  2458. }else if(c->srcFormat == PIX_FMT_BGR8){
  2459. b= (i>>6 )*85;
  2460. g= ((i>>3)&7)*36;
  2461. r= (i&7 )*36;
  2462. }else if(c->srcFormat == PIX_FMT_RGB4_BYTE){
  2463. r= (i>>3 )*255;
  2464. g= ((i>>1)&3)*85;
  2465. b= (i&1 )*255;
  2466. }else {
  2467. assert(c->srcFormat == PIX_FMT_BGR4_BYTE);
  2468. b= (i>>3 )*255;
  2469. g= ((i>>1)&3)*85;
  2470. r= (i&1 )*255;
  2471. }
  2472. y= av_clip_uint8((RY*r + GY*g + BY*b + ( 33<<(RGB2YUV_SHIFT-1)))>>RGB2YUV_SHIFT);
  2473. u= av_clip_uint8((RU*r + GU*g + BU*b + (257<<(RGB2YUV_SHIFT-1)))>>RGB2YUV_SHIFT);
  2474. v= av_clip_uint8((RV*r + GV*g + BV*b + (257<<(RGB2YUV_SHIFT-1)))>>RGB2YUV_SHIFT);
  2475. c->pal_yuv[i]= y + (u<<8) + (v<<16);
  2476. switch(c->dstFormat) {
  2477. case PIX_FMT_BGR32:
  2478. #ifndef WORDS_BIGENDIAN
  2479. case PIX_FMT_RGB24:
  2480. #endif
  2481. c->pal_rgb[i]= r + (g<<8) + (b<<16);
  2482. break;
  2483. case PIX_FMT_BGR32_1:
  2484. #ifdef WORDS_BIGENDIAN
  2485. case PIX_FMT_BGR24:
  2486. #endif
  2487. c->pal_rgb[i]= (r + (g<<8) + (b<<16)) << 8;
  2488. break;
  2489. case PIX_FMT_RGB32_1:
  2490. #ifdef WORDS_BIGENDIAN
  2491. case PIX_FMT_RGB24:
  2492. #endif
  2493. c->pal_rgb[i]= (b + (g<<8) + (r<<16)) << 8;
  2494. break;
  2495. case PIX_FMT_RGB32:
  2496. #ifndef WORDS_BIGENDIAN
  2497. case PIX_FMT_BGR24:
  2498. #endif
  2499. default:
  2500. c->pal_rgb[i]= b + (g<<8) + (r<<16);
  2501. }
  2502. }
  2503. }
  2504. // copy strides, so they can safely be modified
  2505. if (c->sliceDir == 1) {
  2506. // slices go from top to bottom
  2507. int srcStride2[4]= {srcStride[0], srcStride[1], srcStride[2]};
  2508. int dstStride2[4]= {dstStride[0], dstStride[1], dstStride[2]};
  2509. return c->swScale(c, src2, srcStride2, srcSliceY, srcSliceH, dst, dstStride2);
  2510. } else {
  2511. // slices go from bottom to top => we flip the image internally
  2512. uint8_t* dst2[4]= {dst[0] + (c->dstH-1)*dstStride[0],
  2513. dst[1] + ((c->dstH>>c->chrDstVSubSample)-1)*dstStride[1],
  2514. dst[2] + ((c->dstH>>c->chrDstVSubSample)-1)*dstStride[2]};
  2515. int srcStride2[4]= {-srcStride[0], -srcStride[1], -srcStride[2]};
  2516. int dstStride2[4]= {-dstStride[0], -dstStride[1], -dstStride[2]};
  2517. src2[0] += (srcSliceH-1)*srcStride[0];
  2518. if (!usePal(c->srcFormat))
  2519. src2[1] += ((srcSliceH>>c->chrSrcVSubSample)-1)*srcStride[1];
  2520. src2[2] += ((srcSliceH>>c->chrSrcVSubSample)-1)*srcStride[2];
  2521. return c->swScale(c, src2, srcStride2, c->srcH-srcSliceY-srcSliceH, srcSliceH, dst2, dstStride2);
  2522. }
  2523. }
  2524. #if LIBSWSCALE_VERSION_MAJOR < 1
  2525. int sws_scale_ordered(SwsContext *c, uint8_t* src[], int srcStride[], int srcSliceY,
  2526. int srcSliceH, uint8_t* dst[], int dstStride[]){
  2527. return sws_scale(c, src, srcStride, srcSliceY, srcSliceH, dst, dstStride);
  2528. }
  2529. #endif
  2530. SwsFilter *sws_getDefaultFilter(float lumaGBlur, float chromaGBlur,
  2531. float lumaSharpen, float chromaSharpen,
  2532. float chromaHShift, float chromaVShift,
  2533. int verbose)
  2534. {
  2535. SwsFilter *filter= av_malloc(sizeof(SwsFilter));
  2536. if (lumaGBlur!=0.0){
  2537. filter->lumH= sws_getGaussianVec(lumaGBlur, 3.0);
  2538. filter->lumV= sws_getGaussianVec(lumaGBlur, 3.0);
  2539. }else{
  2540. filter->lumH= sws_getIdentityVec();
  2541. filter->lumV= sws_getIdentityVec();
  2542. }
  2543. if (chromaGBlur!=0.0){
  2544. filter->chrH= sws_getGaussianVec(chromaGBlur, 3.0);
  2545. filter->chrV= sws_getGaussianVec(chromaGBlur, 3.0);
  2546. }else{
  2547. filter->chrH= sws_getIdentityVec();
  2548. filter->chrV= sws_getIdentityVec();
  2549. }
  2550. if (chromaSharpen!=0.0){
  2551. SwsVector *id= sws_getIdentityVec();
  2552. sws_scaleVec(filter->chrH, -chromaSharpen);
  2553. sws_scaleVec(filter->chrV, -chromaSharpen);
  2554. sws_addVec(filter->chrH, id);
  2555. sws_addVec(filter->chrV, id);
  2556. sws_freeVec(id);
  2557. }
  2558. if (lumaSharpen!=0.0){
  2559. SwsVector *id= sws_getIdentityVec();
  2560. sws_scaleVec(filter->lumH, -lumaSharpen);
  2561. sws_scaleVec(filter->lumV, -lumaSharpen);
  2562. sws_addVec(filter->lumH, id);
  2563. sws_addVec(filter->lumV, id);
  2564. sws_freeVec(id);
  2565. }
  2566. if (chromaHShift != 0.0)
  2567. sws_shiftVec(filter->chrH, (int)(chromaHShift+0.5));
  2568. if (chromaVShift != 0.0)
  2569. sws_shiftVec(filter->chrV, (int)(chromaVShift+0.5));
  2570. sws_normalizeVec(filter->chrH, 1.0);
  2571. sws_normalizeVec(filter->chrV, 1.0);
  2572. sws_normalizeVec(filter->lumH, 1.0);
  2573. sws_normalizeVec(filter->lumV, 1.0);
  2574. if (verbose) sws_printVec2(filter->chrH, NULL, AV_LOG_DEBUG);
  2575. if (verbose) sws_printVec2(filter->lumH, NULL, AV_LOG_DEBUG);
  2576. return filter;
  2577. }
  2578. SwsVector *sws_getGaussianVec(double variance, double quality){
  2579. const int length= (int)(variance*quality + 0.5) | 1;
  2580. int i;
  2581. double *coeff= av_malloc(length*sizeof(double));
  2582. double middle= (length-1)*0.5;
  2583. SwsVector *vec= av_malloc(sizeof(SwsVector));
  2584. vec->coeff= coeff;
  2585. vec->length= length;
  2586. for (i=0; i<length; i++)
  2587. {
  2588. double dist= i-middle;
  2589. coeff[i]= exp(-dist*dist/(2*variance*variance)) / sqrt(2*variance*PI);
  2590. }
  2591. sws_normalizeVec(vec, 1.0);
  2592. return vec;
  2593. }
  2594. SwsVector *sws_getConstVec(double c, int length){
  2595. int i;
  2596. double *coeff= av_malloc(length*sizeof(double));
  2597. SwsVector *vec= av_malloc(sizeof(SwsVector));
  2598. vec->coeff= coeff;
  2599. vec->length= length;
  2600. for (i=0; i<length; i++)
  2601. coeff[i]= c;
  2602. return vec;
  2603. }
  2604. SwsVector *sws_getIdentityVec(void){
  2605. return sws_getConstVec(1.0, 1);
  2606. }
  2607. double sws_dcVec(SwsVector *a){
  2608. int i;
  2609. double sum=0;
  2610. for (i=0; i<a->length; i++)
  2611. sum+= a->coeff[i];
  2612. return sum;
  2613. }
  2614. void sws_scaleVec(SwsVector *a, double scalar){
  2615. int i;
  2616. for (i=0; i<a->length; i++)
  2617. a->coeff[i]*= scalar;
  2618. }
  2619. void sws_normalizeVec(SwsVector *a, double height){
  2620. sws_scaleVec(a, height/sws_dcVec(a));
  2621. }
  2622. static SwsVector *sws_getConvVec(SwsVector *a, SwsVector *b){
  2623. int length= a->length + b->length - 1;
  2624. double *coeff= av_malloc(length*sizeof(double));
  2625. int i, j;
  2626. SwsVector *vec= av_malloc(sizeof(SwsVector));
  2627. vec->coeff= coeff;
  2628. vec->length= length;
  2629. for (i=0; i<length; i++) coeff[i]= 0.0;
  2630. for (i=0; i<a->length; i++)
  2631. {
  2632. for (j=0; j<b->length; j++)
  2633. {
  2634. coeff[i+j]+= a->coeff[i]*b->coeff[j];
  2635. }
  2636. }
  2637. return vec;
  2638. }
  2639. static SwsVector *sws_sumVec(SwsVector *a, SwsVector *b){
  2640. int length= FFMAX(a->length, b->length);
  2641. double *coeff= av_malloc(length*sizeof(double));
  2642. int i;
  2643. SwsVector *vec= av_malloc(sizeof(SwsVector));
  2644. vec->coeff= coeff;
  2645. vec->length= length;
  2646. for (i=0; i<length; i++) coeff[i]= 0.0;
  2647. for (i=0; i<a->length; i++) coeff[i + (length-1)/2 - (a->length-1)/2]+= a->coeff[i];
  2648. for (i=0; i<b->length; i++) coeff[i + (length-1)/2 - (b->length-1)/2]+= b->coeff[i];
  2649. return vec;
  2650. }
  2651. static SwsVector *sws_diffVec(SwsVector *a, SwsVector *b){
  2652. int length= FFMAX(a->length, b->length);
  2653. double *coeff= av_malloc(length*sizeof(double));
  2654. int i;
  2655. SwsVector *vec= av_malloc(sizeof(SwsVector));
  2656. vec->coeff= coeff;
  2657. vec->length= length;
  2658. for (i=0; i<length; i++) coeff[i]= 0.0;
  2659. for (i=0; i<a->length; i++) coeff[i + (length-1)/2 - (a->length-1)/2]+= a->coeff[i];
  2660. for (i=0; i<b->length; i++) coeff[i + (length-1)/2 - (b->length-1)/2]-= b->coeff[i];
  2661. return vec;
  2662. }
  2663. /* shift left / or right if "shift" is negative */
  2664. static SwsVector *sws_getShiftedVec(SwsVector *a, int shift){
  2665. int length= a->length + FFABS(shift)*2;
  2666. double *coeff= av_malloc(length*sizeof(double));
  2667. int i;
  2668. SwsVector *vec= av_malloc(sizeof(SwsVector));
  2669. vec->coeff= coeff;
  2670. vec->length= length;
  2671. for (i=0; i<length; i++) coeff[i]= 0.0;
  2672. for (i=0; i<a->length; i++)
  2673. {
  2674. coeff[i + (length-1)/2 - (a->length-1)/2 - shift]= a->coeff[i];
  2675. }
  2676. return vec;
  2677. }
  2678. void sws_shiftVec(SwsVector *a, int shift){
  2679. SwsVector *shifted= sws_getShiftedVec(a, shift);
  2680. av_free(a->coeff);
  2681. a->coeff= shifted->coeff;
  2682. a->length= shifted->length;
  2683. av_free(shifted);
  2684. }
  2685. void sws_addVec(SwsVector *a, SwsVector *b){
  2686. SwsVector *sum= sws_sumVec(a, b);
  2687. av_free(a->coeff);
  2688. a->coeff= sum->coeff;
  2689. a->length= sum->length;
  2690. av_free(sum);
  2691. }
  2692. void sws_subVec(SwsVector *a, SwsVector *b){
  2693. SwsVector *diff= sws_diffVec(a, b);
  2694. av_free(a->coeff);
  2695. a->coeff= diff->coeff;
  2696. a->length= diff->length;
  2697. av_free(diff);
  2698. }
  2699. void sws_convVec(SwsVector *a, SwsVector *b){
  2700. SwsVector *conv= sws_getConvVec(a, b);
  2701. av_free(a->coeff);
  2702. a->coeff= conv->coeff;
  2703. a->length= conv->length;
  2704. av_free(conv);
  2705. }
  2706. SwsVector *sws_cloneVec(SwsVector *a){
  2707. double *coeff= av_malloc(a->length*sizeof(double));
  2708. int i;
  2709. SwsVector *vec= av_malloc(sizeof(SwsVector));
  2710. vec->coeff= coeff;
  2711. vec->length= a->length;
  2712. for (i=0; i<a->length; i++) coeff[i]= a->coeff[i];
  2713. return vec;
  2714. }
  2715. void sws_printVec2(SwsVector *a, AVClass *log_ctx, int log_level){
  2716. int i;
  2717. double max=0;
  2718. double min=0;
  2719. double range;
  2720. for (i=0; i<a->length; i++)
  2721. if (a->coeff[i]>max) max= a->coeff[i];
  2722. for (i=0; i<a->length; i++)
  2723. if (a->coeff[i]<min) min= a->coeff[i];
  2724. range= max - min;
  2725. for (i=0; i<a->length; i++)
  2726. {
  2727. int x= (int)((a->coeff[i]-min)*60.0/range +0.5);
  2728. av_log(log_ctx, log_level, "%1.3f ", a->coeff[i]);
  2729. for (;x>0; x--) av_log(log_ctx, log_level, " ");
  2730. av_log(log_ctx, log_level, "|\n");
  2731. }
  2732. }
  2733. #if LIBSWSCALE_VERSION_MAJOR < 1
  2734. void sws_printVec(SwsVector *a){
  2735. sws_printVec2(a, NULL, AV_LOG_DEBUG);
  2736. }
  2737. #endif
  2738. void sws_freeVec(SwsVector *a){
  2739. if (!a) return;
  2740. av_freep(&a->coeff);
  2741. a->length=0;
  2742. av_free(a);
  2743. }
  2744. void sws_freeFilter(SwsFilter *filter){
  2745. if (!filter) return;
  2746. if (filter->lumH) sws_freeVec(filter->lumH);
  2747. if (filter->lumV) sws_freeVec(filter->lumV);
  2748. if (filter->chrH) sws_freeVec(filter->chrH);
  2749. if (filter->chrV) sws_freeVec(filter->chrV);
  2750. av_free(filter);
  2751. }
  2752. void sws_freeContext(SwsContext *c){
  2753. int i;
  2754. if (!c) return;
  2755. if (c->lumPixBuf)
  2756. {
  2757. for (i=0; i<c->vLumBufSize; i++)
  2758. av_freep(&c->lumPixBuf[i]);
  2759. av_freep(&c->lumPixBuf);
  2760. }
  2761. if (c->chrPixBuf)
  2762. {
  2763. for (i=0; i<c->vChrBufSize; i++)
  2764. av_freep(&c->chrPixBuf[i]);
  2765. av_freep(&c->chrPixBuf);
  2766. }
  2767. av_freep(&c->vLumFilter);
  2768. av_freep(&c->vChrFilter);
  2769. av_freep(&c->hLumFilter);
  2770. av_freep(&c->hChrFilter);
  2771. #if HAVE_ALTIVEC
  2772. av_freep(&c->vYCoeffsBank);
  2773. av_freep(&c->vCCoeffsBank);
  2774. #endif
  2775. av_freep(&c->vLumFilterPos);
  2776. av_freep(&c->vChrFilterPos);
  2777. av_freep(&c->hLumFilterPos);
  2778. av_freep(&c->hChrFilterPos);
  2779. #if ARCH_X86 && CONFIG_GPL
  2780. #ifdef MAP_ANONYMOUS
  2781. if (c->funnyYCode) munmap(c->funnyYCode, MAX_FUNNY_CODE_SIZE);
  2782. if (c->funnyUVCode) munmap(c->funnyUVCode, MAX_FUNNY_CODE_SIZE);
  2783. #else
  2784. av_free(c->funnyYCode);
  2785. av_free(c->funnyUVCode);
  2786. #endif
  2787. c->funnyYCode=NULL;
  2788. c->funnyUVCode=NULL;
  2789. #endif /* ARCH_X86 && CONFIG_GPL */
  2790. av_freep(&c->lumMmx2Filter);
  2791. av_freep(&c->chrMmx2Filter);
  2792. av_freep(&c->lumMmx2FilterPos);
  2793. av_freep(&c->chrMmx2FilterPos);
  2794. av_freep(&c->yuvTable);
  2795. av_free(c);
  2796. }
  2797. struct SwsContext *sws_getCachedContext(struct SwsContext *context,
  2798. int srcW, int srcH, enum PixelFormat srcFormat,
  2799. int dstW, int dstH, enum PixelFormat dstFormat, int flags,
  2800. SwsFilter *srcFilter, SwsFilter *dstFilter, double *param)
  2801. {
  2802. static const double default_param[2] = {SWS_PARAM_DEFAULT, SWS_PARAM_DEFAULT};
  2803. if (!param)
  2804. param = default_param;
  2805. if (context) {
  2806. if (context->srcW != srcW || context->srcH != srcH ||
  2807. context->srcFormat != srcFormat ||
  2808. context->dstW != dstW || context->dstH != dstH ||
  2809. context->dstFormat != dstFormat || context->flags != flags ||
  2810. context->param[0] != param[0] || context->param[1] != param[1])
  2811. {
  2812. sws_freeContext(context);
  2813. context = NULL;
  2814. }
  2815. }
  2816. if (!context) {
  2817. return sws_getContext(srcW, srcH, srcFormat,
  2818. dstW, dstH, dstFormat, flags,
  2819. srcFilter, dstFilter, param);
  2820. }
  2821. return context;
  2822. }