AMD64.Raster.Mod 106 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523252425252526252725282529253025312532253325342535253625372538253925402541254225432544254525462547254825492550255125522553255425552556255725582559256025612562256325642565256625672568256925702571257225732574257525762577257825792580258125822583258425852586258725882589259025912592259325942595259625972598259926002601260226032604260526062607260826092610261126122613261426152616261726182619262026212622262326242625262626272628262926302631263226332634263526362637263826392640264126422643264426452646264726482649265026512652265326542655265626572658265926602661266226632664266526662667266826692670267126722673267426752676267726782679268026812682268326842685268626872688268926902691269226932694269526962697269826992700270127022703270427052706270727082709271027112712271327142715271627172718271927202721272227232724272527262727272827292730273127322733273427352736273727382739274027412742274327442745274627472748274927502751275227532754275527562757275827592760276127622763276427652766276727682769277027712772277327742775277627772778277927802781278227832784278527862787278827892790279127922793279427952796279727982799280028012802280328042805280628072808280928102811281228132814281528162817281828192820282128222823282428252826282728282829283028312832283328342835283628372838283928402841284228432844284528462847284828492850285128522853285428552856285728582859286028612862286328642865286628672868286928702871287228732874287528762877287828792880288128822883288428852886288728882889289028912892289328942895289628972898289929002901290229032904290529062907290829092910291129122913291429152916291729182919292029212922292329242925292629272928292929302931293229332934293529362937293829392940294129422943294429452946294729482949295029512952295329542955295629572958295929602961296229632964296529662967296829692970297129722973297429752976297729782979298029812982298329842985298629872988298929902991299229932994299529962997299829993000300130023003300430053006300730083009301030113012301330143015301630173018301930203021302230233024302530263027302830293030303130323033303430353036303730383039304030413042304330443045304630473048304930503051305230533054305530563057305830593060306130623063306430653066306730683069307030713072307330743075307630773078307930803081308230833084308530863087308830893090309130923093309430953096309730983099310031013102310331043105310631073108310931103111311231133114311531163117311831193120312131223123312431253126312731283129313031313132313331343135313631373138313931403141314231433144314531463147314831493150315131523153315431553156315731583159316031613162316331643165316631673168316931703171317231733174317531763177317831793180318131823183318431853186318731883189319031913192319331943195319631973198319932003201320232033204320532063207320832093210321132123213321432153216321732183219322032213222322332243225322632273228322932303231323232333234323532363237323832393240324132423243324432453246324732483249325032513252325332543255325632573258325932603261326232633264326532663267326832693270327132723273327432753276327732783279328032813282328332843285328632873288328932903291329232933294329532963297329832993300330133023303330433053306330733083309331033113312331333143315331633173318331933203321332233233324332533263327332833293330333133323333333433353336333733383339334033413342334333443345334633473348334933503351335233533354335533563357335833593360336133623363336433653366336733683369337033713372337333743375337633773378337933803381338233833384338533863387338833893390339133923393339433953396339733983399340034013402340334043405340634073408340934103411341234133414341534163417341834193420
  1. MODULE Raster; (** non-portable *) (* eos, TF **)
  2. (** AUTHOR "eos"; PURPOSE "Raster operations"; *)
  3. (**
  4. Raster image bitmaps and basic image processing
  5. **)
  6. (*
  7. 19.9.1999 - spawned from GfxMaps
  8. 25.10.1999 - fixed bytes-per-row calculation in Create (need to make arguments LONG)
  9. 17.11.1999 - eliminated F8 format, replaced by D8 (implemented with module Colors)
  10. 19.11.1999 - fixed missing alpha component in computed palettes
  11. 16.05.2000 - module Raster as Oberon-independent part of Images
  12. 19.06.2000 - replaced DisplayFormat and InitDisplay by DisplayFormat()
  13. 25.02.2006 - raster operations with SSE2 added (student project by Myrto Zehnder)
  14. 28.02.2008 - added capabilities for 16-bit palette & grayscale images often used in scientific,medical imaging and professional photography (Patrick Hunziker)
  15. To do:
  16. - store in compressed format
  17. - add capabilities for RGB and multiplane images with >8 bits per color as used in scientific imaging and professional photography
  18. *)
  19. IMPORT
  20. SYSTEM, KernelLog, Machine, Streams, CLUTs, Displays;
  21. (*
  22. Interfacing with display hardware and foreign framebuffers may suffer a performance hit if their
  23. bit or byte ordering can't be made compatible with that of a built-in format and has to be converted
  24. manually. Predefined format A1 has the leftmost pixel in the least significant bit of a byte, and
  25. all hi/true color formats have their blue component at the lowest address, followed by green,
  26. red, and possibly alpha (which conforms to the specification of the transfer formats in Displays).
  27. As SYSTEM is imported, the module is not portable and has always to be compiled to native code.
  28. However, it should usually suffice to recompile the module on other platforms without changing
  29. any code.
  30. Assumptions:
  31. * CHR(l) = CHR(l MOD 100H) for all l: LONGINT
  32. * SIZEOF(LONGINT)=4
  33. *)
  34. CONST
  35. b* = 0; g* = 1; r* = 2; a* = 3; (** index of blue, green, red, and alpha components in a Pixel **)
  36. (** format codes **)
  37. custom* = 0; a1* = 1; a8* = 2; d8* = 3; p8* = 4; bgr555* = 5; bgr565* = 6; bgr466* = 7; bgr888* = 8; bgra8888* = 9; p16* =10;
  38. (** components **)
  39. color* = 0; alpha* = 1; index* = 2;
  40. (** compositing operations (srcCopy = replace, srcOverDst = paint **)
  41. clear* = 0; srcCopy* = 1; dstCopy* = 2; srcOverDst* = 3; dstOverSrc* = 4; srcInDst* = 5; dstInSrc* = 6;
  42. srcWithoutDst* = 7; dstWithoutSrc* = 8; srcAtopDst* = 9; dstAtopSrc* = 10; srcXorDst* = 11; InvDst*=12;
  43. InvOverDst*=13;
  44. MAXCOL = 10000H; (*current implementation limitation for number of color indexes *)
  45. TYPE
  46. (** general pixels with red, green, blue, and alpha information in range 0..255; alpha is pre-multiplied into RGB **)
  47. Pixel* = ARRAY 4 OF CHAR;
  48. (** palette structure for indexed formats **)
  49. Palette* = OBJECT
  50. VAR
  51. col*: POINTER TO ARRAY OF Pixel; (** color table **)
  52. used*: LONGINT; (** number of valid entries in color table **)
  53. clut: CLUTs.CLUT; (* reverse color lookup structure *)
  54. PROCEDURE &New*; BEGIN NEW(col,256); used:=256 END New; (*initialized to 256 colors; for backwards compatibility*)
  55. PROCEDURE Init*(used:LONGINT); BEGIN SELF.used:=used; NEW(col,used) END Init; (*initialize to size # 256*) (*bugfix PH090122*)
  56. END Palette;
  57. (** image format **)
  58. Format0* = RECORD
  59. code*: SHORTINT; (** format code for quick format checks **)
  60. bpp*: SHORTINT; (** number of bits per pixel **)
  61. align*: SHORTINT; (** bytes per row must be multiple of this **)
  62. components*: SET; (** components that are stored in a pixel **)
  63. pal*: Palette; (** optional palette for indexed formats **)
  64. END;
  65. PackProc* = PROCEDURE (VAR fmt: Format0; adr: ADDRESS; bit: LONGINT; VAR pix: Pixel);
  66. Format* = RECORD (Format0)
  67. pack*: PackProc; (** store supported pixel components at given address **)
  68. unpack*: PackProc; (** load supported pixel components from given address **)
  69. END;
  70. (** raster image **)
  71. Image* = OBJECT (* POINTER TO ImageDesc;
  72. ImageDesc* = RECORD *)
  73. VAR
  74. width*, height*: LONGINT; (** image dimensions **)
  75. fmt*: Format; (** pixel format **)
  76. bpr*: LONGINT; (** number of bytes per row (may be negative) **)
  77. adr*: ADDRESS; (** address of lower left pixel **)
  78. mem*: POINTER TO ARRAY OF CHAR; (** block where pixels are stored; mem#NIL implies adr=ADR(mem[0]) **)
  79. END Image;
  80. (** transfer mode **)
  81. Mode0* = RECORD
  82. src*, dst*: Format; (** source and destination format **)
  83. op*: LONGINT; (** compositing operation **)
  84. col*: Pixel; (** substitute color used when transfering from pure alpha formats to colored ones **)
  85. buf: Pixel; (* constant area for special-case moving *)
  86. map: POINTER TO ARRAY OF INTEGER; (* color map for transfer between indexed formats *)
  87. END;
  88. TransferProc* = PROCEDURE (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  89. Mode* = RECORD (Mode0)
  90. transfer*: TransferProc; (** procedure transfering pixels from source to destination **)
  91. END;
  92. PictureTransferParameters* = POINTER TO RECORD
  93. img* : Image;
  94. name* : ARRAY 128 OF CHAR;
  95. done* : BOOLEAN
  96. END;
  97. VAR
  98. A1*, A8*, D8*, BGR555*, BGR565*, BGR466*, BGR888*, BGRA8888*: Format; (** predefined formats **)
  99. PixelFormat*: Format; (** special formats **)
  100. Clamp*: ARRAY 500H OF CHAR; (** Clamp[200H+i] = CHR(min(max(i, 0), 0FFH)) **)
  101. Zero: Pixel; (* pixel with all components cleared *)
  102. Bit: ARRAY 100H, 8 OF BOOLEAN; (* Bit[b, i] means bit i in byte b is set *)
  103. Set, Clr: ARRAY 100H, 8 OF CHAR; (* Set/Clr[b, i] is byte b with bit i set/cleared *)
  104. (* d8display: Displays.Display; (* only one system-wide D8 display supported *)
  105. plugin: Plugins.Plugin; *)
  106. MMXenabled*,SSE2enabled* : BOOLEAN;
  107. (**--- Color/Pixel conversions ---**)
  108. (** set pixel to opaque RGB value **)
  109. PROCEDURE SetRGB* (VAR pix: Pixel; red, green, blue: LONGINT);
  110. BEGIN
  111. pix[b] := CHR(blue); pix[g] := CHR(green); pix[r] := CHR(red); pix[a] := 0FFX
  112. END SetRGB;
  113. (** set pixel to partly transparent RGB value **)
  114. PROCEDURE SetRGBA* (VAR pix: Pixel; red, green, blue, alpha: LONGINT);
  115. BEGIN
  116. pix[b] := CHR(blue * alpha DIV 255);
  117. pix[g] := CHR(green * alpha DIV 255);
  118. pix[r] := CHR(red * alpha DIV 255);
  119. pix[a] := CHR(alpha)
  120. END SetRGBA;
  121. (** retrieve RGB and alpha values from pixel **)
  122. PROCEDURE GetRGBA* (pix: Pixel; VAR red, green, blue, alpha: LONGINT);
  123. BEGIN
  124. alpha := ORD(pix[a]);
  125. IF alpha = 0 THEN (* color has disappeared *)
  126. red := 255; green := 255; blue := 255
  127. ELSE
  128. red := ORD(pix[r]); green := ORD(pix[g]); blue := ORD(pix[b]);
  129. IF alpha # 255 THEN (* un-multiply alpha *)
  130. red := 255 * red DIV alpha; IF red > 255 THEN red := 255 END;
  131. green := 255 * green DIV alpha; IF green > 255 THEN green := 255 END;
  132. blue := 255 * blue DIV alpha; IF blue > 255 THEN blue := 255 END
  133. END
  134. END
  135. END GetRGBA;
  136. (**--- Palettes ---**)
  137. (** return index of color in palette which approximates the requested color reasonably well **)
  138. PROCEDURE PaletteIndex* (pal: Palette; red, green, blue: LONGINT): LONGINT;
  139. BEGIN
  140. IF pal.used>256 THEN
  141. RETURN CLUTs.Match(pal.clut, ASH(red, 16) + ASH(green, 8) + blue) *pal.used DIV 256 (*PH090122*)
  142. ELSE RETURN CLUTs.Match(pal.clut, ASH(red, 16) + ASH(green, 8) + blue)
  143. END;
  144. END PaletteIndex;
  145. (** compute internal palette structures whenever palette colors have been modified **)
  146. PROCEDURE InitPalette* (pal: Palette; used, bits: LONGINT);
  147. VAR n, red, green, blue, alpha: LONGINT;
  148. BEGIN
  149. n := 0;
  150. IF used>pal.used THEN NEW(pal.col,used);END;
  151. pal.used:=used;
  152. WHILE n < used DO
  153. GetRGBA(pal.col[n], red, green, blue, alpha);
  154. CLUTs.Set(pal.clut, (*n*) n*255 DIV used, ASH(red, 16) + ASH(green, 8) + blue);
  155. INC(n)
  156. END;
  157. CLUTs.Init(pal.clut, MIN (used,256), bits);
  158. END InitPalette;
  159. (** (re)compute grayscale palette, typically used for pictures with >256 gray scale values**)
  160. PROCEDURE InitGrayPalette* (pal: Palette; used, bits: LONGINT);
  161. VAR n, gray: LONGINT;
  162. BEGIN
  163. n := 0;
  164. IF used>pal.used THEN NEW(pal.col,used); END;
  165. pal.used := used;
  166. WHILE n < used DO
  167. gray:= n*255 DIV used;
  168. SetRGBA(pal.col[n],gray,gray,gray,255); (*PH 090122*)
  169. CLUTs.Set(pal.clut, gray, ASH(gray, 16) + ASH(gray, 8) + gray);
  170. INC(n)
  171. END;
  172. CLUTs.Init(pal.clut, MIN(used,256), bits);
  173. END InitGrayPalette;
  174. (** copy palette contents **)
  175. PROCEDURE CopyPalette* (from, to: Palette);
  176. VAR n: LONGINT;
  177. BEGIN
  178. n := 0;
  179. IF to.used<from.used THEN NEW(to.col,from.used) END;
  180. to.used:=from.used;
  181. WHILE n < from.used DO
  182. to.col[n] := from.col[n]; INC(n)
  183. END;
  184. CLUTs.Copy(from.clut, to.clut)
  185. END CopyPalette;
  186. (** compute and initialize a pseudo-optimal palette for an image (in hi-color or true-color format) **)
  187. PROCEDURE ComputePalette* (img: Image; pal: Palette; reservedcols, maxcols, bits: LONGINT);
  188. (*
  189. uses octree-quantization
  190. *)
  191. TYPE
  192. Node = POINTER TO RECORD (* octree node *)
  193. dsc: ARRAY 8 OF Node; (* descendants *)
  194. link: Node; (* next reducible node on same level *)
  195. leaf: BOOLEAN;
  196. weight: LONGINT; (* accumulated number of pixels represented by this node *)
  197. r, g, b: LONGINT; (* accumulated color values *)
  198. END;
  199. VAR
  200. sent, root: Node; reducible: ARRAY 8 OF Node; colors, maxDepth, y, x, bb, used: LONGINT; adr, aa: ADDRESS; pix: Pixel;
  201. PROCEDURE insert (VAR node: Node; depth: LONGINT; pix: Pixel);
  202. VAR idx, bit: LONGINT;
  203. BEGIN
  204. IF node = NIL THEN
  205. NEW(node);
  206. IF depth = maxDepth THEN
  207. node.leaf := TRUE;
  208. INC(colors)
  209. ELSE
  210. node.leaf := FALSE;
  211. node.link := reducible[depth]; reducible[depth] := node
  212. END
  213. END;
  214. INC(node.weight); (* node represents more pixels *)
  215. IF node.leaf THEN
  216. INC(node.r, LONG(ORD(pix[r])));
  217. INC(node.g, LONG(ORD(pix[g])));
  218. INC(node.b, LONG(ORD(pix[b])))
  219. ELSE
  220. idx := 0; bit := 7-depth;
  221. IF ODD(ASH(ORD(pix[r]), -bit)) THEN INC(idx, 4) END;
  222. IF ODD(ASH(ORD(pix[g]), -bit)) THEN INC(idx, 2) END;
  223. IF ODD(ASH(ORD(pix[b]), -bit)) THEN INC(idx) END;
  224. insert(node.dsc[idx], depth+1, pix)
  225. END
  226. END insert;
  227. PROCEDURE reduce;
  228. VAR d, min, n, i: LONGINT; node, prev, dsc: Node;
  229. BEGIN
  230. d := maxDepth-1;
  231. WHILE reducible[d] = NIL DO
  232. DEC(d); DEC(maxDepth)
  233. END;
  234. sent.link := reducible[d];
  235. node := sent; min := MAX(LONGINT);
  236. WHILE node.link # NIL DO
  237. IF node.link.weight < min THEN
  238. min := node.link.weight; prev := node
  239. END;
  240. node := node.link
  241. END;
  242. node := prev.link; prev.link := node.link;
  243. reducible[d] := sent.link;
  244. n := 1; (* number of colors is initially one for the node itself *)
  245. FOR i := 0 TO 7 DO
  246. dsc := node.dsc[i];
  247. IF dsc # NIL THEN
  248. DEC(n); (* reducing one color *)
  249. INC(node.r, dsc.r); INC(node.g, dsc.g); INC(node.b, dsc.b);
  250. node.dsc[i] := NIL
  251. END
  252. END;
  253. node.leaf := TRUE;
  254. INC(colors, n)
  255. END reduce;
  256. PROCEDURE traverse (node: Node);
  257. VAR i: LONGINT;
  258. BEGIN
  259. IF node # NIL THEN
  260. IF node.leaf THEN
  261. pal.col[used, r] := CHR(node.r DIV node.weight);
  262. pal.col[used, g] := CHR(node.g DIV node.weight);
  263. pal.col[used, b] := CHR(node.b DIV node.weight);
  264. pal.col[used, a] := 0FFX;
  265. INC(used)
  266. ELSE
  267. FOR i := 0 TO 7 DO
  268. traverse(node.dsc[i])
  269. END
  270. END
  271. END
  272. END traverse;
  273. BEGIN (* ComputePalette *)
  274. ASSERT(reservedcols + maxcols <= MAXCOL, 100);
  275. NEW(sent);
  276. root := NIL; colors := 0; maxDepth := 8;
  277. y := 0; adr := img.adr;
  278. WHILE y < img.height DO
  279. IF img.fmt.bpp < 8 THEN
  280. x := 0; aa := adr; bb := 0;
  281. WHILE x < img.width DO
  282. img.fmt.unpack(img.fmt, aa, bb, pix);
  283. insert(root, 0, pix);
  284. WHILE colors > maxcols DO
  285. reduce()
  286. END;
  287. INC(x); bb := bb + img.fmt.bpp; INC(aa, bb DIV 8); bb := bb MOD 8
  288. END
  289. ELSE
  290. x := 0; aa := adr; bb := img.fmt.bpp DIV 8;
  291. WHILE x < img.width DO
  292. img.fmt.unpack(img.fmt, aa, 0, pix);
  293. insert(root, 0, pix);
  294. WHILE colors > maxcols DO
  295. reduce()
  296. END;
  297. INC(x); INC(aa, bb)
  298. END
  299. END;
  300. INC(y); INC(adr, img.bpr)
  301. END;
  302. used := reservedcols;
  303. traverse(root);
  304. InitPalette(pal, used, bits)
  305. END ComputePalette;
  306. (**--- Formats ---**)
  307. (* A1 - one bit alpha, MSB leftmost *)
  308. PROCEDURE PackA1 (VAR fmt: Format0; adr: ADDRESS; bit: LONGINT; VAR pix: Pixel);
  309. VAR b: CHAR;
  310. BEGIN
  311. SYSTEM.GET(adr, b);
  312. IF pix[a] >= 80X THEN SYSTEM.PUT(adr, Set[ORD(b), bit])
  313. ELSE SYSTEM.PUT(adr, Clr[ORD(b), bit])
  314. END
  315. END PackA1;
  316. PROCEDURE UnpackA1 (VAR fmt: Format0; adr: ADDRESS; bit: LONGINT; VAR pix: Pixel);
  317. VAR b: CHAR;
  318. BEGIN
  319. SYSTEM.GET(adr, b);
  320. IF Bit[ORD(b), bit] THEN pix[a] := 0FFX
  321. ELSE pix := Zero
  322. END
  323. END UnpackA1;
  324. (* A8 - 8 bit alpha *)
  325. PROCEDURE PackA8 (VAR fmt: Format0; adr: ADDRESS; bit: LONGINT; VAR pix: Pixel);
  326. BEGIN
  327. SYSTEM.PUT(adr, pix[a])
  328. END PackA8;
  329. PROCEDURE UnpackA8 (VAR fmt: Format0; adr: ADDRESS; bit: LONGINT; VAR pix: Pixel);
  330. VAR alpha: LONGINT;
  331. BEGIN
  332. SYSTEM.GET(adr, pix[a]);
  333. IF pix[a] = 0X THEN
  334. pix := Zero
  335. ELSIF pix[a] # 0FFX THEN
  336. alpha := ORD(pix[a]);
  337. pix[r] := CHR(ORD(pix[r]) * alpha DIV 255);
  338. pix[g] := CHR(ORD(pix[g]) * alpha DIV 255);
  339. pix[b] := CHR(ORD(pix[b]) * alpha DIV 255)
  340. END
  341. END UnpackA8;
  342. (* P8 - 8 bit indexed format with custom palette *)
  343. PROCEDURE PackP8 (VAR fmt: Format0; adr: ADDRESS; bit: LONGINT; VAR pix: Pixel);
  344. BEGIN
  345. IF pix[a] # 0X THEN (* model alpha as brightness *)
  346. SYSTEM.PUT(adr, CHR(CLUTs.Match(fmt.pal.clut, ORD(pix[b]) + ASH(ORD(pix[g]), 8) + ASH(ORD(pix[r]), 16))))
  347. END
  348. END PackP8;
  349. PROCEDURE UnpackP8 (VAR fmt: Format0; adr: ADDRESS; bit: LONGINT; VAR pix: Pixel);
  350. VAR idx: CHAR;
  351. BEGIN
  352. SYSTEM.GET(adr, idx); pix := fmt.pal.col[ORD(idx)]
  353. END UnpackP8;
  354. (* D8 - 8 bit indexed format with display palette *)
  355. PROCEDURE PackD8 (VAR fmt: Format0; adr: ADDRESS; bit: LONGINT; VAR pix: Pixel);
  356. BEGIN
  357. IF pix[a] # 0X THEN (* model alpha as brightness *)
  358. SYSTEM.PUT(adr, CHR(ColorToIndex(ORD(pix[b]) + ASH(ORD(pix[g]), 8) + ASH(ORD(pix[r]), 16))))
  359. END
  360. END PackD8;
  361. PROCEDURE UnpackD8 (VAR fmt: Format0; adr: ADDRESS; bit: LONGINT; VAR pix: Pixel);
  362. VAR idx: CHAR; col: LONGINT;
  363. BEGIN
  364. SYSTEM.GET(adr, idx); col := IndexToColor(ORD(idx));
  365. pix[b] := CHR(col MOD 100H); pix[g] := CHR(ASH(col, -8) MOD 100H); pix[r] := CHR(ASH(col, -16) MOD 100H)
  366. END UnpackD8;
  367. (* P16 - 16 bit indexed format with custom palette *)
  368. PROCEDURE PackP16 (VAR fmt: Format0; adr: ADDRESS; bit: LONGINT; VAR pix: Pixel);
  369. VAR val:LONGINT;
  370. BEGIN
  371. IF pix[a] # 0X THEN (* model alpha as brightness *)
  372. (*SYSTEM.PUT16(adr, PaletteIndex(fmt.pal, ORD(pix[r]), ORD(pix[g]), ORD(pix[b])))*)
  373. val:=CLUTs.Match(fmt.pal.clut, ORD(pix[b]) + ASH(ORD(pix[g]), 8) + ASH(ORD(pix[r]),16));
  374. IF fmt.pal.used>256 THEN val:=val*fmt.pal.used DIV 256 END;
  375. SYSTEM.PUT16(adr, SHORT(val))
  376. END
  377. END PackP16;
  378. PROCEDURE UnpackP16 (VAR fmt: Format0; adr: ADDRESS; bit: LONGINT; VAR pix: Pixel);
  379. BEGIN
  380. pix := fmt.pal.col[SYSTEM.GET16(adr) MOD 1000H] (*unsigned 16 bit entity*)
  381. END UnpackP16;
  382. (* BGR555 - 16 hi-color with 5 bit blue, 5 bit green and 5 bit red in ascending order *)
  383. PROCEDURE PackBGR555 (VAR fmt: Format0; adr: ADDRESS; bit: LONGINT; VAR pix: Pixel);
  384. VAR int: LONGINT;
  385. BEGIN
  386. IF pix[a] # 0X THEN (* model alpha as brightness *)
  387. int := ASH(ORD(pix[b]), -3) + ASH(ASH(ORD(pix[g]), -3), 5) + ASH(ASH(ORD(pix[r]), -3), 10);
  388. SYSTEM.PUT(adr, CHR(int)); SYSTEM.PUT(adr+1, CHR(ASH(int, -8)))
  389. END
  390. END PackBGR555;
  391. PROCEDURE UnpackBGR555 (VAR fmt: Format0; adr: ADDRESS; bit: LONGINT; VAR pix: Pixel);
  392. VAR lo, hi: CHAR; int: LONGINT;
  393. BEGIN
  394. SYSTEM.GET(adr, lo); SYSTEM.GET(adr+1, hi); int := ASH(ORD(hi), 8) + ORD(lo);
  395. pix[b] := CHR(ASH(int MOD 20H, 3) + 4);
  396. pix[g] := CHR(ASH(ASH(int, -5) MOD 20H, 3) + 4);
  397. pix[r] := CHR(ASH(ASH(int, -10) MOD 20H, 3) + 4);
  398. pix[a] := 0FFX
  399. END UnpackBGR555;
  400. (* BGR565 - 16 hi-color with 5 bit blue, 6 bit green and 5 bit red in ascending order *)
  401. PROCEDURE PackBGR565 (VAR fmt: Format0; adr: ADDRESS; bit: LONGINT; VAR pix: Pixel);
  402. VAR int: LONGINT;
  403. BEGIN
  404. IF pix[a] # 0X THEN (* model alpha as brightness *)
  405. int := ASH(ORD(pix[b]), -3) + ASH(ASH(ORD(pix[g]), -2), 5) + ASH(ASH(ORD(pix[r]), -3), 11);
  406. SYSTEM.PUT(adr, CHR(int)); SYSTEM.PUT(adr+1, CHR(ASH(int, -8)))
  407. END
  408. END PackBGR565;
  409. PROCEDURE UnpackBGR565 (VAR fmt: Format0; adr: ADDRESS; bit: LONGINT; VAR pix: Pixel);
  410. VAR lo, hi: CHAR; int: LONGINT;
  411. BEGIN
  412. SYSTEM.GET(adr, lo); SYSTEM.GET(adr+1, hi); int := ASH(ORD(hi), 8) + ORD(lo);
  413. pix[b] := CHR(ASH(int MOD 20H, 3) + 4);
  414. pix[g] := CHR(ASH(ASH(int, -5) MOD 40H, 2) + 2);
  415. pix[r] := CHR(ASH(ASH(int, -11) MOD 20H, 3) + 4);
  416. pix[a] := 0FFX
  417. END UnpackBGR565;
  418. (* BGR466 - 16 hi-color with 4 bit blue, 6 bit green and 6 bit red in ascending order *)
  419. PROCEDURE PackBGR466 (VAR fmt: Format0; adr: ADDRESS; bit: LONGINT; VAR pix: Pixel);
  420. VAR int: LONGINT;
  421. BEGIN
  422. IF pix[a] # 0X THEN (* model alpha as brightness *)
  423. int := ASH(ORD(pix[b]), -4) + ASH(ASH(ORD(pix[g]), -2), 4) + ASH(ASH(ORD(pix[r]), -2), 10);
  424. SYSTEM.PUT(adr, CHR(int)); SYSTEM.PUT(adr+1, CHR(ASH(int, -8)))
  425. END
  426. END PackBGR466;
  427. PROCEDURE UnpackBGR466 (VAR fmt: Format0; adr: ADDRESS; bit: LONGINT; VAR pix: Pixel);
  428. VAR lo, hi: CHAR; int: LONGINT;
  429. BEGIN
  430. SYSTEM.GET(adr, lo); SYSTEM.GET(adr+1, hi); int := ASH(ORD(hi), 8) + ORD(lo);
  431. pix[b] := CHR(ASH(int MOD 10H, 4) + 8);
  432. pix[g] := CHR(ASH(ASH(int, -4) MOD 40H, 2) + 2);
  433. pix[r] := CHR(ASH(ASH(int, -10) MOD 40H, 2) + 2);
  434. pix[a] := 0FFX
  435. END UnpackBGR466;
  436. (* BGR888 - 24 bit true color with blue in lower, green in middle, and red in upper byte *)
  437. PROCEDURE PackBGR888 (VAR fmt: Format0; adr: ADDRESS; bit: LONGINT; VAR pix: Pixel);
  438. BEGIN
  439. IF pix[a] # 0X THEN (* model alpha as brightness *)
  440. SYSTEM.MOVE(ADDRESSOF(pix[0]), adr, 3)
  441. END
  442. END PackBGR888;
  443. PROCEDURE UnpackBGR888 (VAR fmt: Format0; adr: ADDRESS; bit: LONGINT; VAR pix: Pixel);
  444. BEGIN
  445. SYSTEM.MOVE(adr, ADDRESSOF(pix[0]), 3); pix[a] := 0FFX
  446. END UnpackBGR888;
  447. (* BGRA8888 - 32 bit true color with blue in lowest, green in lower middle, red in upper middle, and alpha in top byte *)
  448. PROCEDURE PackBGRA8888 (VAR fmt: Format0; adr: ADDRESS; bit: LONGINT; VAR pix: Pixel);
  449. BEGIN
  450. SYSTEM.MOVE(ADDRESSOF(pix[0]), adr, 4)
  451. END PackBGRA8888;
  452. PROCEDURE UnpackBGRA8888 (VAR fmt: Format0; adr: ADDRESS; bit: LONGINT; VAR pix: Pixel);
  453. BEGIN
  454. SYSTEM.MOVE(adr, ADDRESSOF(pix[0]), 4)
  455. END UnpackBGRA8888;
  456. (** return image format for given Displays transfer format **)
  457. PROCEDURE DisplayFormat* (format: LONGINT): Format;
  458. BEGIN
  459. CASE format OF
  460. | Displays.index8: RETURN D8
  461. | Displays.color565: RETURN BGR565
  462. | Displays.color888: RETURN BGR888
  463. | Displays.color8888: RETURN BGRA8888
  464. END
  465. END DisplayFormat;
  466. (** initialize format **)
  467. PROCEDURE InitFormat* (VAR fmt: Format; code, bpp, align: SHORTINT; comps: SET; pal: Palette; pack, unpack: PackProc);
  468. BEGIN
  469. fmt.code := code; fmt.bpp := bpp; fmt.align := align; fmt.components := comps; fmt.pal := pal;
  470. fmt.pack := pack; fmt.unpack := unpack
  471. END InitFormat;
  472. (** initialize 8 bit index format with custom palette **)
  473. PROCEDURE InitPaletteFormat* (VAR fmt: Format; pal: Palette);
  474. BEGIN
  475. (*fmt.code := p8; fmt.bpp := 8; fmt.align := 1; fmt.components := {index}; fmt.pal := pal;
  476. fmt.pack := PackP8; fmt.unpack := UnpackP8*)
  477. fmt.components := {index}; fmt.pal := pal;
  478. IF pal.used<=256 THEN
  479. fmt.align := 1;
  480. fmt.code := p8; fmt.bpp := 8;
  481. fmt.pack := PackP8; fmt.unpack := UnpackP8
  482. ELSIF pal.used <= 10000H THEN
  483. fmt.align := 2;
  484. fmt.code := p16; fmt.bpp := 16;
  485. fmt.pack := PackP16; fmt.unpack := UnpackP16
  486. ELSE HALT(199)
  487. END
  488. END InitPaletteFormat;
  489. (** return if two formats are the same **)
  490. PROCEDURE Same* (VAR fmt0, fmt1: Format): BOOLEAN;
  491. BEGIN
  492. RETURN
  493. (fmt0.pack = fmt1.pack) & (fmt0.unpack = fmt1.unpack) &
  494. (~(index IN fmt0.components) OR (fmt0.pal = fmt1.pal)) (* doesn't work if palette has been re-initialized *)
  495. END Same;
  496. (**--- Images ---**)
  497. (** initialize custom image **)
  498. PROCEDURE Init* (img: Image; width, height: LONGINT; VAR fmt: Format; bpr: LONGINT; adr: ADDRESS);
  499. BEGIN
  500. ASSERT((width > 0) & (height > 0), 100);
  501. img.width := width; img.height := height; img.fmt := fmt; img.bpr := bpr; img.adr := adr
  502. END Init;
  503. (** initialize custom image on byte buffer **)
  504. PROCEDURE InitBuf* (img: Image; width, height: LONGINT; VAR fmt: Format; bpr, offset: LONGINT; VAR buf: ARRAY OF CHAR);
  505. BEGIN
  506. ASSERT((0 <= offset) & (offset + height * ABS(bpr) <= LEN(buf)), 100);
  507. IF bpr >= 0 THEN Init(img, width, height, fmt, bpr, ADDRESSOF(buf[0]))
  508. ELSE Init(img, width, height, fmt, bpr, ADDRESSOF(buf[offset]) + LEN(buf) - bpr)
  509. END
  510. END InitBuf;
  511. (** initialize image on rectangular area within existing image (lower left corner must fall on byte boundary) **)
  512. PROCEDURE InitRect* (img, base: Image; x, y, w, h: LONGINT);
  513. BEGIN
  514. ASSERT((0 <= x) & (x + w <= base.width) & (0 <= y) & (y + h <= base.height), 100);
  515. ASSERT(x * base.fmt.bpp MOD 8 = 0, 101);
  516. Init(img, w, h, base.fmt, base.bpr, base.adr + y * base.bpr + x * base.fmt.bpp DIV 8)
  517. END InitRect;
  518. (** create image in requested format (allocating or reusing necessary memory) **)
  519. PROCEDURE Create* (img: Image; width, height: LONGINT; fmt: Format);
  520. VAR size: LONGINT; a0, a1: ADDRESS;
  521. BEGIN
  522. ASSERT((width > 0) & (height > 0), 100);
  523. img.width := width; img.height := height;
  524. img.fmt := fmt;
  525. img.bpr := (width * fmt.bpp + 7) DIV 8;
  526. IF fmt.align > 1 THEN
  527. img.bpr := (img.bpr + fmt.align - 1) DIV fmt.align * fmt.align
  528. END;
  529. size := height * img.bpr; INC(size, (-size) MOD 4);
  530. IF (img.mem = NIL) OR (size < LEN(img.mem^) DIV 2) OR (LEN(img.mem^) < size) THEN
  531. NEW(img.mem, size)
  532. ELSE
  533. a0 := ADDRESSOF(img.mem[0]); a1 := a0 + size;
  534. WHILE a0 # a1 DO
  535. SYSTEM.PUT32(a0,0); INC(a0, SIZEOF(LONGINT))
  536. END
  537. END;
  538. img.adr := ADDRESSOF(img.mem[0])
  539. END Create;
  540. (**--- Transfer Modes ---**)
  541. (** initialize transfer mode **)
  542. PROCEDURE InitMode* (VAR mode: Mode; op: SHORTINT);
  543. BEGIN
  544. mode.op := op;
  545. IF (mode.src.pal # NIL) & ((mode.map = NIL) OR (LEN(mode.map^) # mode.src.pal.used)) THEN
  546. NEW(mode.map, mode.src.pal.used)
  547. END;
  548. (*SetRGB(mode.col, 255, 255, 255);*)
  549. mode.col := SYSTEM.VAL(Pixel, -1);
  550. mode.src.pack := NIL; mode.dst.pack := NIL (* force re-evaluation of transfer procedure *)
  551. END InitMode;
  552. (** initialize transfer mode with color components for pure alpha sources **)
  553. PROCEDURE InitModeColor* (VAR mode: Mode; op: SHORTINT; red, green, blue: LONGINT);
  554. BEGIN
  555. mode.op := op;
  556. IF (mode.src.pal # NIL) & ((mode.map = NIL) OR (LEN(mode.map^) # mode.src.pal.used)) THEN
  557. NEW(mode.map, mode.src.pal.used)
  558. END;
  559. SetRGB(mode.col, red, green, blue);
  560. mode.src.pack := NIL; mode.dst.pack := NIL
  561. END InitModeColor;
  562. (** set new source color for transfer mode **)
  563. PROCEDURE SetModeColor* (VAR mode: Mode; red, green, blue: LONGINT);
  564. BEGIN
  565. SetRGB(mode.col, red, green, blue);
  566. IF (mode.src.pal # NIL) & ((mode.map = NIL) OR (LEN(mode.map^) # mode.src.pal.used)) THEN
  567. NEW(mode.map, mode.src.pal.used)
  568. END;
  569. mode.src.pack := NIL; mode.dst.pack := NIL
  570. END SetModeColor;
  571. (** blend source pixel into destination pixel according to compositing operation **)
  572. PROCEDURE Blend* (op: LONGINT; VAR src, dst: Pixel);
  573. VAR fs, fd: LONGINT;
  574. BEGIN
  575. CASE op OF
  576. | clear: fs := 0; fd := 0
  577. | srcCopy: fs := 255; fd := 0
  578. | dstCopy: fs := 0; fd := 255
  579. | srcOverDst: fs := 255; fd := 255-ORD(src[a])
  580. | dstOverSrc: fs := 255-ORD(dst[a]); fd := 255
  581. | srcInDst: fs := ORD(dst[a]); fd := 0
  582. | dstInSrc: fs := 0; fd := ORD(src[a])
  583. | srcWithoutDst: fs := 255-ORD(dst[a]); fd := 0
  584. | dstWithoutSrc: fs := 0; fd := 255-ORD(src[a])
  585. | srcAtopDst: fs := ORD(dst[a]); fd := 255-ORD(src[a])
  586. | dstAtopSrc: fs := 255-ORD(dst[a]); fd := ORD(src[a])
  587. | srcXorDst: fs := 255-ORD(dst[a]); fd := 255-ORD(src[a])
  588. END;
  589. IF fs + fd = 0 THEN
  590. dst := Zero;
  591. ELSIF fs = 0 THEN
  592. IF fd # 255 THEN
  593. dst[0] := Clamp[200H + fd * ORD(dst[0]) DIV 255];
  594. dst[1] := Clamp[200H + fd * ORD(dst[1]) DIV 255];
  595. dst[2] := Clamp[200H + fd * ORD(dst[2]) DIV 255];
  596. dst[3] := Clamp[200H + fd * ORD(dst[3]) DIV 255];
  597. END
  598. ELSIF fd = 0 THEN
  599. IF fs = 255 THEN
  600. dst := src
  601. ELSE
  602. dst[0] := Clamp[200H + fs * ORD(src[0]) DIV 255];
  603. dst[1] := Clamp[200H + fs * ORD(src[1]) DIV 255];
  604. dst[2] := Clamp[200H + fs * ORD(src[2]) DIV 255];
  605. dst[3] := Clamp[200H + fs * ORD(src[3]) DIV 255];
  606. END
  607. ELSE
  608. dst[0] := Clamp[200H + (fs * ORD(src[0]) + fd * ORD(dst[0])) DIV 255];
  609. dst[1] := Clamp[200H + (fs * ORD(src[1]) + fd * ORD(dst[1])) DIV 255];
  610. dst[2] := Clamp[200H + (fs * ORD(src[2]) + fd * ORD(dst[2])) DIV 255];
  611. dst[3] := Clamp[200H + (fs * ORD(src[3]) + fd * ORD(dst[3])) DIV 255]
  612. END
  613. END Blend;
  614. (*--- General Transfer ---*)
  615. PROCEDURE AnyBlendAny (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  616. VAR spix, dpix: Pixel;
  617. BEGIN
  618. WHILE len > 0 DO
  619. mode.src.unpack(mode.src, sadr, sbit, spix);
  620. mode.dst.unpack(mode.dst, dadr, dbit, dpix);
  621. Blend(mode.op, spix, dpix);
  622. mode.dst.pack(mode.dst, dadr, dbit, dpix);
  623. sbit := sbit + mode.src.bpp; INC(sadr, sbit DIV 8); sbit := sbit MOD 8;
  624. dbit := dbit + mode.dst.bpp; INC(dadr, dbit DIV 8); dbit := dbit MOD 8;
  625. DEC(len)
  626. END
  627. END AnyBlendAny;
  628. (* --- invert --- *)
  629. PROCEDURE InvAny (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  630. BEGIN
  631. WHILE len > 0 DO
  632. mode.dst.unpack(mode.dst, dadr, dbit, mode.buf);
  633. mode.buf[r]:=CHR(255-ORD(mode.buf[r]));
  634. mode.buf[g]:=CHR(255-ORD(mode.buf[g]));
  635. mode.buf[b]:=CHR(255-ORD(mode.buf[b]));
  636. mode.dst.pack(mode.dst, dadr, dbit, mode.buf);
  637. sbit := sbit + mode.src.bpp; INC(sadr, sbit DIV 8); sbit := sbit MOD 8;
  638. dbit := dbit + mode.dst.bpp; INC(dadr, dbit DIV 8); dbit := dbit MOD 8;
  639. DEC(len)
  640. END
  641. END InvAny;
  642. (* --- alpha invert --- *)
  643. PROCEDURE InvOverAny (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  644. VAR pix:Pixel;
  645. BEGIN
  646. WHILE len > 0 DO
  647. mode.src.unpack(mode.src, sadr, sbit, pix);
  648. IF pix[a]>=80X THEN
  649. mode.dst.unpack(mode.dst, dadr, dbit, mode.buf);
  650. mode.buf[r]:=CHR(255-ORD(mode.buf[r]));
  651. mode.buf[g]:=CHR(255-ORD(mode.buf[g]));
  652. mode.buf[b]:=CHR(255-ORD(mode.buf[b]));
  653. mode.dst.pack(mode.dst, dadr, dbit, mode.buf)
  654. END;
  655. sbit := sbit + mode.src.bpp; INC(sadr, sbit DIV 8); sbit := sbit MOD 8;
  656. dbit := dbit + mode.dst.bpp; INC(dadr, dbit DIV 8); dbit := dbit MOD 8;
  657. DEC(len)
  658. END
  659. END InvOverAny;
  660. (*--- clear ---*)
  661. PROCEDURE ClearAny (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  662. VAR inc: LONGINT;
  663. BEGIN
  664. IF mode.dst.bpp MOD 8 = 0 THEN
  665. inc := mode.dst.bpp DIV 8;
  666. WHILE len > 0 DO
  667. mode.dst.pack(mode.dst, dadr, 0, Zero);
  668. INC(dadr, inc); DEC(len)
  669. END
  670. ELSE
  671. WHILE len > 0 DO
  672. mode.dst.pack(mode.dst, dadr, dbit, Zero);
  673. dbit := dbit + mode.dst.bpp; INC(dadr, dbit DIV 8); dbit := dbit MOD 8;
  674. DEC(len)
  675. END
  676. END
  677. END ClearAny;
  678. PROCEDURE Clear1 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  679. VAR out: CHAR;
  680. BEGIN
  681. IF (dbit > 0) OR (len < 8) THEN
  682. SYSTEM.GET(dadr, out);
  683. WHILE (dbit < 8) & (len > 0) DO
  684. out := Clr[ORD(out), dbit];
  685. INC(dbit); DEC(len)
  686. END;
  687. SYSTEM.PUT(dadr, out)
  688. END;
  689. WHILE len >= 32 DO
  690. SYSTEM.PUT(dadr, LONG(LONG(0))); INC(dadr, 4); DEC(len, 32)
  691. END;
  692. WHILE len >= 8 DO
  693. SYSTEM.PUT(dadr, 0X); INC(dadr); DEC(len, 8)
  694. END;
  695. IF len > 0 THEN
  696. SYSTEM.GET(dadr, out); dbit := 0;
  697. REPEAT
  698. out := Clr[ORD(out), dbit];
  699. INC(dbit); DEC(len)
  700. UNTIL len = 0;
  701. SYSTEM.PUT(dadr, out)
  702. END
  703. END Clear1;
  704. PROCEDURE ClearBytes (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  705. BEGIN
  706. len := len * mode.dst.bpp DIV 8;
  707. WHILE len >= 4 DO
  708. SYSTEM.PUT(dadr, LONG(LONG(0))); INC(dadr, 4); DEC(len)
  709. END;
  710. WHILE len > 0 DO
  711. SYSTEM.PUT(dadr, 0X); INC(dadr); DEC(len)
  712. END
  713. END ClearBytes;
  714. (*--- srcCopy Transfer ---*)
  715. (* constant values *)
  716. PROCEDURE Set1 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  717. VAR out: CHAR;
  718. BEGIN
  719. IF (dbit > 0) OR (len < 8) THEN
  720. SYSTEM.GET(dadr, out);
  721. WHILE (dbit < 8) & (len > 0) DO
  722. out := Set[ORD(out), dbit];
  723. INC(dbit); DEC(len)
  724. END;
  725. SYSTEM.PUT(dadr, out)
  726. END;
  727. WHILE len >= 8 DO
  728. SYSTEM.PUT(dadr, 0FFX);
  729. INC(dadr); DEC(len, 8)
  730. END;
  731. IF len > 0 THEN
  732. SYSTEM.GET(dadr, out); dbit := 0;
  733. REPEAT
  734. out := Set[ORD(out), dbit];
  735. INC(dbit); DEC(len)
  736. UNTIL len = 0;
  737. SYSTEM.PUT(dadr, out)
  738. END
  739. END Set1;
  740. PROCEDURE ConstCopy8 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  741. BEGIN
  742. WHILE len > 0 DO
  743. SYSTEM.PUT(dadr, mode.buf[0]); INC(dadr); DEC(len)
  744. END
  745. END ConstCopy8;
  746. PROCEDURE ConstCopy16 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  747. BEGIN
  748. WHILE len > 0 DO
  749. SYSTEM.MOVE(ADDRESSOF(mode.buf[0]), dadr, 2); INC(dadr, 2); DEC(len)
  750. END
  751. END ConstCopy16;
  752. PROCEDURE ConstCopy24 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  753. BEGIN
  754. WHILE len > 0 DO
  755. SYSTEM.MOVE(ADDRESSOF(mode.buf[0]), dadr, 3); INC(dadr, 3); DEC(len)
  756. END
  757. END ConstCopy24;
  758. (* identical formats *)
  759. PROCEDURE Copy1 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  760. VAR in, out: CHAR;
  761. BEGIN
  762. SYSTEM.GET(sadr, in);
  763. WHILE (sbit = 0) & (dbit = 0) & (len >= 8) DO
  764. SYSTEM.PUT(dadr, in);
  765. INC(sadr); INC(dadr); DEC(len, 8);
  766. SYSTEM.GET(sadr, in)
  767. END;
  768. IF (dbit > 0) OR (len < 8) THEN
  769. SYSTEM.GET(dadr, out)
  770. END;
  771. WHILE len > 0 DO
  772. IF Bit[ORD(in), sbit] THEN out := Set[ORD(out), dbit]
  773. ELSE out := Clr[ORD(out), dbit]
  774. END;
  775. INC(sbit); INC(dbit); DEC(len);
  776. IF sbit = 8 THEN
  777. INC(sadr); sbit := 0;
  778. SYSTEM.GET(sadr, in)
  779. END;
  780. IF dbit = 8 THEN
  781. SYSTEM.PUT(dadr, out);
  782. INC(dadr); dbit := 0;
  783. IF len < 8 THEN
  784. SYSTEM.GET(dadr, out)
  785. END
  786. END
  787. END;
  788. IF dbit > 0 THEN
  789. SYSTEM.PUT(dadr, out)
  790. END
  791. END Copy1;
  792. PROCEDURE Copy8 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  793. BEGIN
  794. SYSTEM.MOVE(sadr, dadr, len)
  795. END Copy8;
  796. PROCEDURE I8CopyI8 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  797. VAR byte: CHAR;
  798. BEGIN
  799. WHILE len > 0 DO
  800. SYSTEM.GET(sadr, byte); SYSTEM.PUT(dadr, mode.map[ORD(byte)]);
  801. INC(sadr); INC(dadr); DEC(len)
  802. END
  803. END I8CopyI8;
  804. PROCEDURE Copy16 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  805. BEGIN
  806. SYSTEM.MOVE(sadr, dadr, 2*len)
  807. END Copy16;
  808. PROCEDURE I16CopyI16 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  809. VAR val: INTEGER;
  810. BEGIN
  811. WHILE len > 0 DO
  812. val:=SYSTEM.GET16(sadr); SYSTEM.PUT16(dadr, mode.map[val MOD 10000H]);
  813. INC(sadr); INC(dadr); DEC(len)
  814. END
  815. END I16CopyI16;
  816. PROCEDURE Copy24 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  817. BEGIN
  818. SYSTEM.MOVE(sadr, dadr, 3*len)
  819. END Copy24;
  820. PROCEDURE Copy32 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  821. BEGIN
  822. SYSTEM.MOVE(sadr, dadr, 4*len)
  823. END Copy32;
  824. (* general methods *)
  825. PROCEDURE AnyCopyAny (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  826. VAR pix: Pixel;
  827. BEGIN
  828. WHILE len > 0 DO
  829. pix := mode.buf;
  830. mode.src.unpack(mode.src, sadr, sbit, mode.buf);
  831. mode.dst.pack(mode.dst, dadr, dbit, mode.buf);
  832. sbit := sbit + mode.src.bpp; INC(sadr, sbit DIV 8); sbit := sbit MOD 8;
  833. dbit := dbit + mode.dst.bpp; INC(dadr, dbit DIV 8); dbit := dbit MOD 8;
  834. DEC(len)
  835. END
  836. END AnyCopyAny;
  837. PROCEDURE AnyBytesCopyAnyBytes (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  838. VAR sinc, dinc: LONGINT; pix: Pixel;
  839. BEGIN
  840. sinc := mode.src.bpp DIV 8; dinc := mode.dst.bpp DIV 8;
  841. WHILE len > 0 DO
  842. pix := mode.buf;
  843. mode.src.unpack(mode.src, sadr, sbit, mode.buf);
  844. mode.dst.pack(mode.dst, dadr, dbit, mode.buf);
  845. INC(sadr, sinc); INC(dadr, dinc); DEC(len)
  846. END
  847. END AnyBytesCopyAnyBytes;
  848. (* A1 *)
  849. PROCEDURE AnyCopyA1 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  850. VAR out: CHAR; pix: Pixel;
  851. BEGIN
  852. SYSTEM.GET(dadr, out); pix[a] := 0FFX;
  853. WHILE len > 0 DO
  854. mode.src.unpack(mode.src, sadr, sbit, pix);
  855. sbit := sbit + mode.src.bpp; INC(sadr, sbit MOD 8); sbit := sbit MOD 8;
  856. IF pix[a] >= 80X THEN out := Set[ORD(out), dbit]
  857. ELSE out := Clr[ORD(out), dbit]
  858. END;
  859. INC(dbit); DEC(len);
  860. IF dbit = 8 THEN
  861. SYSTEM.PUT(dadr, out); INC(dadr); SYSTEM.GET(dadr, out); dbit := 0
  862. END
  863. END;
  864. SYSTEM.PUT(dadr, out)
  865. END AnyCopyA1;
  866. PROCEDURE A8CopyA1 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  867. VAR out, in: CHAR;
  868. BEGIN
  869. IF (dbit > 0) OR (len < 8) THEN
  870. SYSTEM.GET(dadr, out)
  871. END;
  872. WHILE len > 0 DO
  873. SYSTEM.GET(sadr, in);
  874. IF in >= 80X THEN out := Set[ORD(out), dbit]
  875. ELSE out := Clr[ORD(out), dbit]
  876. END;
  877. INC(sadr); INC(dbit); DEC(len);
  878. IF dbit = 8 THEN
  879. SYSTEM.PUT(dadr, out);
  880. INC(dadr); dbit := 0;
  881. IF len < 8 THEN
  882. SYSTEM.GET(dadr, out)
  883. END
  884. END
  885. END;
  886. IF dbit > 0 THEN
  887. SYSTEM.PUT(dadr, out)
  888. END
  889. END A8CopyA1;
  890. PROCEDURE BGRA8888CopyA1 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  891. VAR out, in: CHAR;
  892. BEGIN
  893. INC(sadr, a); (* only look at alpha component *)
  894. IF (dbit > 0) OR (len < 8) THEN
  895. SYSTEM.GET(dadr, out)
  896. END;
  897. WHILE len > 0 DO
  898. SYSTEM.GET(sadr, in);
  899. IF in >= 80X THEN out := Set[ORD(out), dbit]
  900. ELSE out := Clr[ORD(out), dbit]
  901. END;
  902. INC(sadr, 4); INC(dbit); DEC(len);
  903. IF dbit = 8 THEN
  904. SYSTEM.PUT(dadr, out);
  905. INC(dadr); dbit := 0;
  906. IF len < 8 THEN
  907. SYSTEM.GET(dadr, out)
  908. END
  909. END
  910. END;
  911. IF dbit > 0 THEN
  912. SYSTEM.PUT(dadr, out)
  913. END
  914. END BGRA8888CopyA1;
  915. PROCEDURE A1CopyAny (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  916. VAR in: CHAR;
  917. BEGIN
  918. SYSTEM.GET(sadr, in);
  919. WHILE len > 0 DO
  920. IF Bit[ORD(in), sbit] THEN mode.dst.pack(mode.dst, dadr, dbit, mode.buf)
  921. ELSE mode.dst.pack(mode.dst, dadr, dbit, Zero)
  922. END;
  923. INC(sbit); dbit := dbit + mode.dst.bpp; INC(dadr, dbit DIV 8); dbit := dbit MOD 8; DEC(len);
  924. IF sbit = 8 THEN
  925. INC(sadr); sbit := 0;
  926. SYSTEM.GET(sadr, in)
  927. END
  928. END
  929. END A1CopyAny;
  930. PROCEDURE A1CopyA8 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  931. VAR in: CHAR;
  932. BEGIN
  933. SYSTEM.GET(sadr, in);
  934. WHILE len > 0 DO
  935. IF Bit[ORD(in), sbit] THEN SYSTEM.PUT(dadr, 0FFX)
  936. ELSE SYSTEM.PUT(dadr, 0X)
  937. END;
  938. INC(sbit); INC(dadr); DEC(len);
  939. IF sbit = 8 THEN
  940. INC(sadr); sbit := 0;
  941. SYSTEM.GET(sadr, in)
  942. END
  943. END
  944. END A1CopyA8;
  945. PROCEDURE A1CopyBGRA8888 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  946. VAR pix: Pixel; in: CHAR;
  947. BEGIN
  948. pix := mode.buf;
  949. SYSTEM.GET(sadr, in);
  950. WHILE len > 0 DO
  951. IF Bit[ORD(in), sbit] THEN pix[a] := 0FFX
  952. ELSE pix[a] := 0X
  953. END;
  954. SYSTEM.MOVE(ADDRESSOF(pix), dadr, 4);
  955. INC(sbit); INC(dadr, 4); DEC(len);
  956. IF sbit = 8 THEN
  957. INC(sadr); sbit := 0;
  958. SYSTEM.GET(sadr, in)
  959. END
  960. END
  961. END A1CopyBGRA8888;
  962. (* A8 *)
  963. PROCEDURE AnyCopyA8 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  964. VAR pix: Pixel;
  965. BEGIN
  966. pix[a] := 0FFX;
  967. WHILE len > 0 DO
  968. mode.src.unpack(mode.src, sadr, sbit, pix);
  969. SYSTEM.PUT(dadr, pix[a]);
  970. INC(dadr); sbit := sbit + mode.src.bpp; INC(sadr, sbit DIV 8); sbit := sbit MOD 8; DEC(len)
  971. END
  972. END AnyCopyA8;
  973. PROCEDURE BGRA8888CopyA8 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  974. VAR byte: CHAR;
  975. BEGIN
  976. INC(sadr, 3);
  977. WHILE len > 0 DO
  978. SYSTEM.GET(sadr, byte);
  979. SYSTEM.PUT(dadr, byte);
  980. INC(sadr, 4); INC(dadr); DEC(len)
  981. END
  982. END BGRA8888CopyA8;
  983. PROCEDURE A8CopyBGRA8888 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  984. VAR pix: Pixel;
  985. BEGIN
  986. pix := mode.buf;
  987. WHILE len > 0 DO
  988. SYSTEM.GET(sadr, pix[a]);
  989. SYSTEM.MOVE(ADDRESSOF(pix), dadr, 4);
  990. INC(sadr); INC(dadr, 4); DEC(len)
  991. END
  992. END A8CopyBGRA8888;
  993. (* P8 *)
  994. PROCEDURE AnyCopyP8 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  995. VAR pix: Pixel;
  996. BEGIN
  997. WHILE len > 0 DO
  998. pix := mode.buf;
  999. mode.src.unpack(mode.src, sadr, sbit, pix);
  1000. SYSTEM.PUT(dadr, CHR(CLUTs.Match(mode.dst.pal.clut, ORD(pix[b]) + ASH(ORD(pix[g]), 8) + ASH(ORD(pix[r]), 16))));
  1001. INC(dadr); sbit := sbit + mode.src.bpp; INC(sadr, sbit DIV 8); sbit := sbit MOD 8; DEC(len)
  1002. END
  1003. END AnyCopyP8;
  1004. PROCEDURE Any16CopyP8 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1005. VAR pix: Pixel;
  1006. BEGIN
  1007. WHILE len > 0 DO
  1008. mode.src.unpack(mode.src, sadr, 0, pix);
  1009. SYSTEM.PUT(dadr, CHR(CLUTs.Match(mode.dst.pal.clut, ORD(pix[b]) + ASH(ORD(pix[g]), 8) + ASH(ORD(pix[r]), 16))));
  1010. INC(sadr, 2); INC(dadr); DEC(len)
  1011. END
  1012. END Any16CopyP8;
  1013. PROCEDURE BGR888CopyP8 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1014. VAR pix: Pixel;
  1015. BEGIN
  1016. WHILE len > 0 DO
  1017. SYSTEM.MOVE(sadr, ADDRESSOF(pix[0]), 3);
  1018. SYSTEM.PUT(dadr, CHR(CLUTs.Match(mode.dst.pal.clut, ORD(pix[b]) + ASH(ORD(pix[g]), 8) + ASH(ORD(pix[r]), 16))));
  1019. INC(sadr, 3); INC(dadr); DEC(len)
  1020. END
  1021. END BGR888CopyP8;
  1022. PROCEDURE BGRA8888CopyP8 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1023. VAR pix: Pixel;
  1024. BEGIN
  1025. WHILE len > 0 DO
  1026. SYSTEM.MOVE(sadr, ADDRESSOF(pix[0]), 4);
  1027. SYSTEM.PUT(dadr, CHR(CLUTs.Match(mode.dst.pal.clut, ORD(pix[b]) + ASH(ORD(pix[g]), 8) + ASH(ORD(pix[r]), 16))));
  1028. INC(sadr, 4); INC(dadr); DEC(len)
  1029. END
  1030. END BGRA8888CopyP8;
  1031. PROCEDURE P8CopyAny (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1032. VAR b: CHAR;
  1033. BEGIN
  1034. WHILE len > 0 DO
  1035. SYSTEM.GET(sadr, b);
  1036. mode.dst.pack(mode.dst, dadr, dbit, mode.src.pal.col[ORD(b)]);
  1037. INC(sadr); dbit := dbit + mode.dst.bpp; INC(dadr, dbit DIV 8); dbit := dbit MOD 8; DEC(len)
  1038. END
  1039. END P8CopyAny;
  1040. PROCEDURE P8CopyAny16 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1041. VAR b: CHAR;
  1042. BEGIN
  1043. WHILE len > 0 DO
  1044. SYSTEM.GET(sadr, b);
  1045. mode.dst.pack(mode.dst, dadr, 0, mode.src.pal.col[ORD(b)]);
  1046. INC(sadr); INC(dadr, 2); DEC(len)
  1047. END
  1048. END P8CopyAny16;
  1049. PROCEDURE P8CopyBGR888 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1050. VAR b: CHAR;
  1051. BEGIN
  1052. WHILE len > 0 DO
  1053. SYSTEM.GET(sadr, b);
  1054. SYSTEM.MOVE(ADDRESSOF(mode.src.pal.col[ORD(b)]), dadr, 3);
  1055. INC(sadr); INC(dadr, 3); DEC(len)
  1056. END
  1057. END P8CopyBGR888;
  1058. PROCEDURE P8CopyBGRA8888 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1059. VAR b: CHAR;
  1060. BEGIN
  1061. WHILE len > 0 DO
  1062. SYSTEM.GET(sadr, b);
  1063. SYSTEM.MOVE(ADDRESSOF(mode.src.pal.col[ORD(b)]), dadr, 4);
  1064. INC(sadr); INC(dadr, 4); DEC(len)
  1065. END
  1066. END P8CopyBGRA8888;
  1067. (* D8 *)
  1068. PROCEDURE AnyCopyD8 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1069. VAR pix: Pixel;
  1070. BEGIN
  1071. WHILE len > 0 DO
  1072. pix := mode.buf;
  1073. mode.src.unpack(mode.src, sadr, sbit, pix);
  1074. SYSTEM.PUT(dadr, CHR(ColorToIndex(ORD(pix[b]) + ASH(ORD(pix[g]), 8) + ASH(ORD(pix[r]), 16))));
  1075. INC(dadr); sbit := sbit + mode.src.bpp; INC(sadr, sbit DIV 8); sbit := sbit MOD 8; DEC(len)
  1076. END
  1077. END AnyCopyD8;
  1078. PROCEDURE Any16CopyD8 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1079. VAR pix: Pixel;
  1080. BEGIN
  1081. WHILE len > 0 DO
  1082. mode.src.unpack(mode.src, sadr, 0, pix);
  1083. SYSTEM.PUT(dadr, CHR(ColorToIndex(ORD(pix[b]) + ASH(ORD(pix[g]), 8) + ASH(ORD(pix[r]), 16))));
  1084. INC(sadr, 2); INC(dadr); DEC(len)
  1085. END
  1086. END Any16CopyD8;
  1087. PROCEDURE BGR888CopyD8 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1088. VAR pix: Pixel;
  1089. BEGIN
  1090. WHILE len > 0 DO
  1091. SYSTEM.MOVE(sadr, ADDRESSOF(pix[0]), 3);
  1092. SYSTEM.PUT(dadr, CHR(ColorToIndex(ORD(pix[b]) + ASH(ORD(pix[g]), 8) + ASH(ORD(pix[r]), 16))));
  1093. INC(sadr, 3); INC(dadr); DEC(len)
  1094. END
  1095. END BGR888CopyD8;
  1096. PROCEDURE BGRA8888CopyD8 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1097. VAR pix: Pixel;
  1098. BEGIN
  1099. WHILE len > 0 DO
  1100. SYSTEM.MOVE(sadr, ADDRESSOF(pix[0]), 4);
  1101. SYSTEM.PUT(dadr, CHR(ColorToIndex(ORD(pix[b]) + ASH(ORD(pix[g]), 8) + ASH(ORD(pix[r]), 16))));
  1102. INC(sadr, 4); INC(dadr); DEC(len)
  1103. END
  1104. END BGRA8888CopyD8;
  1105. PROCEDURE D8CopyAny (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1106. VAR pix: Pixel; byte: CHAR; col: LONGINT;
  1107. BEGIN
  1108. pix[a] := 0FFX;
  1109. WHILE len > 0 DO
  1110. SYSTEM.GET(sadr, byte); col := IndexToColor(ORD(byte));
  1111. pix[b] := CHR(col MOD 100H); pix[g] := CHR(ASH(col, -8) MOD 100H); pix[r] := CHR(ASH(col, -16) MOD 100H);
  1112. mode.dst.pack(mode.dst, dadr, dbit, pix);
  1113. INC(sadr); dbit := dbit + mode.dst.bpp; INC(dadr, dbit DIV 8); dbit := dbit MOD 8; DEC(len)
  1114. END
  1115. END D8CopyAny;
  1116. PROCEDURE D8CopyAny16 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1117. VAR pix: Pixel; byte: CHAR; col: LONGINT;
  1118. BEGIN
  1119. pix[a] := 0FFX;
  1120. WHILE len > 0 DO
  1121. SYSTEM.GET(sadr, byte); col := IndexToColor(ORD(byte));
  1122. pix[b] := CHR(col MOD 100H); pix[g] := CHR(ASH(col, -8) MOD 100H); pix[r] := CHR(ASH(col, -16) MOD 100H);
  1123. mode.dst.pack(mode.dst, dadr, 0, pix);
  1124. INC(sadr); INC(dadr, 2); DEC(len)
  1125. END
  1126. END D8CopyAny16;
  1127. PROCEDURE D8CopyBGR888 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1128. VAR byte: CHAR; col: LONGINT; pix: Pixel;
  1129. BEGIN
  1130. WHILE len > 0 DO
  1131. SYSTEM.GET(sadr, byte); col := IndexToColor(ORD(byte));
  1132. pix[b] := CHR(col MOD 100H); pix[g] := CHR(ASH(col, -8) MOD 100H); pix[r] := CHR(ASH(col, -16) MOD 100H);
  1133. SYSTEM.MOVE(ADDRESSOF(pix[0]), dadr, 3);
  1134. INC(sadr); INC(dadr, 3); DEC(len)
  1135. END
  1136. END D8CopyBGR888;
  1137. PROCEDURE D8CopyBGRA8888 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1138. VAR pix: Pixel; byte: CHAR; col: LONGINT;
  1139. BEGIN
  1140. pix[a] := 0FFX;
  1141. WHILE len > 0 DO
  1142. SYSTEM.GET(sadr, byte); col := IndexToColor(ORD(byte));
  1143. pix[b] := CHR(col MOD 100H); pix[g] := CHR(ASH(col, -8) MOD 100H); pix[r] := CHR(ASH(col, -16) MOD 100H);
  1144. SYSTEM.MOVE(ADDRESSOF(pix[0]), dadr, 4);
  1145. INC(sadr); INC(dadr, 4); DEC(len)
  1146. END
  1147. END D8CopyBGRA8888;
  1148. (*
  1149. (* P816*)
  1150. PROCEDURE AnyCopyP16 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1151. VAR pix: Pixel;
  1152. BEGIN
  1153. WHILE len > 0 DO
  1154. pix := mode.buf;
  1155. mode.src.unpack(mode.src, sadr, sbit, pix);
  1156. SYSTEM.PUT16(dadr, PaletteIndex(mode.dst.pal, ORD(pix[r]), ORD(pix[g]), ORD(pix[b])));
  1157. INC(dadr,2); sbit := sbit + mode.src.bpp; INC(sadr, sbit DIV 8); sbit := sbit MOD 8; DEC(len)
  1158. END
  1159. END AnyCopyP16;
  1160. PROCEDURE Any16CopyP16 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1161. VAR pix: Pixel;
  1162. BEGIN
  1163. WHILE len > 0 DO
  1164. mode.src.unpack(mode.src, sadr, 0, pix);
  1165. SYSTEM.PUT16(dadr, PaletteIndex(mode.dst.pal, ORD(pix[r]), ORD(pix[g]), ORD(pix[b])));
  1166. INC(sadr, 2); INC(dadr,2); DEC(len)
  1167. END
  1168. END Any16CopyP16;
  1169. PROCEDURE BGR888CopyP16 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1170. VAR pix: Pixel;
  1171. BEGIN
  1172. WHILE len > 0 DO
  1173. SYSTEM.MOVE(sadr, ADDRESSOF(pix[0]), 3);
  1174. SYSTEM.PUT16(dadr, PaletteIndex(mode.dst.pal, ORD(pix[r]), ORD(pix[g]), ORD(pix[b])));
  1175. INC(sadr, 3); INC(dadr,2); DEC(len)
  1176. END
  1177. END BGR888CopyP16;
  1178. PROCEDURE BGRA8888CopyP16 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1179. VAR pix: Pixel;
  1180. BEGIN
  1181. WHILE len > 0 DO
  1182. SYSTEM.MOVE(sadr, ADDRESSOF(pix[0]), 4);
  1183. SYSTEM.PUT16(dadr, PaletteIndex(mode.dst.pal, ORD(pix[r]), ORD(pix[g]), ORD(pix[b])));
  1184. INC(sadr, 4); INC(dadr,2); DEC(len)
  1185. END
  1186. END BGRA8888CopyP16;
  1187. PROCEDURE P16CopyAny (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1188. BEGIN
  1189. WHILE len > 0 DO
  1190. mode.dst.pack(mode.dst, dadr, dbit, mode.src.pal.col[LONG(SYSTEM.GET16(sadr)) MOD 10000H]);
  1191. INC(sadr,2); dbit := dbit + mode.dst.bpp; INC(dadr, dbit DIV 8); dbit := dbit MOD 8; DEC(len)
  1192. END
  1193. END P16CopyAny;
  1194. PROCEDURE P16CopyAny16 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1195. BEGIN
  1196. WHILE len > 0 DO
  1197. mode.dst.pack(mode.dst, dadr, 0, mode.src.pal.col[LONG(SYSTEM.GET16(sadr)) MOD 10000H]);
  1198. INC(sadr,2); INC(dadr, 2); DEC(len)
  1199. END
  1200. END P16CopyAny16;
  1201. *)
  1202. PROCEDURE P16CopyBGR888 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1203. BEGIN
  1204. WHILE len > 0 DO
  1205. SYSTEM.MOVE(ADDRESSOF(mode.src.pal.col[LONG(SYSTEM.GET16(sadr)) MOD 10000H]), dadr, 3);
  1206. INC(sadr,2); INC(dadr, 3); DEC(len)
  1207. END
  1208. END P16CopyBGR888;
  1209. PROCEDURE P16CopyBGRA8888 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1210. VAR val:LONGINT;
  1211. BEGIN
  1212. WHILE len > 0 DO
  1213. val:=LONG(SYSTEM.GET16(sadr)) MOD 10000H;
  1214. SYSTEM.MOVE(ADDRESSOF(mode.src.pal.col[val]), dadr, 4);
  1215. INC(sadr,2); INC(dadr, 4); DEC(len)
  1216. END
  1217. END P16CopyBGRA8888;
  1218. (* BGR555, BGR565, BGR466 *)
  1219. PROCEDURE AnyCopyAny16 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1220. VAR pix: Pixel;
  1221. BEGIN
  1222. WHILE len > 0 DO
  1223. pix := mode.buf;
  1224. mode.src.unpack(mode.src, sadr, 0, pix);
  1225. mode.dst.pack(mode.dst, dadr, 0, pix);
  1226. INC(dadr, 2); sbit := sbit + mode.src.bpp; INC(sadr, sbit DIV 8); sbit := sbit MOD 8; DEC(len)
  1227. END
  1228. END AnyCopyAny16;
  1229. PROCEDURE Any16CopyAny16 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1230. VAR pix: Pixel;
  1231. BEGIN
  1232. WHILE len > 0 DO
  1233. mode.src.unpack(mode.src, sadr, 0, pix);
  1234. mode.dst.pack(mode.dst, dadr, 0, pix);
  1235. INC(sadr, 2); INC(dadr, 2); DEC(len)
  1236. END
  1237. END Any16CopyAny16;
  1238. PROCEDURE BGR888CopyAny16 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1239. VAR pix: Pixel;
  1240. BEGIN
  1241. pix[a] := 0FFX;
  1242. WHILE len > 0 DO
  1243. SYSTEM.MOVE(sadr, ADDRESSOF(pix[0]), 3);
  1244. mode.dst.pack(mode.dst, dadr, 0, pix);
  1245. INC(sadr, 3); INC(dadr, 2); DEC(len)
  1246. END
  1247. END BGR888CopyAny16;
  1248. PROCEDURE BGRA8888CopyAny16 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1249. VAR pix: Pixel;
  1250. BEGIN
  1251. WHILE len > 0 DO
  1252. SYSTEM.MOVE(sadr, ADDRESSOF(pix[0]), 4);
  1253. mode.dst.pack(mode.dst, dadr, 0, pix);
  1254. INC(dadr, 2); sbit := sbit + mode.src.bpp; INC(sadr, sbit DIV 8); sbit := sbit MOD 8; DEC(len)
  1255. END
  1256. END BGRA8888CopyAny16;
  1257. PROCEDURE Any16CopyAny (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1258. VAR pix: Pixel;
  1259. BEGIN
  1260. WHILE len > 0 DO
  1261. mode.src.unpack(mode.src, sadr, 0, pix);
  1262. mode.dst.pack(mode.dst, dadr, 0, pix);
  1263. INC(sadr, 2); dbit := dbit + mode.dst.bpp; INC(dadr, dbit DIV 8); dbit := dbit MOD 8; DEC(len)
  1264. END
  1265. END Any16CopyAny;
  1266. PROCEDURE Any16CopyBGR888 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1267. VAR pix: Pixel;
  1268. BEGIN
  1269. WHILE len > 0 DO
  1270. mode.src.unpack(mode.src, sadr, 0, pix);
  1271. SYSTEM.MOVE(ADDRESSOF(pix[0]), dadr, 3);
  1272. INC(sadr, 2); INC(dadr, 3); DEC(len)
  1273. END
  1274. END Any16CopyBGR888;
  1275. PROCEDURE Any16CopyBGRA8888 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1276. VAR pix: Pixel;
  1277. BEGIN
  1278. WHILE len > 0 DO
  1279. mode.src.unpack(mode.src, sadr, 0, pix);
  1280. SYSTEM.MOVE(ADDRESSOF(pix[0]), dadr, 4);
  1281. INC(sadr, 2); INC(dadr, 4); DEC(len)
  1282. END
  1283. END Any16CopyBGRA8888;
  1284. (* BGR888 *)
  1285. PROCEDURE AnyCopyBGR888 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1286. VAR pix: Pixel;
  1287. BEGIN
  1288. WHILE len > 0 DO
  1289. pix := mode.buf;
  1290. mode.src.unpack(mode.src, sadr, sbit, pix);
  1291. SYSTEM.MOVE(ADDRESSOF(pix[0]), dadr, 3);
  1292. INC(dadr, 3); sbit := sbit + mode.src.bpp; INC(sadr, sbit DIV 8); sbit := sbit MOD 8; DEC(len)
  1293. END
  1294. END AnyCopyBGR888;
  1295. PROCEDURE BGRA8888CopyBGR888 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1296. BEGIN
  1297. WHILE len > 0 DO
  1298. SYSTEM.MOVE(sadr, dadr, 3);
  1299. INC(sadr, 4); INC(dadr, 3); DEC(len)
  1300. END
  1301. END BGRA8888CopyBGR888;
  1302. PROCEDURE SSE2BGRA8888CopyBGR888 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1303. CODE {SYSTEM.AMD64, SYSTEM.MMX, SYSTEM.SSE, SYSTEM.SSE2}
  1304. PUSHFQ
  1305. PUSH RBX
  1306. ; CLI
  1307. MOV RSI, [RBP + sadr] ; source adr
  1308. MOV RDI, [RBP + dadr] ; source adr
  1309. MOV ECX, [RBP + len]
  1310. loop:
  1311. CMP ECX, 0
  1312. JLE end
  1313. CMP ECX, 4
  1314. JL singlepixel
  1315. fourpixel:
  1316. ; 4pixels at the time
  1317. MOV EAX, [RSI] ; pixel 0
  1318. MOV EBX, [RSI + 4] ; pixel 1
  1319. AND EAX, 0FFFFFFH
  1320. AND EBX, 0FFFFFFH
  1321. MOV EDX, EBX
  1322. SHL EDX, 24
  1323. OR EAX, EDX ; 1000
  1324. MOV [RDI], EAX ; write back to mem
  1325. MOV EAX, [RSI + 8] ; pixel 2
  1326. AND EAX, 0FFFFFFH
  1327. SHR EBX,8
  1328. MOV EDX, EAX
  1329. SHL EDX, 16
  1330. OR EBX, EDX ; 2211
  1331. MOV [RDI + 4], EBX
  1332. MOV EDX, [RSI + 12] ; pixel 3
  1333. SHL EDX, 8
  1334. SHR EAX, 16
  1335. OR EAX, EDX ; 3332
  1336. MOV [RDI], EAX
  1337. ADD RSI, 16
  1338. ADD RDI, 12
  1339. SUB ECX, 4
  1340. JG loop
  1341. JMP end
  1342. singlepixel:
  1343. MOV EAX, [RSI]
  1344. MOV [RDI], AX
  1345. SHR EAX, 16
  1346. MOV [RDI + 2], AL
  1347. ADD RSI, 4
  1348. ADD RDI, 3
  1349. SUB ECX, 1
  1350. JG loop
  1351. end:
  1352. EMMS ; declare FPU registers free
  1353. POP RBX
  1354. POPFQ
  1355. END SSE2BGRA8888CopyBGR888;
  1356. PROCEDURE BGR888CopyAny (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1357. VAR pix: Pixel;
  1358. BEGIN
  1359. pix[a] := 0FFX;
  1360. WHILE len > 0 DO
  1361. SYSTEM.MOVE(sadr, ADDRESSOF(pix[0]), 3);
  1362. mode.dst.pack(mode.dst, dadr, dbit, pix);
  1363. INC(sadr, 3); dbit := dbit + mode.dst.bpp; INC(dadr, dbit DIV 8); dbit := dbit MOD 8; DEC(len)
  1364. END
  1365. END BGR888CopyAny;
  1366. PROCEDURE BGR888CopyBGRA8888(VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1367. BEGIN
  1368. WHILE len > 0 DO
  1369. SYSTEM.MOVE(sadr, dadr, 3); SYSTEM.PUT(dadr+3, 0FFX);
  1370. INC(sadr, 3); INC(dadr, 4); DEC(len)
  1371. END
  1372. END BGR888CopyBGRA8888;
  1373. PROCEDURE SSE2BGR888CopyBGRA8888(VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1374. CODE {SYSTEM.AMD64, SYSTEM.MMX, SYSTEM.SSE, SYSTEM.SSE2}
  1375. PUSHFQ
  1376. PUSH RBX
  1377. ; CLI
  1378. PXOR XMM0, XMM0
  1379. MOV EAX, 0FF00H
  1380. PINSRW XMM0, EAX, 1
  1381. PINSRW XMM0, EAX, 3
  1382. PINSRW XMM0, EAX, 5
  1383. PINSRW XMM0, EAX, 7 ; prepare for fourpixel
  1384. SHL EAX, 16 ; prepare for singlepixel
  1385. MOV RSI, [RBP + sadr] ; source adr
  1386. MOV RDI, [RBP + dadr] ; source adr
  1387. MOV ECX, [RBP + len]
  1388. loop:
  1389. CMP ECX, 0
  1390. JLE end
  1391. CMP ECX, 4
  1392. JL singlepixel
  1393. fourpixel:
  1394. ; 4pixels at the time
  1395. PXOR XMM2,XMM2
  1396. PXOR XMM1,XMM1
  1397. MOV EBX, [RSI + 9] ; read 1st source pixel
  1398. MOVD XMM2, EBX
  1399. PSLLDQ XMM2, 4
  1400. MOV EBX, [RSI + 6] ; read 2nd source pixel
  1401. MOVD XMM1, EBX
  1402. POR XMM2, XMM1
  1403. PSLLDQ XMM2, 4
  1404. MOV EBX, [RSI + 3] ; read 3rd source pixel
  1405. MOVD XMM1, EBX
  1406. POR XMM2, XMM1
  1407. PSLLDQ XMM2, 4
  1408. MOV EBX, [RSI] ; read 4th source pixel
  1409. MOVD XMM1, EBX
  1410. POR XMM2, XMM1
  1411. ADD RSI, 12
  1412. POR XMM2, XMM0
  1413. MOVDQU [RDI], XMM2 ; set the pixels
  1414. ADD RDI, 16 ; inc adr
  1415. SUB ECX, 4
  1416. JG loop
  1417. JMP end
  1418. singlepixel:
  1419. MOV EBX, [RSI] ; read source pixel
  1420. OR EBX, EAX
  1421. ADD RSI, 3
  1422. MOV [RDI], EBX
  1423. ADD RDI, 4 ; inc adr
  1424. SUB ECX, 1
  1425. JG loop
  1426. end:
  1427. EMMS ; declare FPU registers free
  1428. POP RBX
  1429. POPFQ
  1430. END SSE2BGR888CopyBGRA8888;
  1431. (* BGRA8888 *)
  1432. PROCEDURE AnyCopyBGRA8888 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1433. VAR pix: Pixel;
  1434. BEGIN
  1435. WHILE len > 0 DO
  1436. pix := mode.buf;
  1437. mode.src.unpack(mode.src, sadr, sbit, pix);
  1438. SYSTEM.MOVE(ADDRESSOF(pix[0]), dadr, 4);
  1439. INC(dadr, 4); sbit := sbit + mode.src.bpp; INC(sadr, sbit DIV 8); sbit := sbit MOD 8; DEC(len)
  1440. END
  1441. END AnyCopyBGRA8888;
  1442. PROCEDURE BGRA8888CopyAny (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1443. VAR pix: Pixel;
  1444. BEGIN
  1445. WHILE len > 0 DO
  1446. SYSTEM.MOVE(sadr, ADDRESSOF(pix[0]), 4);
  1447. mode.dst.pack(mode.dst, dadr, dbit, pix);
  1448. INC(sadr, 4); dbit := dbit + mode.dst.bpp; INC(dadr, dbit DIV 8); dbit := dbit MOD 8; DEC(len)
  1449. END
  1450. END BGRA8888CopyAny;
  1451. (*--- dstCopy Transfer ---*)
  1452. PROCEDURE EmptyTransfer (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1453. END EmptyTransfer;
  1454. (*--- srcOverDst Transfer ---*)
  1455. (* A1 *)
  1456. PROCEDURE AnyOverA1 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1457. VAR out: CHAR; pix: Pixel;
  1458. BEGIN
  1459. SYSTEM.GET(dadr, out);
  1460. WHILE len > 0 DO
  1461. mode.src.unpack(mode.src, sadr, sbit, pix);
  1462. IF pix[a] >= 80X THEN
  1463. out := Set[ORD(out), dbit]
  1464. END;
  1465. sbit := sbit + mode.src.bpp; INC(sadr, sbit DIV 8); sbit := sbit MOD 8; INC(dbit); DEC(len);
  1466. IF dbit = 8 THEN
  1467. SYSTEM.PUT(dadr, out);
  1468. INC(dadr); dbit := 0;
  1469. SYSTEM.GET(dadr, out)
  1470. END
  1471. END;
  1472. SYSTEM.PUT(dadr, out)
  1473. END AnyOverA1;
  1474. PROCEDURE A1OverA1 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1475. VAR in, out: CHAR;
  1476. BEGIN
  1477. SYSTEM.GET(sadr, in); SYSTEM.GET(dadr, out);
  1478. WHILE len > 0 DO
  1479. IF Bit[ORD(in), sbit] THEN
  1480. out := Set[ORD(out), dbit]
  1481. END;
  1482. INC(sbit); INC(dbit); DEC(len);
  1483. IF sbit = 8 THEN
  1484. INC(sadr); sbit := 0;
  1485. SYSTEM.GET(sadr, in)
  1486. END;
  1487. IF dbit = 8 THEN
  1488. SYSTEM.PUT(dadr, out);
  1489. INC(dadr); dbit := 0;
  1490. SYSTEM.GET(dadr, out)
  1491. END
  1492. END;
  1493. SYSTEM.PUT(dadr, out)
  1494. END A1OverA1;
  1495. PROCEDURE A8OverA1 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1496. VAR in, out: CHAR;
  1497. BEGIN
  1498. SYSTEM.GET(dadr, out);
  1499. WHILE len > 0 DO
  1500. SYSTEM.GET(sadr, in);
  1501. IF in >= 80X THEN
  1502. out := Set[ORD(out), dbit]
  1503. END;
  1504. INC(sadr); INC(dbit); DEC(len);
  1505. IF dbit = 8 THEN
  1506. SYSTEM.PUT(dadr, out);
  1507. INC(dadr); dbit := 0;
  1508. SYSTEM.GET(dadr, out)
  1509. END
  1510. END;
  1511. SYSTEM.PUT(dadr, out)
  1512. END A8OverA1;
  1513. PROCEDURE BGRA8888OverA1 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1514. VAR in, out: CHAR;
  1515. BEGIN
  1516. SYSTEM.GET(dadr, out);
  1517. WHILE len > 0 DO
  1518. SYSTEM.GET(sadr + a, in);
  1519. IF in >= 80X THEN
  1520. out := Set[ORD(out), dbit]
  1521. END;
  1522. INC(sadr, 4); INC(dbit); DEC(len);
  1523. IF dbit = 8 THEN
  1524. SYSTEM.PUT(dadr, out);
  1525. INC(dadr); dbit := 0;
  1526. SYSTEM.GET(dadr, out)
  1527. END
  1528. END;
  1529. SYSTEM.PUT(dadr, out)
  1530. END BGRA8888OverA1;
  1531. PROCEDURE A1OverAny (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1532. VAR in: CHAR;
  1533. BEGIN
  1534. SYSTEM.GET(sadr, in);
  1535. WHILE len > 0 DO
  1536. IF Bit[ORD(in), sbit] THEN
  1537. mode.dst.pack(mode.dst, dadr, dbit, mode.buf)
  1538. END;
  1539. INC(sbit); dbit := dbit + mode.dst.bpp; INC(dadr, dbit DIV 8); dbit := dbit MOD 8; DEC(len);
  1540. IF sbit = 8 THEN
  1541. INC(sadr); sbit := 0;
  1542. SYSTEM.GET(sadr, in)
  1543. END
  1544. END
  1545. END A1OverAny;
  1546. PROCEDURE A1OverConst8 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1547. VAR in: CHAR;
  1548. BEGIN
  1549. SYSTEM.GET(sadr, in);
  1550. WHILE len > 0 DO
  1551. IF Bit[ORD(in), sbit] THEN
  1552. SYSTEM.PUT(dadr, mode.buf[0])
  1553. END;
  1554. INC(sbit); INC(dadr); DEC(len);
  1555. IF sbit = 8 THEN
  1556. INC(sadr); sbit := 0;
  1557. SYSTEM.GET(sadr, in)
  1558. END
  1559. END
  1560. END A1OverConst8;
  1561. PROCEDURE A1OverConst16 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1562. VAR in: CHAR;
  1563. BEGIN
  1564. SYSTEM.GET(sadr, in);
  1565. WHILE len > 0 DO
  1566. IF Bit[ORD(in), sbit] THEN
  1567. SYSTEM.MOVE(ADDRESSOF(mode.buf[0]), dadr, 2)
  1568. END;
  1569. INC(sbit); INC(dadr, 2); DEC(len);
  1570. IF sbit = 8 THEN
  1571. INC(sadr); sbit := 0;
  1572. SYSTEM.GET(sadr, in)
  1573. END
  1574. END
  1575. END A1OverConst16;
  1576. PROCEDURE A1OverConst24 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1577. VAR in: CHAR;
  1578. BEGIN
  1579. SYSTEM.GET(sadr, in);
  1580. WHILE len > 0 DO
  1581. IF Bit[ORD(in), sbit] THEN
  1582. SYSTEM.MOVE(ADDRESSOF(mode.buf[0]), dadr, 3)
  1583. END;
  1584. INC(sbit); INC(dadr, 3); DEC(len);
  1585. IF sbit = 8 THEN
  1586. INC(sadr); sbit := 0;
  1587. SYSTEM.GET(sadr, in)
  1588. END
  1589. END
  1590. END A1OverConst24;
  1591. PROCEDURE A1OverConst32 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1592. VAR in: CHAR;
  1593. BEGIN
  1594. SYSTEM.GET(sadr, in);
  1595. WHILE len > 0 DO
  1596. IF Bit[ORD(in), sbit] THEN
  1597. SYSTEM.MOVE(ADDRESSOF(mode.buf[0]), dadr, 4)
  1598. END;
  1599. INC(sbit); INC(dadr, 4); DEC(len);
  1600. IF sbit = 8 THEN
  1601. INC(sadr); sbit := 0;
  1602. SYSTEM.GET(sadr, in)
  1603. END
  1604. END
  1605. END A1OverConst32;
  1606. (* A8 *)
  1607. PROCEDURE AnyOverA8 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1608. VAR pix: Pixel; b: CHAR;
  1609. BEGIN
  1610. WHILE len > 0 DO
  1611. mode.src.unpack(mode.src, sadr, sbit, pix);
  1612. IF pix[a] = 0FFX THEN
  1613. SYSTEM.PUT(dadr, 0FFX)
  1614. ELSIF pix[a] # 0X THEN
  1615. SYSTEM.GET(dadr, b);
  1616. SYSTEM.PUT(dadr, CHR(ORD(pix[a]) + ORD(b) * LONG(255-ORD(pix[a])) DIV 255))
  1617. END;
  1618. sbit := sbit + mode.src.bpp; INC(sadr, sbit DIV 8); sbit := sbit MOD 8; INC(dadr); DEC(len)
  1619. END
  1620. END AnyOverA8;
  1621. PROCEDURE A8OverAny (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1622. VAR spix, dpix: Pixel; alpha, rc,gc,bc,ac: CHAR;
  1623. BEGIN
  1624. ac := mode.col[a];
  1625. rc := mode.col[r];
  1626. gc := mode.col[g];
  1627. bc := mode.col[b];
  1628. WHILE len > 0 DO
  1629. SYSTEM.GET(sadr, alpha);
  1630. alpha := CHR(ORD(ac) * ORD(alpha) DIV 255);
  1631. IF alpha = 0FFX THEN
  1632. mode.dst.pack(mode.dst, dadr, dbit, mode.buf)
  1633. ELSIF alpha # 0X THEN
  1634. spix[a] := alpha;
  1635. (* the following computation of the colors has to be done because the blending method seems to assume this *)
  1636. spix[r] := CHR(ORD(rc) * ORD(alpha) DIV 255);
  1637. spix[g] := CHR(ORD(gc) * ORD(alpha) DIV 255);
  1638. spix[b] := CHR(ORD(bc) * ORD(alpha) DIV 255);
  1639. mode.dst.unpack(mode.dst, dadr, dbit, dpix);
  1640. Blend(mode.op, spix, dpix);
  1641. mode.dst.pack(mode.dst, dadr, dbit, dpix);
  1642. END;
  1643. INC(sadr); DEC(len);
  1644. dbit := dbit + mode.dst.bpp; INC(dadr, dbit DIV 8); dbit := dbit MOD 8
  1645. END
  1646. END A8OverAny;
  1647. PROCEDURE A8OverA8 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1648. VAR in, out: CHAR;
  1649. BEGIN
  1650. WHILE len > 0 DO
  1651. SYSTEM.GET(sadr, in);
  1652. IF in = 0FFX THEN
  1653. SYSTEM.PUT(dadr, 0FFX)
  1654. ELSIF in # 0X THEN
  1655. SYSTEM.GET(dadr, out);
  1656. SYSTEM.PUT(dadr, CHR(ORD(in) + ORD(out) * LONG(255-ORD(in)) DIV 255))
  1657. END;
  1658. INC(sadr); INC(dadr); DEC(len)
  1659. END
  1660. END A8OverA8;
  1661. (* BGRA8888 *)
  1662. PROCEDURE BGRA8888OverAny (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1663. VAR spix, dpix: Pixel;
  1664. BEGIN
  1665. WHILE len > 0 DO
  1666. SYSTEM.GET (sadr, spix);
  1667. IF spix[a] = 0FFX THEN
  1668. mode.dst.pack(mode.dst, dadr, dbit, spix)
  1669. ELSIF spix[a] # 0X THEN
  1670. mode.dst.unpack(mode.dst, dadr, dbit, dpix);
  1671. Blend(mode.op, spix, dpix);
  1672. mode.dst.pack(mode.dst, dadr, dbit, dpix)
  1673. END;
  1674. INC(sadr, SIZEOF (Pixel)); DEC(len);
  1675. dbit := dbit + mode.dst.bpp; INC(dadr, dbit DIV 8); dbit := dbit MOD 8
  1676. END
  1677. END BGRA8888OverAny;
  1678. PROCEDURE BGRA8888OverA8 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1679. VAR in, out: CHAR;
  1680. BEGIN
  1681. WHILE len > 0 DO
  1682. SYSTEM.GET(sadr + a, in);
  1683. IF in = 0FFX THEN
  1684. SYSTEM.PUT(dadr, 0FFX)
  1685. ELSIF in # 0X THEN
  1686. SYSTEM.GET(dadr, out);
  1687. SYSTEM.PUT(dadr, CHR(ORD(in) + ORD(out) * (255 - ORD(in)) DIV 255))
  1688. END;
  1689. INC(sadr, 4); INC(dadr); DEC(len)
  1690. END
  1691. END BGRA8888OverA8;
  1692. PROCEDURE BGRA8888OverAny16 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1693. VAR src, dst: Pixel; fd, t: LONGINT;
  1694. BEGIN
  1695. WHILE len > 0 DO
  1696. SYSTEM.GET (sadr, src);
  1697. IF src[a] = 0FFX THEN
  1698. mode.dst.pack(mode.dst, dadr, dbit, src)
  1699. ELSIF src[a] # 0X THEN
  1700. mode.dst.unpack(mode.dst, dadr, 0, dst);
  1701. fd := 255-ORD(src[a]);
  1702. t := (256 * ORD(src[0]) + fd * ORD(dst[0])) DIV 256;
  1703. IF t < 255 THEN dst[0] := CHR(t) ELSE dst[0] := CHR(255) END;
  1704. t := (256 * ORD(src[1]) + fd * ORD(dst[1])) DIV 256;
  1705. IF t < 255 THEN dst[1] := CHR(t) ELSE dst[1] := CHR(255) END;
  1706. t := (256 * ORD(src[2]) + fd * ORD(dst[2])) DIV 256;
  1707. IF t < 255 THEN dst[2] := CHR(t) ELSE dst[2] := CHR(255) END;
  1708. t := (256 * ORD(src[3]) + fd * ORD(dst[3])) DIV 256;
  1709. IF t < 255 THEN dst[3] := CHR(t) ELSE dst[3] := CHR(255) END;
  1710. mode.dst.pack(mode.dst, dadr, 0, dst);
  1711. END;
  1712. INC(dadr, 2); INC(sadr, SIZEOF (Pixel)); DEC(len)
  1713. END
  1714. END BGRA8888OverAny16;
  1715. PROCEDURE BGRA8888Over565* (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1716. VAR src, dst: Pixel; fd, t: LONGINT;
  1717. BEGIN
  1718. WHILE len > 0 DO
  1719. SYSTEM.GET (sadr, src);
  1720. IF src[a] = 0FFX THEN
  1721. SYSTEM.PUT16(dadr, ASH(ORD(src[b]), -3) + ASH(ASH(ORD(src[g]), -2), 5) + ASH(ASH(ORD(src[r]), -3), 11));
  1722. ELSIF src[a] # 0X THEN
  1723. t := SYSTEM.GET16(dadr);
  1724. dst[b] := CHR((t MOD 32) * 8); dst[g] := CHR((t DIV 32 MOD 64) * 4); dst[r] := CHR((t DIV 2048 MOD 32) * 8);
  1725. fd := 256-ORD(src[a]);
  1726. t := (256 * ORD(src[0]) + fd * ORD(dst[0])) DIV 256;
  1727. IF t < 255 THEN dst[0] := CHR(t) ELSE dst[0] := CHR(255) END;
  1728. t := (256 * ORD(src[1]) + fd * ORD(dst[1])) DIV 256;
  1729. IF t < 255 THEN dst[1] := CHR(t) ELSE dst[1] := CHR(255) END;
  1730. t := (256 * ORD(src[2]) + fd * ORD(dst[2])) DIV 256;
  1731. IF t < 255 THEN dst[2] := CHR(t) ELSE dst[2] := CHR(255) END;
  1732. t := (256 * ORD(src[3]) + fd * ORD(dst[3])) DIV 256;
  1733. IF t < 255 THEN dst[3] := CHR(t) ELSE dst[3] := CHR(255) END;
  1734. SYSTEM.PUT16(dadr, ASH(ORD(dst[b]), -3) + ASH(ASH(ORD(dst[g]), -2), 5) + ASH(ASH(ORD(dst[r]), -3), 11));
  1735. END;
  1736. INC(dadr, 2); INC(sadr, 4); DEC(len)
  1737. END
  1738. END BGRA8888Over565;
  1739. PROCEDURE MMXBGRA8888Over565(VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1740. CODE {SYSTEM.AMD64, SYSTEM.MMX}
  1741. PUSHFQ
  1742. ; CLI
  1743. MOV RSI, [RBP + sadr]
  1744. MOV RDI, [RBP + dadr]
  1745. PXOR MMX0, MMX0
  1746. PXOR MMX1, MMX1
  1747. MOV EAX, 0FFFFFFFFH
  1748. MOVD MMX7, EAX
  1749. PUNPCKLBW MMX7, MMX0 ; 00FF00FF00FF00FF
  1750. MOV ECX, [RBP + len]
  1751. loop:
  1752. CMP ECX, 0
  1753. JE WORD end
  1754. MOV EAX, [RSI]
  1755. XOR EBX, EBX
  1756. MOV BX, [RDI]
  1757. ; 255 - alpha
  1758. MOV EDX, EAX
  1759. SHR EDX, 24
  1760. CMP EDX, 0
  1761. JE WORD empty
  1762. CMP EDX, 255
  1763. JE full
  1764. alpha:
  1765. NEG EDX
  1766. ADD EDX, 255
  1767. MOVD MMX6, EDX
  1768. PUNPCKLWD MMX6, MMX6
  1769. PUNPCKLDQ MMX6, MMX6
  1770. MOVD MMX1, EAX
  1771. ; unpack dst
  1772. MOV EDX, EBX ; b
  1773. SHL EDX, 3
  1774. AND EDX, 0F8H
  1775. MOV EAX, EDX
  1776. MOV EDX, EBX ; g
  1777. SHL EDX, 5
  1778. AND EDX, 0FC00H
  1779. OR EAX, EDX
  1780. MOV EDX, EBX ; r
  1781. SHL EDX, 8
  1782. AND EDX, 0F80000H
  1783. OR EAX, EDX
  1784. MOVD MMX2, EAX
  1785. PUNPCKLBW MMX1, MMX0 ; 0000ARGB --> 0A0R0G0B
  1786. PMULLW MMX1, MMX7
  1787. PUNPCKLBW MMX2, MMX0 ; 0000ARGB --> 0A0R0G0B
  1788. PMULLW MMX2, MMX6
  1789. PADDUSW MMX1, MMX2
  1790. ; PSRLW MM1, 8 ; normalize
  1791. DB 0FH, 71H, 0D1H, 08H
  1792. PACKUSWB MMX1, MMX0
  1793. ; HUGA BIMBO Muell
  1794. MOVD EAX, MMX1
  1795. full:
  1796. ; XOR EDX, EDX
  1797. ; SHR EAX, 3
  1798. ; MOV EDX, EAX
  1799. ; AND EDX, 1FH
  1800. ; SHR EAX, 2
  1801. ; AND EAX, 0FFFFFFE0H
  1802. ; OR EDX, EAX
  1803. ; AND EDX, 7FFH
  1804. ;
  1805. ; SHR EAX, 3
  1806. ; AND EAX,
  1807. ;
  1808. ;
  1809. ; SHR AL, 3
  1810. ; SHR AH, 2
  1811. ; MOV EDX, EAX
  1812. ; SHR EAX, 3
  1813. ; AND EAX, 01F0000H
  1814. ; OR EDX, EAX
  1815. ; AND EDX, 01F3F1FH
  1816. MOV EBX, EAX
  1817. AND EBX, 0FFH
  1818. SHR EBX, 3
  1819. MOV EDX, EBX
  1820. MOV EBX, EAX
  1821. SHR EBX, 8
  1822. AND EBX, 0FFH
  1823. SHR EBX, 2
  1824. SHL EBX, 5
  1825. OR EDX, EBX
  1826. MOV EBX, EAX
  1827. SHR EBX, 16
  1828. AND EBX, 0FFH
  1829. SHR EBX, 3
  1830. SHL EBX, 11
  1831. OR EDX, EBX
  1832. MOV [RDI], DX
  1833. empty:
  1834. ADD RSI, 4;
  1835. ADD RDI, 2;
  1836. DEC ECX
  1837. JMP WORD loop
  1838. end:
  1839. EMMS ; declare FPU registers free
  1840. POPFQ
  1841. END MMXBGRA8888Over565;
  1842. PROCEDURE SSE2BGRA8888Over565(VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1843. CODE {SYSTEM.AMD64, SYSTEM.MMX, SYSTEM.SSE, SYSTEM.SSE2}
  1844. PUSHFQ
  1845. PUSH RBX
  1846. ; CLI
  1847. PXOR MMX0, MMX0
  1848. PXOR MMX1, MMX1
  1849. PXOR MMX2, MMX2
  1850. PXOR MMX3, MMX3
  1851. PXOR MMX4, MMX4
  1852. PXOR MMX5, MMX5
  1853. PXOR MMX6, MMX6
  1854. PXOR MMX7, MMX7
  1855. PXOR XMM3, XMM3
  1856. PXOR XMM4, XMM4
  1857. MOV RSI, [RBP + sadr]
  1858. MOV RDI, [RBP + dadr]
  1859. MOV ECX, [RBP + len]
  1860. ; create masks
  1861. ; src only FF which is rotated -> MM3
  1862. MOV EAX, 0000000FFH
  1863. MOVD MMX3, EAX
  1864. ; dest red -> MM4
  1865. MOV EAX, 0F800F800H
  1866. MOVD MMX4, EAX
  1867. ; dest green -> MM5
  1868. MOV EAX, 07E007E0H
  1869. MOVD MMX5, EAX
  1870. ; dest blue -> MM6 ; moved as MM6 is used in singlepixel
  1871. ; MOV EAX, 001F001FH
  1872. ; MOVD MMX6, EAX
  1873. ; BEGIN
  1874. ; WHILE len > 0 DO
  1875. loop:
  1876. CMP ECX,0
  1877. JE WORD end ; jump to end if ECX = 0
  1878. ; if len < 8 then do one pixel at the time
  1879. CMP ECX, 8
  1880. JL WORD singlepixel
  1881. ; else
  1882. ; take 8 at the time
  1883. MOV EBX, ESI
  1884. AND EBX, 0FH
  1885. CMP EBX, 0
  1886. JNE WORD singlepixel
  1887. alleightpixels:
  1888. ; dest blue -> MM6
  1889. MOV EAX, 001F001FH
  1890. MOVD MMX6, EAX
  1891. ; src := SYSTEM.VAL(Pixel, SYSTEM.GET32(sadr));
  1892. ; Load data into memory
  1893. ;MOV XMM4, 0FF000000FF000000FF000000FF000000H
  1894. MOVDQA XMM2, [RSI] ;src 5-8
  1895. MOVQ2DQ XMM4, MMX3 ; 000000000000000000000000000000FFH
  1896. MOVDQA XMM1, [RSI + 16] ;src 1-4
  1897. PREFETCHNTA [RSI + 32] ; prepare src 9-15
  1898. ; get alphas
  1899. MOVDQU XMM6, XMM2
  1900. PSHUFD XMM4, XMM4, 0
  1901. MOVDQU XMM5, XMM1
  1902. PSLLD XMM4, 24
  1903. PAND XMM6, XMM4 ; alpha 5-8 in XMM6
  1904. PAND XMM5, XMM4 ; alpha 1-4 in XMM5
  1905. PSRLD XMM5, 24
  1906. PSHUFHW XMM5, XMM5, 85H
  1907. PSRLD XMM6, 24
  1908. ; put both alphas into 1 register
  1909. PSHUFHW XMM6, XMM6, 85H
  1910. PSHUFLW XMM5, XMM5, 85H
  1911. PSHUFLW XMM6, XMM6, 58H
  1912. PSHUFD XMM5, XMM5, 0D0H ; 0102030400000000
  1913. PSHUFD XMM6, XMM6, 5CH ; 0000000005060708
  1914. PXOR XMM0,XMM0
  1915. POR XMM5, XMM6 ; XMM5 = alphas 0102030405060708
  1916. PCMPEQD XMM0, XMM5
  1917. PMOVMSKB EAX, XMM0
  1918. CMP EAX, 0FFFFH ; all alphas = zero; TEST not possible, because only 8 bits compared
  1919. JE WORD endloop
  1920. ; mask out alpha = zero
  1921. ; fd := 255-ORD(src[a]); fd = XMM4
  1922. ; MOV XMM4, 00FF00FF00FF00FF00FF00FF00FF00FFH
  1923. PXOR XMM4, XMM4
  1924. MOV EAX, 00FFH
  1925. PINSRW XMM4, EAX ,0
  1926. PSHUFLW XMM4, XMM4, 0
  1927. PSHUFD XMM4, XMM4, 0
  1928. PSUBW XMM4, XMM5
  1929. MOV EAX,1H
  1930. PINSRW XMM3, EAX ,0
  1931. PSHUFLW XMM3, XMM3, 0
  1932. PSHUFD XMM3, XMM3, 0
  1933. PADDUSW XMM4, XMM3
  1934. ; new red
  1935. ; calculate red 2
  1936. ; get source
  1937. ; sred14 = src14 && (srcMask <<16)
  1938. ; srcMask << 16
  1939. MOVQ2DQ XMM3, MMX3
  1940. PSHUFD XMM3, XMM3, 0
  1941. MOVDQU XMM5, XMM1
  1942. MOVDQU XMM6, XMM2
  1943. PSLLD XMM3, 16
  1944. ; sred14 = src14 && (srcMask << 24)
  1945. ; src14 must be copied because it mustn't be changed
  1946. PAND XMM5, XMM3 ; sred14
  1947. PSRLD XMM5, 16
  1948. ; sred14s = shuffled sred14
  1949. PSHUFHW XMM5, XMM5,85H
  1950. PAND XMM6, XMM3 ; sred58
  1951. PSRLD XMM6, 16
  1952. PSHUFLW XMM5, XMM5,85H
  1953. PSHUFHW XMM6, XMM6,85H
  1954. PSHUFD XMM5, XMM5,0D0H ; sred14s
  1955. PSHUFLW XMM6, XMM6,58H
  1956. PSHUFD XMM6, XMM6,5CH ; sred58s
  1957. POR XMM5, XMM6 ; sred18
  1958. ; sred18255 = sred18 * 256- sred18
  1959. MOVDQU XMM7, XMM5
  1960. PSLLW XMM5, 8
  1961. PSUBUSW XMM5, XMM7 ; sred18255
  1962. ; src is now ready
  1963. ; destination
  1964. ; dest18 must be copied because it mustn't be changed
  1965. ; Load data into memory
  1966. MOVDQU XMM3, [RDI] ;dest 1-8
  1967. MOVQ2DQ XMM6, MMX4
  1968. PSHUFD XMM6, XMM6, 0
  1969. MOVDQU XMM7, XMM3
  1970. PAND XMM7, XMM6 ; dred18
  1971. PSRLW XMM7, 8
  1972. ; dred18alpha = dred18 * negalpha
  1973. PMULLW XMM7, XMM4 ; dred18alpha
  1974. ; dest is prepared
  1975. ; combining dest and src
  1976. ; dred18big = sred18255 + dred18alpha
  1977. PADDUSW XMM7, XMM5 ; dred18big
  1978. ; dred18f = dred18big && destMaskred128 because >> 11 and << 11 is && mask
  1979. PAND XMM7, XMM6 ; dred18f
  1980. ; dest18nr0 = dest18 && (~destMaskred128)
  1981. PANDN XMM6, XMM3 ; dest18nr0
  1982. ; dest18nrf = dest18nr0 || dred18f
  1983. POR XMM6, XMM7
  1984. MOVDQU XMM3, XMM6
  1985. ; red is calculated
  1986. ; calculate green:
  1987. ; get source
  1988. ; sgreen14 = src14 && (srcMask <<8)
  1989. ; srcMask << 8
  1990. MOVQ2DQ XMM7, MMX3
  1991. PSHUFD XMM7, XMM7, 0
  1992. MOVDQU XMM5, XMM1
  1993. PSLLD XMM7, 8
  1994. PAND XMM5, XMM7 ; sgreen14
  1995. PSRLD XMM5, 8
  1996. ; sgreen14s = shuffled sgreen14
  1997. PSHUFHW XMM5, XMM5,85H
  1998. MOVDQU XMM6, XMM2
  1999. PSHUFLW XMM5, XMM5,85H
  2000. PAND XMM6, XMM7 ; sgreen58
  2001. PSRLD XMM6, 8
  2002. PSHUFD XMM5, XMM5,0D0H ; sgreen14s
  2003. ; sgreen58 = src58&& (srcMask << 8)
  2004. ; src58 must be copied because it mustn't be changed
  2005. ; sgreen58s = shuffled sgreen58
  2006. PSHUFHW XMM6, XMM6,85H
  2007. PSHUFLW XMM6, XMM6,58H
  2008. PSHUFD XMM6, XMM6,5CH ; sgreen58s
  2009. ; sgreen18 = sgreen14s || sgreen58s
  2010. POR XMM5, XMM6 ; sgreen18
  2011. ; sgreen18255 = sgreen18 * 256- sgreen18
  2012. MOVDQU XMM7, XMM5
  2013. MOVQ2DQ XMM6, MMX5
  2014. PSLLW XMM5, 8
  2015. PSUBUSW XMM5, XMM7 ; sgreen18255
  2016. PSHUFD XMM6, XMM6, 0
  2017. MOVDQU XMM7, XMM3
  2018. PAND XMM7, XMM6 ; dgreen18
  2019. PSRLW XMM7,3
  2020. ; dgreen18alpha = dgreen18 * negalpha
  2021. PMULLW XMM7, XMM4 ; dgreen18alpha
  2022. ; dest is prepared
  2023. ; combining dest and src
  2024. ; dgreen18big = sgreen18255 + dgreen18alpha
  2025. PADDUSW XMM7, XMM5 ; dgreen18big
  2026. PANDN XMM6, XMM3 ; dest18ng0
  2027. ; dgreen18f = (dgreen18big >> 11) <<5
  2028. PSRLW XMM7, 10 ; dgreen18f
  2029. PSLLW XMM7, 5
  2030. ; dest18ng0 = dest18 && (~destMaskgreen128)
  2031. ; dest18ngf = dest18ng0 || dred18f
  2032. POR XMM6, XMM7
  2033. MOVDQU XMM3, XMM6
  2034. ; green is calculated
  2035. ; calculate blue
  2036. ; get source
  2037. ; sblue14 = src14 && (srcMask)
  2038. ; srcMask
  2039. MOVQ2DQ XMM7, MMX3
  2040. MOVDQU XMM5, XMM1
  2041. PSHUFD XMM7, XMM7, 0
  2042. MOVDQU XMM6, XMM2
  2043. ; sblue14 = src14 && (srcMask)
  2044. ; src14 must be copied because it mustn't be changed
  2045. PAND XMM5, XMM7 ; sblue14
  2046. ; sblue14s = shuffled sblue14
  2047. PSHUFHW XMM5, XMM5,85H
  2048. PAND XMM6, XMM7 ; sblue58
  2049. PSHUFHW XMM6, XMM6,85H
  2050. PSHUFLW XMM5, XMM5,85H
  2051. PSHUFLW XMM6, XMM6,58H
  2052. PSHUFD XMM5, XMM5,0D0H ; sblue14s
  2053. PSHUFD XMM6, XMM6,5CH ; sblue58s
  2054. POR XMM5, XMM6 ; sblue18
  2055. ; sblue18255 = sblue18 * 256- sblue18
  2056. MOVDQU XMM7, XMM5
  2057. PSLLW XMM5, 8
  2058. PSUBUSW XMM5, XMM7 ; sblue18255
  2059. MOVQ2DQ XMM6, MMX6
  2060. PSHUFD XMM6, XMM6, 0
  2061. MOVDQU XMM7, XMM3
  2062. PAND XMM7, XMM6 ; dblue18
  2063. PSLLW XMM7, 3
  2064. PMULLW XMM7, XMM4 ; dblue18alpha
  2065. ; dest is prepared
  2066. ; combining dest and src
  2067. ; dblue18big = sblue18255 + dblue18alpha
  2068. PADDUSW XMM7, XMM5 ; dblue18big
  2069. ; dblue18f = (dblue18big >> 11)
  2070. PANDN XMM6, XMM3 ; dest18nr0
  2071. PSRLW XMM7, 11 ; dblue18f
  2072. ; dest18nr0 = dest18 && (~destMaskblue128)
  2073. ; dest18nbf = dest18nb0 || dblue18f
  2074. POR XMM6, XMM7
  2075. MOVDQU XMM3, XMM6
  2076. ; blue is calculated
  2077. ; now dest is calculated, store it
  2078. ; get 0 stuff
  2079. MOVDQU XMM5, [RDI]
  2080. PAND XMM5,XMM0
  2081. PANDN XMM0, XMM3
  2082. POR XMM0, XMM5
  2083. MOVDQU [RDI],XMM0
  2084. PREFETCHNTA [RDI + 16] ; prepare dest 9-15
  2085. endloop:
  2086. ADD RSI, 32 ; num of bytes
  2087. ADD RDI, 16
  2088. SUB ECX, 8
  2089. JMP WORD loop
  2090. singlepixel: ; original code from MMXBGRA8888Over565, adjusted to fit this procedure
  2091. MOV EAX, 0FFFFFFFFH
  2092. MOVD MMX7, EAX
  2093. PUNPCKLBW MMX7, MMX0 ; 00FF00FF00FF00FF
  2094. MOV EAX,[RSI]
  2095. XOR EBX, EBX
  2096. MOV BX, [RDI]
  2097. ; 255 - alpha
  2098. MOV EDX, EAX
  2099. SHR EDX, 24
  2100. CMP EDX, 0
  2101. JE WORD empty
  2102. CMP EDX, 255
  2103. JE full
  2104. alpha:
  2105. NEG EDX
  2106. ADD EDX, 255
  2107. MOVD MMX6, EDX
  2108. PUNPCKLWD MMX6, MMX6
  2109. PUNPCKLDQ MMX6, MMX6
  2110. MOVD MMX1, EAX
  2111. ; unpack dst
  2112. MOV EDX, EBX ; b
  2113. SHL EDX, 3
  2114. AND EDX, 0F8H
  2115. MOV EAX, EDX
  2116. MOV EDX, EBX ; g
  2117. SHL EDX, 5
  2118. AND EDX, 0FC00H
  2119. OR EAX, EDX
  2120. MOV EDX, EBX ; r
  2121. SHL EDX, 8
  2122. AND EDX, 0F80000H
  2123. OR EAX, EDX
  2124. MOVD MMX2, EAX
  2125. PUNPCKLBW MMX1, MMX0 ; 0000ARGB --> 0A0R0G0B
  2126. PMULLW MMX1, MMX7
  2127. PUNPCKLBW MMX2, MMX0 ; 0000ARGB --> 0A0R0G0B
  2128. PMULLW MMX2, MMX6
  2129. PADDUSW MMX1, MMX2
  2130. ; PSRLW MM1, 8 ; normalize
  2131. DB 0FH, 71H, 0D1H, 08H
  2132. PACKUSWB MMX1, MMX0
  2133. ; HUGA BIMBO Muell
  2134. MOVD EAX, MMX1
  2135. full:
  2136. MOV EBX, EAX
  2137. AND EBX, 0FFH
  2138. SHR EBX, 3
  2139. MOV EDX, EBX
  2140. MOV EBX, EAX
  2141. SHR EBX, 8
  2142. AND EBX, 0FFH
  2143. SHR EBX, 2
  2144. SHL EBX, 5
  2145. OR EDX, EBX
  2146. MOV EBX, EAX
  2147. SHR EBX, 16
  2148. AND EBX, 0FFH
  2149. SHR EBX, 3
  2150. SHL EBX, 11
  2151. OR EDX, EBX
  2152. MOV [RDI], DX
  2153. empty:
  2154. ADD RSI, 4;
  2155. ADD RDI, 2;
  2156. DEC ECX
  2157. JMP WORD loop
  2158. end:
  2159. EMMS ; declare FPU registers free
  2160. POP RBX
  2161. POPFQ
  2162. END SSE2BGRA8888Over565;
  2163. (** find (optimized) pixel transfer procedure for transfer mode and given source and destination formats **)
  2164. PROCEDURE Bind* (VAR mode: Mode; VAR src, dst: Format);
  2165. VAR op: LONGINT; val,i: LONGINT;
  2166. BEGIN
  2167. IF Same(src, mode.src) & Same(dst, mode.dst) THEN
  2168. ASSERT(mode.transfer # NIL, 120);
  2169. RETURN (* assume transfer procedure is still valid *)
  2170. END;
  2171. mode.src := src; mode.dst := dst; mode.buf := mode.col;
  2172. IF (src.pal # NIL) & ((mode.map = NIL) OR (LEN(mode.map^) # src.pal.used) ) THEN
  2173. NEW(mode.map, src.pal.used)
  2174. END;
  2175. (* try to convert complex composite operations into simpler ones *)
  2176. IF alpha IN src.components * dst.components THEN (* source and destination contain alpha information *)
  2177. op := mode.op
  2178. ELSIF alpha IN src.components THEN (* only source contains alpha *)
  2179. CASE mode.op OF
  2180. | dstOverSrc: op := dstCopy
  2181. | srcInDst: op := srcCopy
  2182. | srcWithoutDst: op := clear
  2183. | srcAtopDst: op := srcOverDst
  2184. | dstAtopSrc: op := dstInSrc
  2185. | srcXorDst: op := dstWithoutSrc
  2186. ELSE op := mode.op
  2187. END
  2188. ELSIF alpha IN dst.components THEN (* only destination contains alpha *)
  2189. CASE mode.op OF
  2190. | srcOverDst: op := srcCopy
  2191. | dstInSrc: op := dstCopy
  2192. | dstWithoutSrc: op := clear
  2193. | srcAtopDst: op := srcInDst
  2194. | dstAtopSrc: op := dstOverSrc
  2195. | srcXorDst: op := srcWithoutDst
  2196. ELSE op := mode.op
  2197. END
  2198. ELSE (* no alpha in either source or destination *)
  2199. CASE mode.op OF
  2200. | srcOverDst, srcInDst, srcAtopDst: op := srcCopy
  2201. | dstOverSrc, dstInSrc, dstAtopSrc: op := dstCopy
  2202. | srcWithoutDst, dstWithoutSrc, srcXorDst: op := clear
  2203. ELSE op := mode.op
  2204. END
  2205. END;
  2206. IF op = InvDst THEN
  2207. mode.transfer:=InvAny;
  2208. ELSIF op = InvOverDst THEN
  2209. mode.transfer:=InvOverAny;
  2210. ELSIF op = clear THEN
  2211. CASE dst.code OF
  2212. | a1: mode.transfer := Clear1
  2213. | a8, bgr555, bgr565, bgr466, bgr888, bgra8888: mode.transfer := ClearBytes
  2214. | p8:
  2215. mode.buf[0] := CHR(CLUTs.Match(dst.pal.clut, 0));
  2216. IF mode.buf[0] = 0X THEN mode.transfer := ClearBytes
  2217. ELSE mode.transfer := ConstCopy8
  2218. END
  2219. | d8:
  2220. mode.buf[0] := CHR(ColorToIndex(0));
  2221. IF mode.buf[0] = 0X THEN mode.transfer := ClearBytes
  2222. ELSE mode.transfer := ConstCopy8
  2223. END
  2224. | p16:
  2225. val:=CLUTs.Match(dst.pal.clut, 0);
  2226. IF dst.pal.used>256 THEN val:=val*dst.pal.used DIV 256 END;
  2227. SYSTEM.PUT16(ADDRESSOF(mode.buf[0]),SHORT(val)); (*PH090122*)
  2228. (*mode.buf[0] := CHR(PaletteIndex(dst.pal, 0, 0, 0));*)
  2229. IF val = 0 THEN mode.transfer := ClearBytes
  2230. ELSE mode.transfer := ConstCopy16
  2231. END
  2232. ELSE mode.transfer := ClearAny
  2233. END
  2234. ELSIF op = srcCopy THEN
  2235. CASE dst.code OF
  2236. | a1:
  2237. CASE src.code OF
  2238. | a1: mode.transfer := Copy1
  2239. | a8: mode.transfer := A8CopyA1
  2240. | bgra8888: mode.transfer := BGRA8888CopyA1
  2241. ELSE
  2242. IF alpha IN src.components THEN mode.transfer := AnyCopyA1
  2243. ELSE mode.transfer := Set1
  2244. END
  2245. END
  2246. | a8:
  2247. CASE src.code OF
  2248. | a1: mode.transfer := A1CopyA8
  2249. | a8: mode.transfer := Copy8
  2250. | bgra8888: mode.transfer := BGRA8888CopyA8
  2251. ELSE
  2252. IF alpha IN src.components THEN mode.transfer := AnyCopyA8
  2253. ELSE mode.buf[0] := 0FFX; mode.transfer := ConstCopy8
  2254. END
  2255. END
  2256. | p8:
  2257. CASE src.code OF
  2258. | a1, a8:
  2259. mode.buf[0] := CHR(CLUTs.Match(dst.pal.clut, ORD(mode.col[b]) + ASH(ORD(mode.col[g]), 8) +
  2260. ASH(ORD(mode.col[r]), 16)));
  2261. mode.transfer := ConstCopy8
  2262. | p8:
  2263. IF src.pal = dst.pal THEN mode.transfer := Copy8
  2264. ELSE
  2265. FOR i := 0 TO src.pal.used-1 DO
  2266. mode.map[i] := SHORT(CLUTs.Match(dst.pal.clut, ORD(src.pal.col[i, b]) + ASH(ORD(src.pal.col[i, g]), 8) +
  2267. ASH(ORD(src.pal.col[i, r]), 16)))
  2268. END;
  2269. mode.transfer := I8CopyI8
  2270. END
  2271. | d8:
  2272. FOR i := 0 TO 255 DO
  2273. mode.map[i] := SHORT(CLUTs.Match(dst.pal.clut, IndexToColor(i) MOD 1000000H))
  2274. END;
  2275. mode.transfer := I8CopyI8
  2276. | bgr555, bgr565, bgr466,p16: mode.transfer := Any16CopyP8
  2277. | bgr888: mode.transfer := BGR888CopyP8
  2278. | bgra8888: mode.transfer := BGRA8888CopyP8
  2279. ELSE mode.transfer := AnyCopyP8
  2280. END
  2281. | d8:
  2282. CASE src.code OF
  2283. | a1, a8:
  2284. mode.buf[0] := CHR(ColorToIndex(
  2285. ORD(mode.col[b]) + ASH(ORD(mode.col[g]), 8) + ASH(ORD(mode.col[r]), 16)));
  2286. mode.transfer := ConstCopy8
  2287. | p8:
  2288. FOR i := 0 TO src.pal.used-1 DO
  2289. mode.map[i] := SHORT(ColorToIndex(
  2290. ORD(src.pal.col[i, b]) + ASH(ORD(src.pal.col[i, g]), 8) + ASH(ORD(src.pal.col[i, r]), 16)))
  2291. END;
  2292. mode.transfer := I8CopyI8
  2293. | d8: mode.transfer := Copy8
  2294. | bgr555, bgr565, bgr466, p16: mode.transfer := Any16CopyD8
  2295. | bgr888: mode.transfer := BGR888CopyD8
  2296. | bgra8888: mode.transfer := BGRA8888CopyD8
  2297. ELSE mode.transfer := AnyCopyD8
  2298. END
  2299. | p16:
  2300. CASE src.code OF
  2301. | a1, a8: dst.pack(dst, ADDRESSOF(mode.buf[0]), 0, mode.col); mode.transfer := ConstCopy16
  2302. | p8: mode.transfer := P8CopyAny16
  2303. | d8: mode.transfer := D8CopyAny16
  2304. | p16:
  2305. IF src.pal = dst.pal THEN mode.transfer := Copy16
  2306. ELSE
  2307. FOR i := 0 TO src.pal.used-1 DO
  2308. val:=CLUTs.Match(dst.pal.clut, ORD(src.pal.col[i, b]) + ASH(ORD(src.pal.col[i, g]), 8) +
  2309. ASH(ORD(src.pal.col[i, r]), 16));
  2310. IF dst.pal.used>256 THEN val := val * dst.pal.used DIV 256 END;
  2311. mode.map[i] := SHORT(val)
  2312. END;
  2313. mode.transfer := I16CopyI16
  2314. END
  2315. | bgr555, bgr565, bgr466: mode.transfer := Any16CopyAny16
  2316. | bgr888: mode.transfer := BGR888CopyAny16
  2317. | bgra8888: mode.transfer := BGRA8888CopyAny16
  2318. ELSE mode.transfer := AnyCopyAny16
  2319. END;
  2320. | bgr555, bgr565, bgr466:
  2321. CASE src.code OF
  2322. | a1, a8: dst.pack(dst, ADDRESSOF(mode.buf[0]), 0, mode.col); mode.transfer := ConstCopy16
  2323. | p8: mode.transfer := P8CopyAny16
  2324. | d8: mode.transfer := D8CopyAny16
  2325. | bgr555, bgr565, bgr466,p16:
  2326. IF src.code = dst.code THEN mode.transfer := Copy16
  2327. ELSE mode.transfer := Any16CopyAny16
  2328. END
  2329. | bgr888: mode.transfer := BGR888CopyAny16
  2330. | bgra8888: mode.transfer := BGRA8888CopyAny16
  2331. ELSE mode.transfer := AnyCopyAny16
  2332. END;
  2333. | bgr888:
  2334. CASE src.code OF
  2335. | a1, a8: mode.buf := mode.col; mode.transfer := ConstCopy24
  2336. | p8: mode.transfer := P8CopyBGR888
  2337. | d8: mode.transfer := D8CopyBGR888
  2338. | p16: mode.transfer := P16CopyBGR888 (*PH090122*)
  2339. | bgr555, bgr565, bgr466: mode.transfer := Any16CopyBGR888
  2340. | bgr888: mode.transfer := Copy24
  2341. | bgra8888: IF SSE2enabled THEN mode.transfer := SSE2BGRA8888CopyBGR888
  2342. ELSE mode.transfer := BGRA8888CopyBGR888
  2343. END;
  2344. ELSE mode.transfer := AnyCopyBGR888
  2345. END
  2346. | bgra8888:
  2347. CASE src.code OF
  2348. | a1: mode.transfer := A1CopyBGRA8888
  2349. | a8: mode.transfer := A8CopyBGRA8888
  2350. | p8: mode.transfer := P8CopyBGRA8888
  2351. | d8: mode.transfer := D8CopyBGRA8888
  2352. | p16: mode.transfer := P16CopyBGRA8888 (*PH090122*)
  2353. | bgr555, bgr565, bgr466: mode.transfer := Any16CopyBGRA8888
  2354. | bgr888: IF SSE2enabled THEN mode.transfer := SSE2BGR888CopyBGRA8888
  2355. ELSE mode.transfer :=BGR888CopyBGRA8888;
  2356. END;
  2357. | bgra8888: mode.transfer := Copy32
  2358. ELSE mode.transfer := AnyCopyBGRA8888
  2359. END
  2360. ELSE
  2361. CASE src.code OF
  2362. | a1: mode.transfer := A1CopyAny
  2363. | p8: mode.transfer := P8CopyAny
  2364. | d8: mode.transfer := D8CopyAny
  2365. | bgr555, bgr565, bgr466,p16: mode.transfer := Any16CopyAny
  2366. | bgr888: mode.transfer := BGR888CopyAny
  2367. | bgra8888: mode.transfer := BGRA8888CopyAny
  2368. ELSE
  2369. IF (src.bpp MOD 8 = 0) & (dst.bpp MOD 8 = 0) THEN mode.transfer := AnyBytesCopyAnyBytes
  2370. ELSE mode.transfer := AnyCopyAny
  2371. END
  2372. END
  2373. END
  2374. ELSIF op = dstOverSrc THEN
  2375. mode.transfer := EmptyTransfer
  2376. ELSIF op = srcOverDst THEN
  2377. CASE dst.code OF
  2378. | a1:
  2379. CASE src.code OF
  2380. | a1: mode.transfer := A1OverA1
  2381. | a8: mode.transfer := A8OverA1
  2382. | bgra8888: mode.transfer := BGRA8888OverA1
  2383. ELSE mode.transfer := AnyOverA1
  2384. END
  2385. | a8:
  2386. CASE src.code OF
  2387. | a1: mode.buf[0] := 0FFX; mode.transfer := A1OverConst8
  2388. | a8: mode.transfer := A8OverA8
  2389. | bgra8888: mode.transfer := BGRA8888OverA8
  2390. ELSE mode.transfer := AnyOverA8
  2391. END
  2392. | bgra8888:
  2393. CASE src.code OF
  2394. | a1: mode.buf := mode.col; mode.transfer := A1OverConst32
  2395. | a8: mode.buf := mode.col; mode.transfer := A8OverAny
  2396. ELSE mode.transfer := BGRA8888OverAny
  2397. END
  2398. ELSE
  2399. CASE src.code OF
  2400. | a1:
  2401. CASE dst.code OF
  2402. | p8:
  2403. mode.buf[0] := CHR(CLUTs.Match(dst.pal.clut, ORD(mode.col[b]) + ASH(ORD(mode.col[g]), 8) +
  2404. ASH(ORD(mode.col[r]), 16)));
  2405. mode.transfer := A1OverConst8
  2406. | d8:
  2407. mode.buf[0] := CHR(ColorToIndex(ORD(mode.col[b]) + ASH(ORD(mode.col[g]), 8) +
  2408. ASH(ORD(mode.col[r]), 16)));
  2409. mode.transfer := A1OverConst8
  2410. | p16: (* this is probably not correct ... *)
  2411. mode.buf[0] := CHR(PaletteIndex(dst.pal, ORD(mode.col[r]), ORD(mode.col[g]), ORD(mode.col[b])));
  2412. mode.transfer := A1OverConst16
  2413. | bgr555, bgr565, bgr466: dst.pack(dst, ADDRESSOF(mode.buf[0]), 0, mode.col); mode.transfer := A1OverConst16
  2414. | bgr888: mode.buf := mode.col; mode.transfer := A1OverConst24
  2415. ELSE mode.transfer := A1OverAny
  2416. END
  2417. | a8: mode.buf := mode.col; mode.transfer := A8OverAny
  2418. | bgra8888:
  2419. CASE dst.code OF
  2420. | bgr555, bgr466, p16: mode.transfer := BGRA8888OverAny16
  2421. | bgr565 : IF MMXenabled THEN
  2422. mode.transfer := MMXBGRA8888Over565;
  2423. IF SSE2enabled THEN mode.transfer := SSE2BGRA8888Over565; END;
  2424. ELSE mode.transfer := BGRA8888Over565
  2425. END
  2426. ELSE mode.transfer := BGRA8888OverAny
  2427. END
  2428. ELSE
  2429. mode.transfer := AnyBlendAny
  2430. END
  2431. END
  2432. ELSE
  2433. mode.transfer := AnyBlendAny
  2434. END;
  2435. ASSERT(mode.transfer # NIL, 120)
  2436. END Bind;
  2437. (**--- Image Operations ---**)
  2438. (** get pixel from image **)
  2439. PROCEDURE Get* (img: Image; x, y: LONGINT; VAR pix: Pixel; VAR mode: Mode);
  2440. VAR bit: LONGINT; adr: ADDRESS;
  2441. BEGIN
  2442. ASSERT((0 <= x) & (x < img.width) & (0 <= y) & (y < img.height), 100);
  2443. bit := x * img.fmt.bpp; adr := img.adr + y * img.bpr + bit DIV 8; bit := bit MOD 8;
  2444. Bind(mode, img.fmt, PixelFormat);
  2445. (*mode.transfer(mode, adr, bit, ADDRESSOF(pix), 0, 1)*)
  2446. mode.transfer(mode, adr, bit, ADDRESSOF(pix[0]), 0, 1) (*PH090122*)
  2447. END Get;
  2448. (** put pixel into image **)
  2449. PROCEDURE Put* (img: Image; x, y: LONGINT; pix: Pixel; VAR mode: Mode);
  2450. VAR bit: LONGINT; adr: ADDRESS;
  2451. BEGIN
  2452. (*ASSERT((0 <= x) & (x < img.width) & (0 <= y) & (y < img.height), 100);*) (*avoid a HALT if roundoff errors from higher levels occur here*)
  2453. IF (0 > x) OR (x >= img.width) OR (0 > y) & (y >= img.height) THEN RETURN END;
  2454. bit := x * img.fmt.bpp; adr := img.adr + y * img.bpr + bit DIV 8; bit := bit MOD 8;
  2455. Bind(mode, PixelFormat, img.fmt);
  2456. mode.transfer(mode, ADDRESSOF(pix[0]), 0, adr, bit, 1)
  2457. END Put;
  2458. (** fill rectangular area **)
  2459. PROCEDURE Fill* (img: Image; llx, lly, urx, ury: LONGINT; pix: Pixel; VAR mode: Mode);
  2460. VAR bit, bb, x, c, t: LONGINT; m: Mode; adr, aa: ADDRESS;
  2461. PROCEDURE Fill16(destAdr: ADDRESS; size: SIZE; filler: LONGINT);
  2462. CODE {SYSTEM.AMD64}
  2463. MOV RDI, [RBP + destAdr]
  2464. MOV RCX, [RBP + size]
  2465. MOV EAX, [RBP + filler]
  2466. CLD
  2467. REP STOSW
  2468. END Fill16;
  2469. BEGIN
  2470. ASSERT((0 <= llx) & (llx < urx) & (urx <= img.width) & (0 <= lly) & (lly < ury) & (ury <= img.height), 100);
  2471. bit := llx * img.fmt.bpp; adr := img.adr + lly * img.bpr + bit DIV 8; bit := bit MOD 8;
  2472. IF (mode.op = srcCopy) & (img.fmt.code IN {bgr565}) THEN (* shortcut for speed in important cases *)
  2473. c := ASH(ORD(pix[b]), -3) + ASH(ASH(ORD(pix[g]), -2), 5) + ASH(ASH(ORD(pix[r]), -3), 11);
  2474. t := urx - llx;
  2475. WHILE lly < ury DO
  2476. Fill16(adr, t, c);
  2477. INC(lly); INC(adr, img.bpr)
  2478. END
  2479. ELSE
  2480. Bind(mode, PixelFormat, img.fmt);
  2481. IF (mode.op IN {clear, srcCopy}) OR (pix[a] = 0FFX) & (mode.op IN {srcOverDst, dstWithoutSrc}) THEN (* dst is replaced *)
  2482. (* copy one pixel to lower left corner of rect *)
  2483. mode.transfer(mode, ADDRESSOF(pix[0]), 0, adr, bit, 1);
  2484. (* copy pixel to rest of bottom row *)
  2485. InitMode(m, srcCopy); Bind(m, img.fmt, img.fmt);
  2486. IF (bit = 0) & (img.fmt.bpp MOD 8 = 0) THEN (* use simple address calculation *)
  2487. bb := img.fmt.bpp DIV 8; aa := adr + bb; x := llx+1;
  2488. WHILE x < urx DO
  2489. m.transfer(m, adr, 0, aa, 0, 1);
  2490. INC(aa, bb); INC(x)
  2491. END
  2492. ELSE
  2493. bb := bit + img.fmt.bpp; aa := adr + bb DIV 8; bb := bb MOD 8; x := llx+1;
  2494. WHILE x < urx DO
  2495. m.transfer(m, adr, bit, aa, bb, 1);
  2496. bb := bb + img.fmt.bpp; aa := aa + bb DIV 8; bb := bb MOD 8; INC(x)
  2497. END
  2498. END;
  2499. (* now copy bottom row to others *)
  2500. INC(lly); aa := adr + img.bpr;
  2501. WHILE lly < ury DO
  2502. m.transfer(m, adr, bit, aa, bit, urx - llx);
  2503. INC(lly); INC(aa, img.bpr)
  2504. END
  2505. ELSE (* fill pixel by pixel *)
  2506. WHILE lly < ury DO
  2507. x := llx; aa := adr; bb := bit;
  2508. WHILE x < urx DO
  2509. mode.transfer(mode, ADDRESSOF(pix[0]), 0, aa, bb, 1);
  2510. bb := bb + img.fmt.bpp; aa := aa + bb DIV 8; bb := bb MOD 8; INC(x)
  2511. END;
  2512. INC(lly); INC(adr, img.bpr)
  2513. END
  2514. END
  2515. END
  2516. END Fill;
  2517. (** clear image **)
  2518. PROCEDURE Clear* (img: Image);
  2519. VAR mode: Mode;
  2520. BEGIN
  2521. InitMode(mode, clear);
  2522. Bind(mode, PixelFormat, img.fmt);
  2523. Fill(img, 0, 0, img.width, img.height, Zero, mode)
  2524. END Clear;
  2525. (** get several pixels and store them in array in requested format **)
  2526. PROCEDURE GetPixels* (img: Image; x, y, w: LONGINT; VAR fmt: Format; VAR buf: ARRAY OF CHAR; ofs : LONGINT; VAR mode: Mode);
  2527. VAR sbit: LONGINT; sadr: ADDRESS;
  2528. BEGIN
  2529. ASSERT((0 <= x) & (x + w <= img.width) & (0 <= y) & (y <= img.height), 100);
  2530. ASSERT(ofs + w * fmt.bpp DIV 8 <= LEN(buf), 101);
  2531. Bind(mode, img.fmt, fmt);
  2532. sbit := x * img.fmt.bpp; sadr := img.adr + y * img.bpr + sbit DIV 8; sbit := sbit MOD 8;
  2533. mode.transfer(mode, sadr, sbit, ADDRESSOF(buf[ofs]), 0, w)
  2534. END GetPixels;
  2535. (** put several pixels from array in given format into image **)
  2536. PROCEDURE PutPixels* (img: Image; x, y, w: LONGINT; VAR fmt: Format; VAR buf: ARRAY OF CHAR; ofs : LONGINT; VAR mode: Mode);
  2537. VAR dbit: LONGINT; dadr: ADDRESS;
  2538. BEGIN
  2539. ASSERT((0 <= x) & (x + w <= img.width) & (0 <= y) & (y <= img.height), 100);
  2540. ASSERT(ofs + w * fmt.bpp DIV 8 <= LEN(buf), 101);
  2541. dbit := x * img.fmt.bpp; dadr := img.adr + y * img.bpr + dbit DIV 8; dbit := dbit MOD 8;
  2542. Bind(mode, fmt, img.fmt);
  2543. mode.transfer(mode, ADDRESSOF(buf[ofs]), 0, dadr, dbit, w)
  2544. END PutPixels;
  2545. (** copy rectangular area to the same or another image in specified mode **)
  2546. PROCEDURE Copy* (src, dst: Image; llx, lly, urx, ury, dx, dy: LONGINT; VAR mode: Mode);
  2547. VAR w, h, sbit, dbit, slen, sb, db, len, l: LONGINT; sadr, dadr, sa, da: ADDRESS;
  2548. BEGIN
  2549. ASSERT((0 <= llx) & (llx <= urx) & (urx <= src.width) & (0 <= lly) & (lly <= ury) & (ury <= src.height), 100);
  2550. ASSERT((0 <= dx) & (dx + urx - llx <= dst.width) & (0 <= dy) & (dy + ury - lly <= dst.height), 101);
  2551. Bind(mode, src.fmt, dst.fmt);
  2552. w := urx - llx; h := ury - lly;
  2553. IF (src # dst) OR (lly > dy) OR (lly = dy) & ((llx > dx) OR (urx <= dx)) THEN (* copy lines bottom-up *)
  2554. sbit := llx * src.fmt.bpp; sadr := src.adr + lly * src.bpr + sbit DIV 8; sbit := sbit MOD 8;
  2555. dbit := dx * dst.fmt.bpp; dadr := dst.adr + dy * dst.bpr + dbit DIV 8; dbit := dbit MOD 8;
  2556. WHILE h > 0 DO
  2557. mode.transfer(mode, sadr, sbit, dadr, dbit, w);
  2558. INC(sadr, src.bpr); INC(dadr, dst.bpr); DEC(h)
  2559. END
  2560. ELSIF lly < dy THEN (* copy lines top-down *)
  2561. sbit := llx * src.fmt.bpp; sadr := src.adr + ury * src.bpr + sbit DIV 8; sbit := sbit MOD 8;
  2562. dbit := dx * dst.fmt.bpp; dadr := dst.adr + (dy + h) * dst.bpr + dbit DIV 8; dbit := dbit MOD 8;
  2563. WHILE h > 0 DO
  2564. DEC(sadr, src.bpr); DEC(dadr, dst.bpr); DEC(h);
  2565. mode.transfer(mode, sadr, sbit, dadr, dbit, w)
  2566. END
  2567. ELSIF llx # dx THEN (* uh oh! overlapping spans *)
  2568. slen := dx + w - urx; (* maximal span length guaranteeing non-overlapping spans *)
  2569. sbit := urx * src.fmt.bpp; sadr := src.adr + lly * src.bpr + sbit DIV 8; sbit := sbit MOD 8;
  2570. dbit := (dx + w) * dst.fmt.bpp; dadr := dst.adr + dy * dst.bpr + dbit DIV 8; dbit := dbit MOD 8;
  2571. WHILE h > 0 DO
  2572. sa := sadr; sb := sbit; da := dadr; db := dbit; len := w;
  2573. WHILE len > 0 DO
  2574. l := slen;
  2575. IF l > len THEN l := len END;
  2576. DEC(sb, l * src.fmt.bpp); INC(sa, sb DIV 8); sb := sb MOD 8;
  2577. DEC(db, l * dst.fmt.bpp); INC(da, db DIV 8); db := db MOD 8;
  2578. mode.transfer(mode, sa, sb, da, db, l);
  2579. DEC(len, l)
  2580. END;
  2581. INC(sadr, src.bpr); INC(dadr, dst.bpr); DEC(h)
  2582. END
  2583. END
  2584. END Copy;
  2585. (** replicate pattern within rectangular area of image using given mode **)
  2586. PROCEDURE FillPattern* (pat, dst: Image; llx, lly, urx, ury, px, py: LONGINT; VAR mode: Mode);
  2587. VAR pw, ph, olx, oby, ilx, olw, irw, dy, sy, dx, sx, ty: LONGINT;
  2588. BEGIN
  2589. ASSERT((0 <= llx) & (llx <= urx) & (urx <= dst.width) & (0 <= lly) & (lly <= ury) & (ury <= dst.height), 100);
  2590. pw := pat.width; ph := pat.height;
  2591. olx := px + (llx - px) DIV pw * pw;
  2592. oby := py + (lly - py) DIV ph * ph;
  2593. ilx := olx + pw; olw := llx - olx;
  2594. irw := (urx - px) MOD pw;
  2595. IF urx - irw < ilx THEN irw := olw + urx - llx END;
  2596. dy := lly; sy := lly - oby;
  2597. IF (oby < lly) & (oby + ph <= ury) THEN
  2598. dx := llx; sx := olw;
  2599. IF (olx < llx) & (ilx <= urx) THEN
  2600. Copy(pat, dst, sx, sy, pw, ph, llx, lly, mode);
  2601. dx := ilx; sx := 0
  2602. END;
  2603. WHILE dx + pw <= urx DO
  2604. Copy(pat, dst, 0, sy, pw, ph, dx, lly, mode);
  2605. INC(dx, pw)
  2606. END;
  2607. IF dx < urx THEN
  2608. Copy(pat, dst, sx, sy, irw, ph, dx, lly, mode)
  2609. END;
  2610. dy := oby + ph; sy := 0
  2611. END;
  2612. WHILE dy + ph <= ury DO
  2613. dx := llx; sx := olw;
  2614. IF (olx < llx) & (ilx <= urx) THEN
  2615. Copy(pat, dst, sx, 0, pw, ph, llx, dy, mode);
  2616. dx := ilx; sx := 0
  2617. END;
  2618. WHILE dx + pw <= urx DO
  2619. Copy(pat, dst, 0, 0, pw, ph, dx, dy, mode);
  2620. INC(dx, pw)
  2621. END;
  2622. IF dx < urx THEN
  2623. Copy(pat, dst, sx, 0, irw, ph, dx, dy, mode)
  2624. END;
  2625. INC(dy, ph)
  2626. END;
  2627. IF dy < ury THEN
  2628. ty := sy + ury - dy;
  2629. dx := llx; sx := olw;
  2630. IF (olx < llx) & (ilx <= urx) THEN
  2631. Copy(pat, dst, sx, sy, pw, ty, llx, dy, mode);
  2632. dx := ilx; sx := 0
  2633. END;
  2634. WHILE dx + pw <= urx DO
  2635. Copy(pat, dst, 0, sy, pw, ty, dx, dy, mode);
  2636. INC(dx, pw)
  2637. END;
  2638. IF dx < urx THEN
  2639. Copy(pat, dst, sx, sy, irw, ty, dx, dy, mode)
  2640. END
  2641. END
  2642. END FillPattern;
  2643. (** darken image while maintaining coverage **)
  2644. PROCEDURE Darken* (img: Image; factor: REAL);
  2645. VAR s, i, j, k, y, x, bit: LONGINT; adr: ADDRESS; clamp: ARRAY 256 OF CHAR; pix: Pixel;
  2646. BEGIN
  2647. s := ABS(ENTIER(255*factor + 0.5));
  2648. IF (s # 255) & (img.fmt.components # {alpha}) THEN
  2649. i := 256; j := 256*s;
  2650. REPEAT
  2651. DEC(i); DEC(j, s); k := j DIV 255;
  2652. IF k <= 255 THEN clamp[i] := CHR(k) ELSE clamp[i] := 0FFX END
  2653. UNTIL i = 0;
  2654. y := 0;
  2655. WHILE y < img.height DO
  2656. x := 0; adr := img.adr + y * img.bpr; bit := 0;
  2657. WHILE x < img.width DO
  2658. img.fmt.unpack(img.fmt, adr, bit, pix);
  2659. pix[r] := clamp[ORD(pix[r])]; pix[g] := clamp[ORD(pix[g])]; pix[b] := clamp[ORD(pix[b])];
  2660. img.fmt.pack(img.fmt, adr, bit, pix);
  2661. bit := bit + img.fmt.bpp; INC(adr, bit); bit := bit MOD 8;
  2662. INC(x)
  2663. END;
  2664. INC(y)
  2665. END
  2666. END
  2667. END Darken;
  2668. (** fade image **)
  2669. PROCEDURE Fade* (img: Image; factor: REAL);
  2670. VAR s, i, j, k, y, x, bit: LONGINT; adr: ADDRESS; clamp: ARRAY 256 OF CHAR; pix: Pixel;
  2671. BEGIN
  2672. s := ABS(ENTIER(255*factor + 0.5));
  2673. IF s = 0 THEN
  2674. Clear(img)
  2675. ELSIF s # 255 THEN
  2676. i := 256; j := 256*s;
  2677. REPEAT
  2678. DEC(i); DEC(j, s); k := j DIV 255;
  2679. IF k <= 255 THEN clamp[i] := CHR(k) ELSE clamp[i] := 0FFX END
  2680. UNTIL i = 0;
  2681. y := 0;
  2682. WHILE y < img.height DO
  2683. x := 0; adr := img.adr + y * img.bpr; bit := 0;
  2684. WHILE x < img.width DO
  2685. img.fmt.unpack(img.fmt, adr, bit, pix);
  2686. pix[r] := clamp[ORD(pix[r])]; pix[g] := clamp[ORD(pix[g])];
  2687. pix[b] := clamp[ORD(pix[b])]; pix[a] := clamp[ORD(pix[a])];
  2688. img.fmt.pack(img.fmt, adr, bit, pix);
  2689. bit := bit + img.fmt.bpp; INC(adr, bit); bit := bit MOD 8;
  2690. INC(x)
  2691. END;
  2692. INC(y)
  2693. END
  2694. END
  2695. END Fade;
  2696. (** make image brighter and more transparent; Opaque(I, f) = Darken(Fade(I, f), 1/f) **)
  2697. PROCEDURE Opaque* (img: Image; factor: REAL);
  2698. VAR s, i, j, k, y, x, bit: LONGINT; adr: ADDRESS; clamp: ARRAY 256 OF CHAR; pix: Pixel;
  2699. BEGIN
  2700. s := ABS(ENTIER(255*factor + 0.5));
  2701. IF s = 0 THEN
  2702. Clear(img)
  2703. ELSIF s # 255 THEN
  2704. i := 256; j := 256*s;
  2705. REPEAT
  2706. DEC(i); DEC(j, s); k := j DIV 255;
  2707. IF k <= 255 THEN clamp[i] := CHR(k) ELSE clamp[i] := 0FFX END
  2708. UNTIL i = 0;
  2709. y := 0;
  2710. WHILE y < img.height DO
  2711. x := 0; adr := img.adr + y * img.bpr; bit := 0;
  2712. WHILE x < img.width DO
  2713. img.fmt.unpack(img.fmt, adr, bit, pix);
  2714. pix[a] := clamp[ORD(pix[a])];
  2715. img.fmt.pack(img.fmt, adr, bit, pix);
  2716. bit := bit + img.fmt.bpp; INC(adr, bit); bit := bit MOD 8;
  2717. INC(x)
  2718. END;
  2719. INC(y)
  2720. END
  2721. END
  2722. END Opaque;
  2723. (** add components of two (faded) images **)
  2724. PROCEDURE Add* (i, j, res: Image);
  2725. VAR y, x, ibit, jbit, rbit: LONGINT; iadr, jadr, radr: ADDRESS; ipix, jpix, rpix: Pixel;
  2726. BEGIN
  2727. ASSERT((i.width = j.width) & (i.height = j.height) & (i.width <= res.width) & (i.height <= res.height), 100);
  2728. y := 0;
  2729. WHILE y < i.height DO
  2730. x := 0; iadr := i.adr + y * i.bpr; ibit := 0; jadr := j.adr + y * j.bpr; jbit := 0; radr := res.adr + y * res.bpr; rbit := 0;
  2731. WHILE x < i.width DO
  2732. i.fmt.unpack(i.fmt, iadr, ibit, ipix); j.fmt.unpack(j.fmt, jadr, jbit, jpix);
  2733. rpix[0] := Clamp[ORD(ipix[0]) + ORD(jpix[0])];
  2734. rpix[1] := Clamp[ORD(ipix[1]) + ORD(jpix[1])];
  2735. rpix[2] := Clamp[ORD(ipix[2]) + ORD(jpix[2])];
  2736. rpix[3] := Clamp[ORD(ipix[3]) + ORD(jpix[3])];
  2737. res.fmt.pack(res.fmt, radr, rbit, rpix);
  2738. ibit := ibit + i.fmt.bpp; INC(iadr, ibit); ibit := ibit MOD 8;
  2739. jbit := jbit + j.fmt.bpp; INC(jadr, jbit); jbit := jbit MOD 8;
  2740. rbit := rbit + res.fmt.bpp; INC(radr, rbit); rbit := rbit MOD 8;
  2741. INC(x)
  2742. END;
  2743. INC(y)
  2744. END
  2745. END Add;
  2746. (** copy image to another using error diffusion dithering (Floyd-Steinberg) **)
  2747. PROCEDURE Dither* (src, dst: Image);
  2748. TYPE
  2749. error = RECORD r, g, b: LONGINT END;
  2750. VAR
  2751. e351: POINTER TO ARRAY OF error;
  2752. y, x, sb, db, ex, e, e3, e5: LONGINT;
  2753. sadr, dadr, sa, da: ADDRESS;
  2754. e7, e51, e1: error;
  2755. spix, dpix: Pixel;
  2756. BEGIN
  2757. ASSERT((src.width <= dst.width) & (src.height <= dst.height), 100);
  2758. NEW(e351, src.width+2); (* accumulated error for next row *)
  2759. y := 0; sadr := src.adr; dadr := dst.adr;
  2760. WHILE y < src.height DO (* scan from left to right *)
  2761. e7.r := 0; e7.g := 0; e7.b := 0;
  2762. e51.r := 0; e51.g := 0; e51.b := 0;
  2763. e1.r := 0; e1.g := 0; e1.b := 0;
  2764. x := 0; sa := sadr; sb := 0; da := dadr; db := 0;
  2765. WHILE x < src.width DO
  2766. ex := x+1;
  2767. src.fmt.unpack(src.fmt, sa, sb, spix);
  2768. spix[r] := Clamp[200H + ORD(spix[r]) + e351[ex].r + e7.r];
  2769. spix[g] := Clamp[200H + ORD(spix[g]) + e351[ex].g + e7.g];
  2770. spix[b] := Clamp[200H + ORD(spix[b]) + e351[ex].b + e7.b];
  2771. dst.fmt.pack(dst.fmt, da, db, spix);
  2772. dst.fmt.unpack(dst.fmt, da, db, dpix);
  2773. e := ORD(spix[r]) - ORD(dpix[r]); e3 := 3*e DIV 16; e5 := 5*e DIV 16;
  2774. e7.r := 7*e DIV 16; e351[x].r := e3 + e51.r; e51.r := e5 + e1.r; e1.r := e - e3 - e5 - e7.r;
  2775. e := ORD(spix[g]) - ORD(dpix[g]); e3 := 3*e DIV 16; e5 := 5*e DIV 16;
  2776. e7.g := 7*e DIV 16; e351[x].g := e3 + e51.g; e51.g := e5 + e1.g; e1.g := e - e3 - e5 - e7.g;
  2777. e := ORD(spix[b]) - ORD(dpix[b]); e3 := 3*e DIV 16; e5 := 5*e DIV 16;
  2778. e7.b := 7*e DIV 16; e351[x].b := e3 + e51.b; e51.b := e5 + e1.b; e1.b := e - e3 - e5 - e7.b;
  2779. sb := sb + src.fmt.bpp; INC(sa, sb DIV 8); sb := sb MOD 8;
  2780. db := db + dst.fmt.bpp; INC(da, db DIV 8); db := db MOD 8;
  2781. x := ex
  2782. END;
  2783. INC(y); INC(sadr, src.bpr); INC(dadr, dst.bpr);
  2784. IF y < src.height THEN (* scan from right to left *)
  2785. e351[x] := e51;
  2786. e7.r := 0; e7.g := 0; e7.b := 0;
  2787. e51.r := 0; e51.g := 0; e51.b := 0;
  2788. e1.r := 0; e1.g := 0; e1.b := 0;
  2789. INC(sa, src.bpr); INC(da, dst.bpr);
  2790. WHILE x > 0 DO
  2791. ex := x; DEC(x);
  2792. sb := sb - src.fmt.bpp; INC(sa, sb DIV 8); sb := sb MOD 8;
  2793. db := db - dst.fmt.bpp; INC(da, db DIV 8); db := db MOD 8;
  2794. src.fmt.unpack(src.fmt, sa, sb, spix);
  2795. spix[r] := Clamp[200H + ORD(spix[r]) + e351[ex].r + e7.r];
  2796. spix[g] := Clamp[200H + ORD(spix[g]) + e351[ex].g + e7.g];
  2797. spix[b] := Clamp[200H + ORD(spix[b]) + e351[ex].b + e7.b];
  2798. dst.fmt.pack(dst.fmt, da, db, spix);
  2799. dst.fmt.unpack(dst.fmt, da, db, dpix);
  2800. INC(ex);
  2801. e := ORD(spix[r]) - ORD(dpix[r]); e3 := 3*e DIV 16; e5 := 5*e DIV 16;
  2802. e7.r := 7*e DIV 16; e351[x].r := e3 + e51.r; e51.r := e5 + e1.r; e1.r := e - e3 - e5 - e7.r;
  2803. e := ORD(spix[g]) - ORD(dpix[g]); e3 := 3*e DIV 16; e5 := 5*e DIV 16;
  2804. e7.g := 7*e DIV 16; e351[x].g := e3 + e51.g; e51.g := e5 + e1.g; e1.g := e - e3 - e5 - e7.g;
  2805. e := ORD(spix[b]) - ORD(dpix[b]); e3 := 3*e DIV 16; e5 := 5*e DIV 16;
  2806. e7.b := 7*e DIV 16; e351[x].b := e3 + e51.b; e51.b := e5 + e1.b; e1.b := e - e3 - e5 - e7.b
  2807. END;
  2808. e351[1] := e51;
  2809. INC(y); INC(sadr, src.bpr); INC(dadr, dst.bpr)
  2810. END
  2811. END
  2812. END Dither;
  2813. (**--- File I/O ---**)
  2814. (** write image to file rider **)
  2815. PROCEDURE Write* (VAR fr: Streams.Writer; img: Image);
  2816. VAR m: Image; h, w, len: LONGINT; adr, aa: ADDRESS; buf: ARRAY 256 OF CHAR;
  2817. SrcCopy:Mode;
  2818. BEGIN
  2819. InitMode(SrcCopy, srcCopy);
  2820. IF ~(img.fmt.code IN {a1..bgra8888,p16}) THEN
  2821. NEW(m);
  2822. IF img.fmt.components = {color} THEN Create(m, img.width, img.height, BGR888)
  2823. ELSIF img.fmt.components = {alpha} THEN Create(m, img.width, img.height, A8)
  2824. ELSIF img.fmt.components = {index} THEN Create(m, img.width, img.height, D8)
  2825. ELSE Create(m, img.width, img.height, BGRA8888)
  2826. END;
  2827. Copy(img, m, 0, 0, img.width, img.height, 0, 0, SrcCopy);
  2828. img := m
  2829. END;
  2830. fr.RawNum(2); (* version *)
  2831. fr.RawNum(img.fmt.code);
  2832. fr.RawNum(img.width); fr.RawNum(img.height);
  2833. fr.RawNum(ABS(img.bpr));
  2834. h := img.height; adr := img.adr;
  2835. WHILE h > 0 DO
  2836. w := ABS(img.bpr); aa := adr;
  2837. WHILE w > 0 DO
  2838. len := 256;
  2839. IF len > w THEN len := w END;
  2840. SYSTEM.MOVE(aa, ADDRESSOF(buf[0]), len);
  2841. fr.Bytes(buf, 0, len);
  2842. DEC(w, len); INC(aa, len)
  2843. END;
  2844. DEC(h); INC(adr, img.bpr)
  2845. END;
  2846. IF img.fmt.code IN {p8,p16} THEN
  2847. fr.RawNum(img.fmt.pal.used);
  2848. len := 0;
  2849. WHILE len < img.fmt.pal.used DO
  2850. fr.Char(img.fmt.pal.col[len, r]);
  2851. fr.Char(img.fmt.pal.col[len, g]);
  2852. fr.Char(img.fmt.pal.col[len, b]);
  2853. INC(len)
  2854. END
  2855. END;
  2856. fr.Update (* optional *)
  2857. END Write;
  2858. (** read image from file rider **)
  2859. PROCEDURE Read* (VAR fr: Streams.Reader; img: Image);
  2860. VAR ver, code, w, h, bpr, len, bytesRead: LONGINT; adr, aa: ADDRESS; fmt: Format; buf: ARRAY 256 OF CHAR; used: LONGINT;
  2861. BEGIN
  2862. ASSERT(img#NIL,100);
  2863. fr.RawNum(ver); (* know version 1&2*)
  2864. ASSERT(ver IN {1,2},101);
  2865. fr.RawNum(code);
  2866. CASE code OF
  2867. | a1: fmt := A1
  2868. | a8: fmt := A8
  2869. | p8: InitFormat(fmt, p8, 8, 1, {index}, NIL, PackP8, UnpackP8)
  2870. | d8: fmt := D8
  2871. | p16: InitFormat(fmt, p16, 16, 2, {index}, NIL, PackP16, UnpackP16);
  2872. | bgr555: fmt := BGR555
  2873. | bgr565: fmt := BGR565
  2874. | bgr466: fmt := BGR466
  2875. | bgr888: fmt := BGR888
  2876. | bgra8888: fmt := BGRA8888
  2877. END;
  2878. fr.RawNum(w); fr.RawNum(h);
  2879. Create(img, SHORT(w), SHORT(h), fmt);
  2880. fr.RawNum(bpr);
  2881. ASSERT(bpr <= img.bpr);
  2882. adr := img.adr;
  2883. WHILE h > 0 DO
  2884. w := bpr; aa := adr;
  2885. WHILE w > 0 DO
  2886. len := 256;
  2887. IF len > w THEN len := w END;
  2888. fr.Bytes(buf, 0, len, bytesRead); (* ignore bytesRead *)
  2889. SYSTEM.MOVE(ADDRESSOF(buf[0]), aa, len);
  2890. DEC(w, len); INC(aa, len)
  2891. END;
  2892. DEC(h); INC(adr, img.bpr)
  2893. END;
  2894. IF code IN {p8,p16} THEN
  2895. fr.RawNum(used);
  2896. len := 0;
  2897. NEW(img.fmt.pal); img.fmt.pal.Init(used);
  2898. WHILE len < used DO
  2899. fr.Char(img.fmt.pal.col[len, r]);
  2900. fr.Char(img.fmt.pal.col[len, g]);
  2901. fr.Char(img.fmt.pal.col[len, b]);
  2902. img.fmt.pal.col[len, a] := 0FFX;
  2903. INC(len)
  2904. END;
  2905. InitPalette(img.fmt.pal, used, 4)
  2906. END
  2907. END Read;
  2908. (*--- Initialization ---*)
  2909. PROCEDURE InitBitTables;
  2910. VAR b, i: LONGINT;
  2911. BEGIN
  2912. FOR b := 0 TO 0FFH DO
  2913. FOR i := 0 TO 7 DO
  2914. IF ODD(ASH(b, -i)) THEN
  2915. Bit[b, i] := TRUE; Set[b, i] := CHR(b); Clr[b, i] := CHR(b - ASH(1, i))
  2916. ELSE
  2917. Bit[b, i] := FALSE; Set[b, i] := CHR(b + ASH(1, i)); Clr[b, i] := CHR(b)
  2918. END
  2919. END
  2920. END
  2921. END InitBitTables;
  2922. PROCEDURE InitClamp;
  2923. VAR i: LONGINT;
  2924. BEGIN
  2925. FOR i := 0 TO 1FFH DO Clamp[i] := 0X END;
  2926. FOR i := 0 TO 0FFH DO Clamp[200H+i] := CHR(i) END;
  2927. FOR i := 300H TO 4FFH DO Clamp[i] := 0FFX END
  2928. END InitClamp;
  2929. PROCEDURE ToggleMMX*;
  2930. BEGIN
  2931. MMXenabled := ~MMXenabled
  2932. END ToggleMMX;
  2933. PROCEDURE ToggleSSE2*;
  2934. BEGIN
  2935. SSE2enabled := ~SSE2enabled;
  2936. KernelLog.String("SSE2 toggled! Is now: "); KernelLog.Boolean(SSE2enabled);KernelLog.Ln;
  2937. END ToggleSSE2;
  2938. (** Map a color value to an 8-bit CLUT index. Only used if format = index8. *)
  2939. PROCEDURE ColorToIndex*(col: LONGINT): LONGINT;
  2940. BEGIN
  2941. (* default implementation is not very useful and should be overridden. *)
  2942. RETURN SYSTEM.VAL(LONGINT,
  2943. SYSTEM.VAL(SET, ASH(col, 7-23)) * {5..7} +
  2944. SYSTEM.VAL(SET, ASH(col, 4-15)) * {2..4} +
  2945. SYSTEM.VAL(SET, ASH(col, 1-7)) * {0..1})
  2946. END ColorToIndex;
  2947. (** Map an 8-bit CLUT index to a color value. Only used if format = index8. *)
  2948. PROCEDURE IndexToColor*(index: LONGINT): LONGINT;
  2949. BEGIN
  2950. (* default implementation is not very useful and should be overridden. *)
  2951. RETURN
  2952. ASH(SYSTEM.VAL(LONGINT, SYSTEM.VAL(SET, index) * {5..7}), 23-7) +
  2953. ASH(SYSTEM.VAL(LONGINT, SYSTEM.VAL(SET, index) * {2..4}), 15-4) +
  2954. ASH(SYSTEM.VAL(LONGINT, SYSTEM.VAL(SET, index) * {0..1}), 7-1)
  2955. END IndexToColor;
  2956. BEGIN
  2957. MMXenabled := 23 IN Machine.features;
  2958. SSE2enabled := Machine.SSE2Support;
  2959. (* plugin := Displays.registry.Await(""); (* assume only one system-wide D8 display driver *)
  2960. d8display := plugin(Displays.Display); *)
  2961. InitFormat(A1, a1, 1, 1, {alpha}, NIL, PackA1, UnpackA1);
  2962. InitFormat(A8, a8, 8, 1, {alpha}, NIL, PackA8, UnpackA8);
  2963. InitFormat(D8, d8, 8, 1, {index}, NIL, PackD8, UnpackD8);
  2964. InitFormat(BGR555, bgr555, 16, 2, {color}, NIL, PackBGR555, UnpackBGR555);
  2965. InitFormat(BGR565, bgr565, 16, 2, {color}, NIL, PackBGR565, UnpackBGR565);
  2966. InitFormat(BGR466, bgr466, 16, 2, {color}, NIL, PackBGR466, UnpackBGR466);
  2967. InitFormat(BGR888, bgr888, 24, 4, {color}, NIL, PackBGR888, UnpackBGR888);
  2968. InitFormat(BGRA8888, bgra8888, 32, 4, {color, alpha}, NIL, PackBGRA8888, UnpackBGRA8888);
  2969. PixelFormat := BGRA8888;
  2970. Zero[0] := 0X; Zero[1] := 0X; Zero[2] := 0X; Zero[3] := 0X;
  2971. InitBitTables; InitClamp
  2972. END Raster.
  2973. (**
  2974. Remarks
  2975. 1. Images
  2976. While many applications wish to handle images of any kind without having to care about details, other applications need low-level access to image interna for maximum effiency. With this in mind, the Images module provides an abstract procedural interface but also discloses low-level information to those clients needing it:
  2977. * an image references a contiguous block of memory holding pixel data
  2978. * the point of reference is the address of the pixel in the lower-left corner
  2979. * pixels are organized in rows (either bottom-up or top-down)
  2980. * rows can be aligned to an arbitrary number of bytes
  2981. * the leftmost pixel in a row has the lowest address of all pixels in that row
  2982. * every pixel uses the same number of bits
  2983. Memory for images can be automatically allocated by using Create(). Alternatively, an image can be initialized on an existing memory block (Init(), InitBuf()) or even on part of an other image (InitRect()).
  2984. 2. Pixels
  2985. A general pixel pix[] contains four components (in range 0X..255X), specifying red, green, blue, and alpha value of the pixel and accessable as pix[r], pix[g], pix[b] and pix[a]. Note that in order to speed up compositing operations, the alpha value is premultiplied into the color components. Example: a red pixel with 50% coverage can be initialized with SetRGBA(pix, 255, 0, 0, 127), after which pix[r]=pix[a]=7FX and pix[g]=pix[b]=0X. Use GetRGBA() to recover the original color and alpha values.
  2986. 3. Palettes
  2987. Many bitmap images and Oberon display drivers use some kind of indexed format to store colors, i.e. the value stored in the bitmap serves as an index into an array of colors. A Palette stores up to 256 colors as an array of pixels, making the mapping of an index to the corresponding color straightforward. To speed up the inverse mapping from an RGB triple to an index with PaletteIndex(), additional data is initialized when InitPalette() is called. Use ComputePalette() to compute a palette that best approximates the colors in a given image (e.g. before quantizing it to indexed format).
  2988. 4. Formats
  2989. While general pixels accurately describe color and alpha information, they use a lot of memory (32 bits). Most images therefore only store part of that information. A Format record describes how pixels are represented within an image. It contains
  2990. * the number of bits used per pixel (must be 1, 2, 4, 8, 16, 24 or 32)
  2991. * the set of components stored in a pixel (color, index and/or alpha)
  2992. * a palette if the format uses one
  2993. * procedures for storing (packing) and loading (unpacking) a general pixel
  2994. The pack and unpack procedures are given an address and a bit number specifying where the pixel is located in memory, with bit numbers ascending from left to right (although a format is free to choose any bit ordering within a pixel).
  2995. 5. Predefined Formats
  2996. The following global variables contain formats which are special and have a unique code number identifying them. Besides, most operations have better performance if acting on images using them.
  2997. * A1 (code a1): one bit alpha, MSB leftmost (corresponds to Oberon display patterns)
  2998. * A8 (code a8): 8 bit alpha (mainly for anti-aliased character patterns)
  2999. * - (code p8): 8 bit indexed with custom palette (Oberon pictures, use InitPaletteFormat to initialize)
  3000. * D8 (code d8): 8 bit indexed with display palette (no palette structure attached)
  3001. * - (code p16): 16 bit indexed with 16bit Palette. This type is, e.g., often used in medical imaging (DICOM-3 standard) (*PH 2004*)
  3002. * BGR555 (code bgr555), BGR565 (code bgr565), BGR466 (code bgr466): 16 bit hi-color
  3003. * BGR888 (code bgr888): 24 bit true-color
  3004. * BGRA8888 (code bgra8888), PixelFormat: 32 bit true-color with alpha channel (general pixel format)
  3005. Procedure DisplayFormat() returns the format that best matches the supplied kind of display transfer format. The returned image format is preferably used for allocating shadow bitmaps.
  3006. 6. Compositing
  3007. Most operations require a transfer mode for specifying how source and destination pixels should be combined when alpha information is present. The following compositing operations are supported:
  3008. * clear: destination becomes black and completely transparent
  3009. * srcCopy: source completely replaces destination (cf. Display.replace)
  3010. * dstCopy: no effect
  3011. * srcOverDst: source replaces destination where source is opaque (cf. Display.paint)
  3012. * dstOverSrc: destination replaces source where destination is opaque
  3013. * srcInDst: source where destination is opaque
  3014. * dstInSrc: destination where source is opaque
  3015. * srcWithoutDest*: source is cleared where destination is opaque
  3016. * dstWithoutSrc*: destination is cleared where source is opaque
  3017. * srcAtopDst*: source replaces destination where destination is opaque
  3018. * dstAtopSrc*: destination replaces source where source is opaque
  3019. * srcXorDst*: destination is cleared where both source and destination are opaque (cf. Display.invert)
  3020. A transfer mode is initialized with a compositing operation and optionally with a color. (The color is used when the source is a pure alpha format which doesn't contain any color of its own.) An initialized mode can be bound to a source and destination format by calling Bind(), by which the mode's transfer procedure is set appropriately. A transfer procedure unpacks pixels from source and destination, blends them according to the compositing operation, and packs the resulting pixel in the destination. Bind() chooses an optimal transfer procedure for the given combination of compositing operation, source format, and destination format.
  3021. 7. Internalization and Externalization
  3022. Images can be loaded from file and stored to file using one of many popular image file formats. The Load() and Store() procedures rely on a section 'ImageFormats' in the Aos registry. This section contains a list of file types that are associated with command procedures. When one of these commands is called, it should initialize the global 'LoadProc' and 'StoreProc' variables. These, when called, should read an image from or write an image to the file and set 'done' to TRUE if successful.
  3023. **)