AMD64.Raster.Mod 106 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431243224332434243524362437243824392440244124422443244424452446244724482449245024512452245324542455245624572458245924602461246224632464246524662467246824692470247124722473247424752476247724782479248024812482248324842485248624872488248924902491249224932494249524962497249824992500250125022503250425052506250725082509251025112512251325142515251625172518251925202521252225232524252525262527252825292530253125322533253425352536253725382539254025412542254325442545254625472548254925502551255225532554255525562557255825592560256125622563256425652566256725682569257025712572257325742575257625772578257925802581258225832584258525862587258825892590259125922593259425952596259725982599260026012602260326042605260626072608260926102611261226132614261526162617261826192620262126222623262426252626262726282629263026312632263326342635263626372638263926402641264226432644264526462647264826492650265126522653265426552656265726582659266026612662266326642665266626672668266926702671267226732674267526762677267826792680268126822683268426852686268726882689269026912692269326942695269626972698269927002701270227032704270527062707270827092710271127122713271427152716271727182719272027212722272327242725272627272728272927302731273227332734273527362737273827392740274127422743274427452746274727482749275027512752275327542755275627572758275927602761276227632764276527662767276827692770277127722773277427752776277727782779278027812782278327842785278627872788278927902791279227932794279527962797279827992800280128022803280428052806280728082809281028112812281328142815281628172818281928202821282228232824282528262827282828292830283128322833283428352836283728382839284028412842284328442845284628472848284928502851285228532854285528562857285828592860286128622863286428652866286728682869287028712872287328742875287628772878287928802881288228832884288528862887288828892890289128922893289428952896289728982899290029012902290329042905290629072908290929102911291229132914291529162917291829192920292129222923292429252926292729282929293029312932293329342935293629372938293929402941294229432944294529462947294829492950295129522953295429552956295729582959296029612962296329642965296629672968296929702971297229732974297529762977297829792980298129822983298429852986298729882989299029912992299329942995299629972998299930003001300230033004300530063007300830093010301130123013301430153016301730183019302030213022302330243025302630273028302930303031303230333034303530363037303830393040304130423043304430453046304730483049305030513052305330543055305630573058305930603061306230633064306530663067306830693070307130723073307430753076307730783079308030813082308330843085308630873088308930903091309230933094309530963097309830993100310131023103310431053106310731083109311031113112311331143115311631173118311931203121312231233124312531263127312831293130313131323133313431353136313731383139314031413142314331443145314631473148314931503151315231533154315531563157315831593160316131623163316431653166316731683169317031713172317331743175317631773178317931803181318231833184318531863187318831893190319131923193319431953196319731983199320032013202320332043205320632073208320932103211321232133214321532163217321832193220322132223223322432253226322732283229323032313232323332343235323632373238323932403241324232433244324532463247324832493250325132523253325432553256325732583259326032613262326332643265326632673268326932703271327232733274327532763277327832793280328132823283328432853286328732883289329032913292329332943295329632973298329933003301330233033304330533063307330833093310331133123313331433153316331733183319332033213322332333243325332633273328332933303331333233333334333533363337333833393340334133423343334433453346334733483349335033513352335333543355335633573358335933603361336233633364336533663367336833693370337133723373337433753376337733783379338033813382338333843385338633873388338933903391339233933394339533963397339833993400340134023403340434053406340734083409341034113412341334143415
  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, i: 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. FOR i := 0 TO 3 DO dst[i] := 0X END
  591. ELSIF fs = 0 THEN
  592. IF fd # 255 THEN
  593. FOR i := 0 TO 3 DO
  594. dst[i] := Clamp[200H + fd * ORD(dst[i]) DIV 255]
  595. END
  596. END
  597. ELSIF fd = 0 THEN
  598. IF fs = 255 THEN
  599. dst := src
  600. ELSE
  601. FOR i := 0 TO 3 DO
  602. dst[i] := Clamp[200H + fs * ORD(src[i]) DIV 255]
  603. END
  604. END
  605. ELSE
  606. dst[0] := Clamp[200H + (fs * ORD(src[0]) + fd * ORD(dst[0])) DIV 255];
  607. dst[1] := Clamp[200H + (fs * ORD(src[1]) + fd * ORD(dst[1])) DIV 255];
  608. dst[2] := Clamp[200H + (fs * ORD(src[2]) + fd * ORD(dst[2])) DIV 255];
  609. dst[3] := Clamp[200H + (fs * ORD(src[3]) + fd * ORD(dst[3])) DIV 255]
  610. END
  611. END Blend;
  612. (*--- General Transfer ---*)
  613. PROCEDURE AnyBlendAny (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  614. VAR spix, dpix: Pixel;
  615. BEGIN
  616. WHILE len > 0 DO
  617. mode.src.unpack(mode.src, sadr, sbit, spix);
  618. mode.dst.unpack(mode.dst, dadr, dbit, dpix);
  619. Blend(mode.op, spix, dpix);
  620. mode.dst.pack(mode.dst, dadr, dbit, dpix);
  621. sbit := sbit + mode.src.bpp; INC(sadr, sbit DIV 8); sbit := sbit MOD 8;
  622. dbit := dbit + mode.dst.bpp; INC(dadr, dbit DIV 8); dbit := dbit MOD 8;
  623. DEC(len)
  624. END
  625. END AnyBlendAny;
  626. (* --- invert --- *)
  627. PROCEDURE InvAny (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  628. BEGIN
  629. WHILE len > 0 DO
  630. mode.dst.unpack(mode.dst, dadr, dbit, mode.buf);
  631. mode.buf[r]:=CHR(255-ORD(mode.buf[r]));
  632. mode.buf[g]:=CHR(255-ORD(mode.buf[g]));
  633. mode.buf[b]:=CHR(255-ORD(mode.buf[b]));
  634. mode.dst.pack(mode.dst, dadr, dbit, mode.buf);
  635. sbit := sbit + mode.src.bpp; INC(sadr, sbit DIV 8); sbit := sbit MOD 8;
  636. dbit := dbit + mode.dst.bpp; INC(dadr, dbit DIV 8); dbit := dbit MOD 8;
  637. DEC(len)
  638. END
  639. END InvAny;
  640. (* --- alpha invert --- *)
  641. PROCEDURE InvOverAny (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  642. VAR pix:Pixel;
  643. BEGIN
  644. WHILE len > 0 DO
  645. mode.src.unpack(mode.src, sadr, sbit, pix);
  646. IF pix[a]>=80X THEN
  647. mode.dst.unpack(mode.dst, dadr, dbit, mode.buf);
  648. mode.buf[r]:=CHR(255-ORD(mode.buf[r]));
  649. mode.buf[g]:=CHR(255-ORD(mode.buf[g]));
  650. mode.buf[b]:=CHR(255-ORD(mode.buf[b]));
  651. mode.dst.pack(mode.dst, dadr, dbit, mode.buf)
  652. END;
  653. sbit := sbit + mode.src.bpp; INC(sadr, sbit DIV 8); sbit := sbit MOD 8;
  654. dbit := dbit + mode.dst.bpp; INC(dadr, dbit DIV 8); dbit := dbit MOD 8;
  655. DEC(len)
  656. END
  657. END InvOverAny;
  658. (*--- clear ---*)
  659. PROCEDURE ClearAny (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  660. VAR inc: LONGINT;
  661. BEGIN
  662. IF mode.dst.bpp MOD 8 = 0 THEN
  663. inc := mode.dst.bpp DIV 8;
  664. WHILE len > 0 DO
  665. mode.dst.pack(mode.dst, dadr, 0, Zero);
  666. INC(dadr, inc); DEC(len)
  667. END
  668. ELSE
  669. WHILE len > 0 DO
  670. mode.dst.pack(mode.dst, dadr, dbit, Zero);
  671. dbit := dbit + mode.dst.bpp; INC(dadr, dbit DIV 8); dbit := dbit MOD 8;
  672. DEC(len)
  673. END
  674. END
  675. END ClearAny;
  676. PROCEDURE Clear1 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  677. VAR out: CHAR;
  678. BEGIN
  679. IF (dbit > 0) OR (len < 8) THEN
  680. SYSTEM.GET(dadr, out);
  681. WHILE (dbit < 8) & (len > 0) DO
  682. out := Clr[ORD(out), dbit];
  683. INC(dbit); DEC(len)
  684. END;
  685. SYSTEM.PUT(dadr, out)
  686. END;
  687. WHILE len >= 32 DO
  688. SYSTEM.PUT(dadr, LONG(LONG(0))); INC(dadr, 4); DEC(len, 32)
  689. END;
  690. WHILE len >= 8 DO
  691. SYSTEM.PUT(dadr, 0X); INC(dadr); DEC(len, 8)
  692. END;
  693. IF len > 0 THEN
  694. SYSTEM.GET(dadr, out); dbit := 0;
  695. REPEAT
  696. out := Clr[ORD(out), dbit];
  697. INC(dbit); DEC(len)
  698. UNTIL len = 0;
  699. SYSTEM.PUT(dadr, out)
  700. END
  701. END Clear1;
  702. PROCEDURE ClearBytes (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  703. BEGIN
  704. len := len * mode.dst.bpp DIV 8;
  705. WHILE len >= 4 DO
  706. SYSTEM.PUT(dadr, LONG(LONG(0))); INC(dadr, 4); DEC(len)
  707. END;
  708. WHILE len > 0 DO
  709. SYSTEM.PUT(dadr, 0X); INC(dadr); DEC(len)
  710. END
  711. END ClearBytes;
  712. (*--- srcCopy Transfer ---*)
  713. (* constant values *)
  714. PROCEDURE Set1 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  715. VAR out: CHAR;
  716. BEGIN
  717. IF (dbit > 0) OR (len < 8) THEN
  718. SYSTEM.GET(dadr, out);
  719. WHILE (dbit < 8) & (len > 0) DO
  720. out := Set[ORD(out), dbit];
  721. INC(dbit); DEC(len)
  722. END;
  723. SYSTEM.PUT(dadr, out)
  724. END;
  725. WHILE len >= 8 DO
  726. SYSTEM.PUT(dadr, 0FFX);
  727. INC(dadr); DEC(len, 8)
  728. END;
  729. IF len > 0 THEN
  730. SYSTEM.GET(dadr, out); dbit := 0;
  731. REPEAT
  732. out := Set[ORD(out), dbit];
  733. INC(dbit); DEC(len)
  734. UNTIL len = 0;
  735. SYSTEM.PUT(dadr, out)
  736. END
  737. END Set1;
  738. PROCEDURE ConstCopy8 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  739. BEGIN
  740. WHILE len > 0 DO
  741. SYSTEM.PUT(dadr, mode.buf[0]); INC(dadr); DEC(len)
  742. END
  743. END ConstCopy8;
  744. PROCEDURE ConstCopy16 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  745. BEGIN
  746. WHILE len > 0 DO
  747. SYSTEM.MOVE(ADDRESSOF(mode.buf[0]), dadr, 2); INC(dadr, 2); DEC(len)
  748. END
  749. END ConstCopy16;
  750. PROCEDURE ConstCopy24 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  751. BEGIN
  752. WHILE len > 0 DO
  753. SYSTEM.MOVE(ADDRESSOF(mode.buf[0]), dadr, 3); INC(dadr, 3); DEC(len)
  754. END
  755. END ConstCopy24;
  756. (* identical formats *)
  757. PROCEDURE Copy1 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  758. VAR in, out: CHAR;
  759. BEGIN
  760. SYSTEM.GET(sadr, in);
  761. WHILE (sbit = 0) & (dbit = 0) & (len >= 8) DO
  762. SYSTEM.PUT(dadr, in);
  763. INC(sadr); INC(dadr); DEC(len, 8);
  764. SYSTEM.GET(sadr, in)
  765. END;
  766. IF (dbit > 0) OR (len < 8) THEN
  767. SYSTEM.GET(dadr, out)
  768. END;
  769. WHILE len > 0 DO
  770. IF Bit[ORD(in), sbit] THEN out := Set[ORD(out), dbit]
  771. ELSE out := Clr[ORD(out), dbit]
  772. END;
  773. INC(sbit); INC(dbit); DEC(len);
  774. IF sbit = 8 THEN
  775. INC(sadr); sbit := 0;
  776. SYSTEM.GET(sadr, in)
  777. END;
  778. IF dbit = 8 THEN
  779. SYSTEM.PUT(dadr, out);
  780. INC(dadr); dbit := 0;
  781. IF len < 8 THEN
  782. SYSTEM.GET(dadr, out)
  783. END
  784. END
  785. END;
  786. IF dbit > 0 THEN
  787. SYSTEM.PUT(dadr, out)
  788. END
  789. END Copy1;
  790. PROCEDURE Copy8 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  791. BEGIN
  792. SYSTEM.MOVE(sadr, dadr, len)
  793. END Copy8;
  794. PROCEDURE I8CopyI8 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  795. VAR byte: CHAR;
  796. BEGIN
  797. WHILE len > 0 DO
  798. SYSTEM.GET(sadr, byte); SYSTEM.PUT(dadr, mode.map[ORD(byte)]);
  799. INC(sadr); INC(dadr); DEC(len)
  800. END
  801. END I8CopyI8;
  802. PROCEDURE Copy16 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  803. BEGIN
  804. SYSTEM.MOVE(sadr, dadr, 2*len)
  805. END Copy16;
  806. PROCEDURE I16CopyI16 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  807. VAR val: INTEGER;
  808. BEGIN
  809. WHILE len > 0 DO
  810. val:=SYSTEM.GET16(sadr); SYSTEM.PUT16(dadr, mode.map[val MOD 10000H]);
  811. INC(sadr); INC(dadr); DEC(len)
  812. END
  813. END I16CopyI16;
  814. PROCEDURE Copy24 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  815. BEGIN
  816. SYSTEM.MOVE(sadr, dadr, 3*len)
  817. END Copy24;
  818. PROCEDURE Copy32 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  819. BEGIN
  820. SYSTEM.MOVE(sadr, dadr, 4*len)
  821. END Copy32;
  822. (* general methods *)
  823. PROCEDURE AnyCopyAny (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  824. VAR pix: Pixel;
  825. BEGIN
  826. WHILE len > 0 DO
  827. pix := mode.buf;
  828. mode.src.unpack(mode.src, sadr, sbit, mode.buf);
  829. mode.dst.pack(mode.dst, dadr, dbit, mode.buf);
  830. sbit := sbit + mode.src.bpp; INC(sadr, sbit DIV 8); sbit := sbit MOD 8;
  831. dbit := dbit + mode.dst.bpp; INC(dadr, dbit DIV 8); dbit := dbit MOD 8;
  832. DEC(len)
  833. END
  834. END AnyCopyAny;
  835. PROCEDURE AnyBytesCopyAnyBytes (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  836. VAR sinc, dinc: LONGINT; pix: Pixel;
  837. BEGIN
  838. sinc := mode.src.bpp DIV 8; dinc := mode.dst.bpp DIV 8;
  839. WHILE len > 0 DO
  840. pix := mode.buf;
  841. mode.src.unpack(mode.src, sadr, sbit, mode.buf);
  842. mode.dst.pack(mode.dst, dadr, dbit, mode.buf);
  843. INC(sadr, sinc); INC(dadr, dinc); DEC(len)
  844. END
  845. END AnyBytesCopyAnyBytes;
  846. (* A1 *)
  847. PROCEDURE AnyCopyA1 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  848. VAR out: CHAR; pix: Pixel;
  849. BEGIN
  850. SYSTEM.GET(dadr, out); pix[a] := 0FFX;
  851. WHILE len > 0 DO
  852. mode.src.unpack(mode.src, sadr, sbit, pix);
  853. sbit := sbit + mode.src.bpp; INC(sadr, sbit MOD 8); sbit := sbit MOD 8;
  854. IF pix[a] >= 80X THEN out := Set[ORD(out), dbit]
  855. ELSE out := Clr[ORD(out), dbit]
  856. END;
  857. INC(dbit); DEC(len);
  858. IF dbit = 8 THEN
  859. SYSTEM.PUT(dadr, out); INC(dadr); SYSTEM.GET(dadr, out); dbit := 0
  860. END
  861. END;
  862. SYSTEM.PUT(dadr, out)
  863. END AnyCopyA1;
  864. PROCEDURE A8CopyA1 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  865. VAR out, in: CHAR;
  866. BEGIN
  867. IF (dbit > 0) OR (len < 8) THEN
  868. SYSTEM.GET(dadr, out)
  869. END;
  870. WHILE len > 0 DO
  871. SYSTEM.GET(sadr, in);
  872. IF in >= 80X THEN out := Set[ORD(out), dbit]
  873. ELSE out := Clr[ORD(out), dbit]
  874. END;
  875. INC(sadr); INC(dbit); DEC(len);
  876. IF dbit = 8 THEN
  877. SYSTEM.PUT(dadr, out);
  878. INC(dadr); dbit := 0;
  879. IF len < 8 THEN
  880. SYSTEM.GET(dadr, out)
  881. END
  882. END
  883. END;
  884. IF dbit > 0 THEN
  885. SYSTEM.PUT(dadr, out)
  886. END
  887. END A8CopyA1;
  888. PROCEDURE BGRA8888CopyA1 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  889. VAR out, in: CHAR;
  890. BEGIN
  891. INC(sadr, a); (* only look at alpha component *)
  892. IF (dbit > 0) OR (len < 8) THEN
  893. SYSTEM.GET(dadr, out)
  894. END;
  895. WHILE len > 0 DO
  896. SYSTEM.GET(sadr, in);
  897. IF in >= 80X THEN out := Set[ORD(out), dbit]
  898. ELSE out := Clr[ORD(out), dbit]
  899. END;
  900. INC(sadr, 4); INC(dbit); DEC(len);
  901. IF dbit = 8 THEN
  902. SYSTEM.PUT(dadr, out);
  903. INC(dadr); dbit := 0;
  904. IF len < 8 THEN
  905. SYSTEM.GET(dadr, out)
  906. END
  907. END
  908. END;
  909. IF dbit > 0 THEN
  910. SYSTEM.PUT(dadr, out)
  911. END
  912. END BGRA8888CopyA1;
  913. PROCEDURE A1CopyAny (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  914. VAR in: CHAR;
  915. BEGIN
  916. SYSTEM.GET(sadr, in);
  917. WHILE len > 0 DO
  918. IF Bit[ORD(in), sbit] THEN mode.dst.pack(mode.dst, dadr, dbit, mode.buf)
  919. ELSE mode.dst.pack(mode.dst, dadr, dbit, Zero)
  920. END;
  921. INC(sbit); dbit := dbit + mode.dst.bpp; INC(dadr, dbit DIV 8); dbit := dbit MOD 8; DEC(len);
  922. IF sbit = 8 THEN
  923. INC(sadr); sbit := 0;
  924. SYSTEM.GET(sadr, in)
  925. END
  926. END
  927. END A1CopyAny;
  928. PROCEDURE A1CopyA8 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  929. VAR in: CHAR;
  930. BEGIN
  931. SYSTEM.GET(sadr, in);
  932. WHILE len > 0 DO
  933. IF Bit[ORD(in), sbit] THEN SYSTEM.PUT(dadr, 0FFX)
  934. ELSE SYSTEM.PUT(dadr, 0X)
  935. END;
  936. INC(sbit); INC(dadr); DEC(len);
  937. IF sbit = 8 THEN
  938. INC(sadr); sbit := 0;
  939. SYSTEM.GET(sadr, in)
  940. END
  941. END
  942. END A1CopyA8;
  943. PROCEDURE A1CopyBGRA8888 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  944. VAR pix: Pixel; in: CHAR;
  945. BEGIN
  946. pix := mode.buf;
  947. SYSTEM.GET(sadr, in);
  948. WHILE len > 0 DO
  949. IF Bit[ORD(in), sbit] THEN pix[a] := 0FFX
  950. ELSE pix[a] := 0X
  951. END;
  952. SYSTEM.MOVE(ADDRESSOF(pix), dadr, 4);
  953. INC(sbit); INC(dadr, 4); DEC(len);
  954. IF sbit = 8 THEN
  955. INC(sadr); sbit := 0;
  956. SYSTEM.GET(sadr, in)
  957. END
  958. END
  959. END A1CopyBGRA8888;
  960. (* A8 *)
  961. PROCEDURE AnyCopyA8 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  962. VAR pix: Pixel;
  963. BEGIN
  964. pix[a] := 0FFX;
  965. WHILE len > 0 DO
  966. mode.src.unpack(mode.src, sadr, sbit, pix);
  967. SYSTEM.PUT(dadr, pix[a]);
  968. INC(dadr); sbit := sbit + mode.src.bpp; INC(sadr, sbit DIV 8); sbit := sbit MOD 8; DEC(len)
  969. END
  970. END AnyCopyA8;
  971. PROCEDURE BGRA8888CopyA8 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  972. VAR byte: CHAR;
  973. BEGIN
  974. INC(sadr, 3);
  975. WHILE len > 0 DO
  976. SYSTEM.GET(sadr, byte);
  977. SYSTEM.PUT(dadr, byte);
  978. INC(sadr, 4); INC(dadr); DEC(len)
  979. END
  980. END BGRA8888CopyA8;
  981. PROCEDURE A8CopyBGRA8888 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  982. VAR pix: Pixel;
  983. BEGIN
  984. pix := mode.buf;
  985. WHILE len > 0 DO
  986. SYSTEM.GET(sadr, pix[a]);
  987. SYSTEM.MOVE(ADDRESSOF(pix), dadr, 4);
  988. INC(sadr); INC(dadr, 4); DEC(len)
  989. END
  990. END A8CopyBGRA8888;
  991. (* P8 *)
  992. PROCEDURE AnyCopyP8 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  993. VAR pix: Pixel;
  994. BEGIN
  995. WHILE len > 0 DO
  996. pix := mode.buf;
  997. mode.src.unpack(mode.src, sadr, sbit, pix);
  998. SYSTEM.PUT(dadr, CHR(CLUTs.Match(mode.dst.pal.clut, ORD(pix[b]) + ASH(ORD(pix[g]), 8) + ASH(ORD(pix[r]), 16))));
  999. INC(dadr); sbit := sbit + mode.src.bpp; INC(sadr, sbit DIV 8); sbit := sbit MOD 8; DEC(len)
  1000. END
  1001. END AnyCopyP8;
  1002. PROCEDURE Any16CopyP8 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1003. VAR pix: Pixel;
  1004. BEGIN
  1005. WHILE len > 0 DO
  1006. mode.src.unpack(mode.src, sadr, 0, pix);
  1007. SYSTEM.PUT(dadr, CHR(CLUTs.Match(mode.dst.pal.clut, ORD(pix[b]) + ASH(ORD(pix[g]), 8) + ASH(ORD(pix[r]), 16))));
  1008. INC(sadr, 2); INC(dadr); DEC(len)
  1009. END
  1010. END Any16CopyP8;
  1011. PROCEDURE BGR888CopyP8 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1012. VAR pix: Pixel;
  1013. BEGIN
  1014. WHILE len > 0 DO
  1015. SYSTEM.MOVE(sadr, ADDRESSOF(pix[0]), 3);
  1016. SYSTEM.PUT(dadr, CHR(CLUTs.Match(mode.dst.pal.clut, ORD(pix[b]) + ASH(ORD(pix[g]), 8) + ASH(ORD(pix[r]), 16))));
  1017. INC(sadr, 3); INC(dadr); DEC(len)
  1018. END
  1019. END BGR888CopyP8;
  1020. PROCEDURE BGRA8888CopyP8 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1021. VAR pix: Pixel;
  1022. BEGIN
  1023. WHILE len > 0 DO
  1024. SYSTEM.MOVE(sadr, ADDRESSOF(pix[0]), 4);
  1025. SYSTEM.PUT(dadr, CHR(CLUTs.Match(mode.dst.pal.clut, ORD(pix[b]) + ASH(ORD(pix[g]), 8) + ASH(ORD(pix[r]), 16))));
  1026. INC(sadr, 4); INC(dadr); DEC(len)
  1027. END
  1028. END BGRA8888CopyP8;
  1029. PROCEDURE P8CopyAny (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1030. VAR b: CHAR;
  1031. BEGIN
  1032. WHILE len > 0 DO
  1033. SYSTEM.GET(sadr, b);
  1034. mode.dst.pack(mode.dst, dadr, dbit, mode.src.pal.col[ORD(b)]);
  1035. INC(sadr); dbit := dbit + mode.dst.bpp; INC(dadr, dbit DIV 8); dbit := dbit MOD 8; DEC(len)
  1036. END
  1037. END P8CopyAny;
  1038. PROCEDURE P8CopyAny16 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1039. VAR b: CHAR;
  1040. BEGIN
  1041. WHILE len > 0 DO
  1042. SYSTEM.GET(sadr, b);
  1043. mode.dst.pack(mode.dst, dadr, 0, mode.src.pal.col[ORD(b)]);
  1044. INC(sadr); INC(dadr, 2); DEC(len)
  1045. END
  1046. END P8CopyAny16;
  1047. PROCEDURE P8CopyBGR888 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1048. VAR b: CHAR;
  1049. BEGIN
  1050. WHILE len > 0 DO
  1051. SYSTEM.GET(sadr, b);
  1052. SYSTEM.MOVE(ADDRESSOF(mode.src.pal.col[ORD(b)]), dadr, 3);
  1053. INC(sadr); INC(dadr, 3); DEC(len)
  1054. END
  1055. END P8CopyBGR888;
  1056. PROCEDURE P8CopyBGRA8888 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1057. VAR b: CHAR;
  1058. BEGIN
  1059. WHILE len > 0 DO
  1060. SYSTEM.GET(sadr, b);
  1061. SYSTEM.MOVE(ADDRESSOF(mode.src.pal.col[ORD(b)]), dadr, 4);
  1062. INC(sadr); INC(dadr, 4); DEC(len)
  1063. END
  1064. END P8CopyBGRA8888;
  1065. (* D8 *)
  1066. PROCEDURE AnyCopyD8 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1067. VAR pix: Pixel;
  1068. BEGIN
  1069. WHILE len > 0 DO
  1070. pix := mode.buf;
  1071. mode.src.unpack(mode.src, sadr, sbit, pix);
  1072. SYSTEM.PUT(dadr, CHR(ColorToIndex(ORD(pix[b]) + ASH(ORD(pix[g]), 8) + ASH(ORD(pix[r]), 16))));
  1073. INC(dadr); sbit := sbit + mode.src.bpp; INC(sadr, sbit DIV 8); sbit := sbit MOD 8; DEC(len)
  1074. END
  1075. END AnyCopyD8;
  1076. PROCEDURE Any16CopyD8 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1077. VAR pix: Pixel;
  1078. BEGIN
  1079. WHILE len > 0 DO
  1080. mode.src.unpack(mode.src, sadr, 0, pix);
  1081. SYSTEM.PUT(dadr, CHR(ColorToIndex(ORD(pix[b]) + ASH(ORD(pix[g]), 8) + ASH(ORD(pix[r]), 16))));
  1082. INC(sadr, 2); INC(dadr); DEC(len)
  1083. END
  1084. END Any16CopyD8;
  1085. PROCEDURE BGR888CopyD8 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1086. VAR pix: Pixel;
  1087. BEGIN
  1088. WHILE len > 0 DO
  1089. SYSTEM.MOVE(sadr, ADDRESSOF(pix[0]), 3);
  1090. SYSTEM.PUT(dadr, CHR(ColorToIndex(ORD(pix[b]) + ASH(ORD(pix[g]), 8) + ASH(ORD(pix[r]), 16))));
  1091. INC(sadr, 3); INC(dadr); DEC(len)
  1092. END
  1093. END BGR888CopyD8;
  1094. PROCEDURE BGRA8888CopyD8 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1095. VAR pix: Pixel;
  1096. BEGIN
  1097. WHILE len > 0 DO
  1098. SYSTEM.MOVE(sadr, ADDRESSOF(pix[0]), 4);
  1099. SYSTEM.PUT(dadr, CHR(ColorToIndex(ORD(pix[b]) + ASH(ORD(pix[g]), 8) + ASH(ORD(pix[r]), 16))));
  1100. INC(sadr, 4); INC(dadr); DEC(len)
  1101. END
  1102. END BGRA8888CopyD8;
  1103. PROCEDURE D8CopyAny (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1104. VAR pix: Pixel; byte: CHAR; col: LONGINT;
  1105. BEGIN
  1106. pix[a] := 0FFX;
  1107. WHILE len > 0 DO
  1108. SYSTEM.GET(sadr, byte); col := IndexToColor(ORD(byte));
  1109. pix[b] := CHR(col MOD 100H); pix[g] := CHR(ASH(col, -8) MOD 100H); pix[r] := CHR(ASH(col, -16) MOD 100H);
  1110. mode.dst.pack(mode.dst, dadr, dbit, pix);
  1111. INC(sadr); dbit := dbit + mode.dst.bpp; INC(dadr, dbit DIV 8); dbit := dbit MOD 8; DEC(len)
  1112. END
  1113. END D8CopyAny;
  1114. PROCEDURE D8CopyAny16 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1115. VAR pix: Pixel; byte: CHAR; col: LONGINT;
  1116. BEGIN
  1117. pix[a] := 0FFX;
  1118. WHILE len > 0 DO
  1119. SYSTEM.GET(sadr, byte); col := IndexToColor(ORD(byte));
  1120. pix[b] := CHR(col MOD 100H); pix[g] := CHR(ASH(col, -8) MOD 100H); pix[r] := CHR(ASH(col, -16) MOD 100H);
  1121. mode.dst.pack(mode.dst, dadr, 0, pix);
  1122. INC(sadr); INC(dadr, 2); DEC(len)
  1123. END
  1124. END D8CopyAny16;
  1125. PROCEDURE D8CopyBGR888 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1126. VAR byte: CHAR; col: LONGINT; pix: Pixel;
  1127. BEGIN
  1128. WHILE len > 0 DO
  1129. SYSTEM.GET(sadr, byte); col := IndexToColor(ORD(byte));
  1130. pix[b] := CHR(col MOD 100H); pix[g] := CHR(ASH(col, -8) MOD 100H); pix[r] := CHR(ASH(col, -16) MOD 100H);
  1131. SYSTEM.MOVE(ADDRESSOF(pix[0]), dadr, 3);
  1132. INC(sadr); INC(dadr, 3); DEC(len)
  1133. END
  1134. END D8CopyBGR888;
  1135. PROCEDURE D8CopyBGRA8888 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1136. VAR pix: Pixel; byte: CHAR; col: LONGINT;
  1137. BEGIN
  1138. pix[a] := 0FFX;
  1139. WHILE len > 0 DO
  1140. SYSTEM.GET(sadr, byte); col := IndexToColor(ORD(byte));
  1141. pix[b] := CHR(col MOD 100H); pix[g] := CHR(ASH(col, -8) MOD 100H); pix[r] := CHR(ASH(col, -16) MOD 100H);
  1142. SYSTEM.MOVE(ADDRESSOF(pix[0]), dadr, 4);
  1143. INC(sadr); INC(dadr, 4); DEC(len)
  1144. END
  1145. END D8CopyBGRA8888;
  1146. (*
  1147. (* P816*)
  1148. PROCEDURE AnyCopyP16 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1149. VAR pix: Pixel;
  1150. BEGIN
  1151. WHILE len > 0 DO
  1152. pix := mode.buf;
  1153. mode.src.unpack(mode.src, sadr, sbit, pix);
  1154. SYSTEM.PUT16(dadr, PaletteIndex(mode.dst.pal, ORD(pix[r]), ORD(pix[g]), ORD(pix[b])));
  1155. INC(dadr,2); sbit := sbit + mode.src.bpp; INC(sadr, sbit DIV 8); sbit := sbit MOD 8; DEC(len)
  1156. END
  1157. END AnyCopyP16;
  1158. PROCEDURE Any16CopyP16 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1159. VAR pix: Pixel;
  1160. BEGIN
  1161. WHILE len > 0 DO
  1162. mode.src.unpack(mode.src, sadr, 0, pix);
  1163. SYSTEM.PUT16(dadr, PaletteIndex(mode.dst.pal, ORD(pix[r]), ORD(pix[g]), ORD(pix[b])));
  1164. INC(sadr, 2); INC(dadr,2); DEC(len)
  1165. END
  1166. END Any16CopyP16;
  1167. PROCEDURE BGR888CopyP16 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1168. VAR pix: Pixel;
  1169. BEGIN
  1170. WHILE len > 0 DO
  1171. SYSTEM.MOVE(sadr, ADDRESSOF(pix[0]), 3);
  1172. SYSTEM.PUT16(dadr, PaletteIndex(mode.dst.pal, ORD(pix[r]), ORD(pix[g]), ORD(pix[b])));
  1173. INC(sadr, 3); INC(dadr,2); DEC(len)
  1174. END
  1175. END BGR888CopyP16;
  1176. PROCEDURE BGRA8888CopyP16 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1177. VAR pix: Pixel;
  1178. BEGIN
  1179. WHILE len > 0 DO
  1180. SYSTEM.MOVE(sadr, ADDRESSOF(pix[0]), 4);
  1181. SYSTEM.PUT16(dadr, PaletteIndex(mode.dst.pal, ORD(pix[r]), ORD(pix[g]), ORD(pix[b])));
  1182. INC(sadr, 4); INC(dadr,2); DEC(len)
  1183. END
  1184. END BGRA8888CopyP16;
  1185. PROCEDURE P16CopyAny (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1186. BEGIN
  1187. WHILE len > 0 DO
  1188. mode.dst.pack(mode.dst, dadr, dbit, mode.src.pal.col[LONG(SYSTEM.GET16(sadr)) MOD 10000H]);
  1189. INC(sadr,2); dbit := dbit + mode.dst.bpp; INC(dadr, dbit DIV 8); dbit := dbit MOD 8; DEC(len)
  1190. END
  1191. END P16CopyAny;
  1192. PROCEDURE P16CopyAny16 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1193. BEGIN
  1194. WHILE len > 0 DO
  1195. mode.dst.pack(mode.dst, dadr, 0, mode.src.pal.col[LONG(SYSTEM.GET16(sadr)) MOD 10000H]);
  1196. INC(sadr,2); INC(dadr, 2); DEC(len)
  1197. END
  1198. END P16CopyAny16;
  1199. *)
  1200. PROCEDURE P16CopyBGR888 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1201. BEGIN
  1202. WHILE len > 0 DO
  1203. SYSTEM.MOVE(ADDRESSOF(mode.src.pal.col[LONG(SYSTEM.GET16(sadr)) MOD 10000H]), dadr, 3);
  1204. INC(sadr,2); INC(dadr, 3); DEC(len)
  1205. END
  1206. END P16CopyBGR888;
  1207. PROCEDURE P16CopyBGRA8888 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1208. VAR val:LONGINT;
  1209. BEGIN
  1210. WHILE len > 0 DO
  1211. val:=LONG(SYSTEM.GET16(sadr)) MOD 10000H;
  1212. SYSTEM.MOVE(ADDRESSOF(mode.src.pal.col[val]), dadr, 4);
  1213. INC(sadr,2); INC(dadr, 4); DEC(len)
  1214. END
  1215. END P16CopyBGRA8888;
  1216. (* BGR555, BGR565, BGR466 *)
  1217. PROCEDURE AnyCopyAny16 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1218. VAR pix: Pixel;
  1219. BEGIN
  1220. WHILE len > 0 DO
  1221. pix := mode.buf;
  1222. mode.src.unpack(mode.src, sadr, 0, pix);
  1223. mode.dst.pack(mode.dst, dadr, 0, pix);
  1224. INC(dadr, 2); sbit := sbit + mode.src.bpp; INC(sadr, sbit DIV 8); sbit := sbit MOD 8; DEC(len)
  1225. END
  1226. END AnyCopyAny16;
  1227. PROCEDURE Any16CopyAny16 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1228. VAR pix: Pixel;
  1229. BEGIN
  1230. WHILE len > 0 DO
  1231. mode.src.unpack(mode.src, sadr, 0, pix);
  1232. mode.dst.pack(mode.dst, dadr, 0, pix);
  1233. INC(sadr, 2); INC(dadr, 2); DEC(len)
  1234. END
  1235. END Any16CopyAny16;
  1236. PROCEDURE BGR888CopyAny16 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1237. VAR pix: Pixel;
  1238. BEGIN
  1239. pix[a] := 0FFX;
  1240. WHILE len > 0 DO
  1241. SYSTEM.MOVE(sadr, ADDRESSOF(pix[0]), 3);
  1242. mode.dst.pack(mode.dst, dadr, 0, pix);
  1243. INC(sadr, 3); INC(dadr, 2); DEC(len)
  1244. END
  1245. END BGR888CopyAny16;
  1246. PROCEDURE BGRA8888CopyAny16 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1247. VAR pix: Pixel;
  1248. BEGIN
  1249. WHILE len > 0 DO
  1250. SYSTEM.MOVE(sadr, ADDRESSOF(pix[0]), 4);
  1251. mode.dst.pack(mode.dst, dadr, 0, pix);
  1252. INC(dadr, 2); sbit := sbit + mode.src.bpp; INC(sadr, sbit DIV 8); sbit := sbit MOD 8; DEC(len)
  1253. END
  1254. END BGRA8888CopyAny16;
  1255. PROCEDURE Any16CopyAny (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1256. VAR pix: Pixel;
  1257. BEGIN
  1258. WHILE len > 0 DO
  1259. mode.src.unpack(mode.src, sadr, 0, pix);
  1260. mode.dst.pack(mode.dst, dadr, 0, pix);
  1261. INC(sadr, 2); dbit := dbit + mode.dst.bpp; INC(dadr, dbit DIV 8); dbit := dbit MOD 8; DEC(len)
  1262. END
  1263. END Any16CopyAny;
  1264. PROCEDURE Any16CopyBGR888 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1265. VAR pix: Pixel;
  1266. BEGIN
  1267. WHILE len > 0 DO
  1268. mode.src.unpack(mode.src, sadr, 0, pix);
  1269. SYSTEM.MOVE(ADDRESSOF(pix[0]), dadr, 3);
  1270. INC(sadr, 2); INC(dadr, 3); DEC(len)
  1271. END
  1272. END Any16CopyBGR888;
  1273. PROCEDURE Any16CopyBGRA8888 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1274. VAR pix: Pixel;
  1275. BEGIN
  1276. WHILE len > 0 DO
  1277. mode.src.unpack(mode.src, sadr, 0, pix);
  1278. SYSTEM.MOVE(ADDRESSOF(pix[0]), dadr, 4);
  1279. INC(sadr, 2); INC(dadr, 4); DEC(len)
  1280. END
  1281. END Any16CopyBGRA8888;
  1282. (* BGR888 *)
  1283. PROCEDURE AnyCopyBGR888 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1284. VAR pix: Pixel;
  1285. BEGIN
  1286. WHILE len > 0 DO
  1287. pix := mode.buf;
  1288. mode.src.unpack(mode.src, sadr, sbit, pix);
  1289. SYSTEM.MOVE(ADDRESSOF(pix[0]), dadr, 3);
  1290. INC(dadr, 3); sbit := sbit + mode.src.bpp; INC(sadr, sbit DIV 8); sbit := sbit MOD 8; DEC(len)
  1291. END
  1292. END AnyCopyBGR888;
  1293. PROCEDURE BGRA8888CopyBGR888 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1294. BEGIN
  1295. WHILE len > 0 DO
  1296. SYSTEM.MOVE(sadr, dadr, 3);
  1297. INC(sadr, 4); INC(dadr, 3); DEC(len)
  1298. END
  1299. END BGRA8888CopyBGR888;
  1300. PROCEDURE SSE2BGRA8888CopyBGR888 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1301. CODE {SYSTEM.AMD64, SYSTEM.MMX, SYSTEM.SSE, SYSTEM.SSE2}
  1302. PUSHFQ
  1303. PUSH RBX
  1304. ; CLI
  1305. MOV RSI, [RBP + sadr] ; source adr
  1306. MOV RDI, [RBP + dadr] ; source adr
  1307. MOV ECX, [RBP + len]
  1308. loop:
  1309. CMP ECX, 0
  1310. JLE end
  1311. CMP ECX, 4
  1312. JL singlepixel
  1313. fourpixel:
  1314. ; 4pixels at the time
  1315. MOV EAX, [RSI] ; pixel 0
  1316. MOV EBX, [RSI + 4] ; pixel 1
  1317. AND EAX, 0FFFFFFH
  1318. AND EBX, 0FFFFFFH
  1319. MOV EDX, EBX
  1320. SHL EDX, 24
  1321. OR EAX, EDX ; 1000
  1322. MOV [RDI], EAX ; write back to mem
  1323. MOV EAX, [RSI + 8] ; pixel 2
  1324. AND EAX, 0FFFFFFH
  1325. SHR EBX,8
  1326. MOV EDX, EAX
  1327. SHL EDX, 16
  1328. OR EBX, EDX ; 2211
  1329. MOV [RDI + 4], EBX
  1330. MOV EDX, [RSI + 12] ; pixel 3
  1331. SHL EDX, 8
  1332. SHR EAX, 16
  1333. OR EAX, EDX ; 3332
  1334. MOV [RDI], EAX
  1335. ADD RSI, 16
  1336. ADD RDI, 12
  1337. SUB ECX, 4
  1338. JG loop
  1339. JMP end
  1340. singlepixel:
  1341. MOV EAX, [RSI]
  1342. MOV [RDI], AX
  1343. SHR EAX, 16
  1344. MOV [RDI + 2], AL
  1345. ADD RSI, 4
  1346. ADD RDI, 3
  1347. SUB ECX, 1
  1348. JG loop
  1349. end:
  1350. EMMS ; declare FPU registers free
  1351. POP RBX
  1352. POPFQ
  1353. END SSE2BGRA8888CopyBGR888;
  1354. PROCEDURE BGR888CopyAny (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1355. VAR pix: Pixel;
  1356. BEGIN
  1357. pix[a] := 0FFX;
  1358. WHILE len > 0 DO
  1359. SYSTEM.MOVE(sadr, ADDRESSOF(pix[0]), 3);
  1360. mode.dst.pack(mode.dst, dadr, dbit, pix);
  1361. INC(sadr, 3); dbit := dbit + mode.dst.bpp; INC(dadr, dbit DIV 8); dbit := dbit MOD 8; DEC(len)
  1362. END
  1363. END BGR888CopyAny;
  1364. PROCEDURE BGR888CopyBGRA8888(VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1365. BEGIN
  1366. WHILE len > 0 DO
  1367. SYSTEM.MOVE(sadr, dadr, 3); SYSTEM.PUT(dadr+3, 0FFX);
  1368. INC(sadr, 3); INC(dadr, 4); DEC(len)
  1369. END
  1370. END BGR888CopyBGRA8888;
  1371. PROCEDURE SSE2BGR888CopyBGRA8888(VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1372. CODE {SYSTEM.AMD64, SYSTEM.MMX, SYSTEM.SSE, SYSTEM.SSE2}
  1373. PUSHFQ
  1374. PUSH RBX
  1375. ; CLI
  1376. PXOR XMM0, XMM0
  1377. MOV EAX, 0FF00H
  1378. PINSRW XMM0, EAX, 1
  1379. PINSRW XMM0, EAX, 3
  1380. PINSRW XMM0, EAX, 5
  1381. PINSRW XMM0, EAX, 7 ; prepare for fourpixel
  1382. SHL EAX, 16 ; prepare for singlepixel
  1383. MOV RSI, [RBP + sadr] ; source adr
  1384. MOV RDI, [RBP + dadr] ; source adr
  1385. MOV ECX, [RBP + len]
  1386. loop:
  1387. CMP ECX, 0
  1388. JLE end
  1389. CMP ECX, 4
  1390. JL singlepixel
  1391. fourpixel:
  1392. ; 4pixels at the time
  1393. PXOR XMM2,XMM2
  1394. PXOR XMM1,XMM1
  1395. MOV EBX, [RSI + 9] ; read 1st source pixel
  1396. MOVD XMM2, EBX
  1397. PSLLDQ XMM2, 4
  1398. MOV EBX, [RSI + 6] ; read 2nd source pixel
  1399. MOVD XMM1, EBX
  1400. POR XMM2, XMM1
  1401. PSLLDQ XMM2, 4
  1402. MOV EBX, [RSI + 3] ; read 3rd source pixel
  1403. MOVD XMM1, EBX
  1404. POR XMM2, XMM1
  1405. PSLLDQ XMM2, 4
  1406. MOV EBX, [RSI] ; read 4th source pixel
  1407. MOVD XMM1, EBX
  1408. POR XMM2, XMM1
  1409. ADD RSI, 12
  1410. POR XMM2, XMM0
  1411. MOVDQU [RDI], XMM2 ; set the pixels
  1412. ADD RDI, 16 ; inc adr
  1413. SUB ECX, 4
  1414. JG loop
  1415. JMP end
  1416. singlepixel:
  1417. MOV EBX, [RSI] ; read source pixel
  1418. OR EBX, EAX
  1419. ADD RSI, 3
  1420. MOV [RDI], EBX
  1421. ADD RDI, 4 ; inc adr
  1422. SUB ECX, 1
  1423. JG loop
  1424. end:
  1425. EMMS ; declare FPU registers free
  1426. POP RBX
  1427. POPFQ
  1428. END SSE2BGR888CopyBGRA8888;
  1429. (* BGRA8888 *)
  1430. PROCEDURE AnyCopyBGRA8888 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1431. VAR pix: Pixel;
  1432. BEGIN
  1433. WHILE len > 0 DO
  1434. pix := mode.buf;
  1435. mode.src.unpack(mode.src, sadr, sbit, pix);
  1436. SYSTEM.MOVE(ADDRESSOF(pix[0]), dadr, 4);
  1437. INC(dadr, 4); sbit := sbit + mode.src.bpp; INC(sadr, sbit DIV 8); sbit := sbit MOD 8; DEC(len)
  1438. END
  1439. END AnyCopyBGRA8888;
  1440. PROCEDURE BGRA8888CopyAny (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1441. VAR pix: Pixel;
  1442. BEGIN
  1443. WHILE len > 0 DO
  1444. SYSTEM.MOVE(sadr, ADDRESSOF(pix[0]), 4);
  1445. mode.dst.pack(mode.dst, dadr, dbit, pix);
  1446. INC(sadr, 4); dbit := dbit + mode.dst.bpp; INC(dadr, dbit DIV 8); dbit := dbit MOD 8; DEC(len)
  1447. END
  1448. END BGRA8888CopyAny;
  1449. (*--- dstCopy Transfer ---*)
  1450. PROCEDURE EmptyTransfer (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1451. END EmptyTransfer;
  1452. (*--- srcOverDst Transfer ---*)
  1453. (* A1 *)
  1454. PROCEDURE AnyOverA1 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1455. VAR out: CHAR; pix: Pixel;
  1456. BEGIN
  1457. SYSTEM.GET(dadr, out);
  1458. WHILE len > 0 DO
  1459. mode.src.unpack(mode.src, sadr, sbit, pix);
  1460. IF pix[a] >= 80X THEN
  1461. out := Set[ORD(out), dbit]
  1462. END;
  1463. sbit := sbit + mode.src.bpp; INC(sadr, sbit DIV 8); sbit := sbit MOD 8; INC(dbit); DEC(len);
  1464. IF dbit = 8 THEN
  1465. SYSTEM.PUT(dadr, out);
  1466. INC(dadr); dbit := 0;
  1467. SYSTEM.GET(dadr, out)
  1468. END
  1469. END;
  1470. SYSTEM.PUT(dadr, out)
  1471. END AnyOverA1;
  1472. PROCEDURE A1OverA1 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1473. VAR in, out: CHAR;
  1474. BEGIN
  1475. SYSTEM.GET(sadr, in); SYSTEM.GET(dadr, out);
  1476. WHILE len > 0 DO
  1477. IF Bit[ORD(in), sbit] THEN
  1478. out := Set[ORD(out), dbit]
  1479. END;
  1480. INC(sbit); INC(dbit); DEC(len);
  1481. IF sbit = 8 THEN
  1482. INC(sadr); sbit := 0;
  1483. SYSTEM.GET(sadr, in)
  1484. END;
  1485. IF dbit = 8 THEN
  1486. SYSTEM.PUT(dadr, out);
  1487. INC(dadr); dbit := 0;
  1488. SYSTEM.GET(dadr, out)
  1489. END
  1490. END;
  1491. SYSTEM.PUT(dadr, out)
  1492. END A1OverA1;
  1493. PROCEDURE A8OverA1 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1494. VAR in, out: CHAR;
  1495. BEGIN
  1496. SYSTEM.GET(dadr, out);
  1497. WHILE len > 0 DO
  1498. SYSTEM.GET(sadr, in);
  1499. IF in >= 80X THEN
  1500. out := Set[ORD(out), dbit]
  1501. END;
  1502. INC(sadr); INC(dbit); DEC(len);
  1503. IF dbit = 8 THEN
  1504. SYSTEM.PUT(dadr, out);
  1505. INC(dadr); dbit := 0;
  1506. SYSTEM.GET(dadr, out)
  1507. END
  1508. END;
  1509. SYSTEM.PUT(dadr, out)
  1510. END A8OverA1;
  1511. PROCEDURE BGRA8888OverA1 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1512. VAR in, out: CHAR;
  1513. BEGIN
  1514. SYSTEM.GET(dadr, out);
  1515. WHILE len > 0 DO
  1516. SYSTEM.GET(sadr + a, in);
  1517. IF in >= 80X THEN
  1518. out := Set[ORD(out), dbit]
  1519. END;
  1520. INC(sadr, 4); INC(dbit); DEC(len);
  1521. IF dbit = 8 THEN
  1522. SYSTEM.PUT(dadr, out);
  1523. INC(dadr); dbit := 0;
  1524. SYSTEM.GET(dadr, out)
  1525. END
  1526. END;
  1527. SYSTEM.PUT(dadr, out)
  1528. END BGRA8888OverA1;
  1529. PROCEDURE A1OverAny (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1530. VAR in: CHAR;
  1531. BEGIN
  1532. SYSTEM.GET(sadr, in);
  1533. WHILE len > 0 DO
  1534. IF Bit[ORD(in), sbit] THEN
  1535. mode.dst.pack(mode.dst, dadr, dbit, mode.buf)
  1536. END;
  1537. INC(sbit); dbit := dbit + mode.dst.bpp; INC(dadr, dbit DIV 8); dbit := dbit MOD 8; DEC(len);
  1538. IF sbit = 8 THEN
  1539. INC(sadr); sbit := 0;
  1540. SYSTEM.GET(sadr, in)
  1541. END
  1542. END
  1543. END A1OverAny;
  1544. PROCEDURE A1OverConst8 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1545. VAR in: CHAR;
  1546. BEGIN
  1547. SYSTEM.GET(sadr, in);
  1548. WHILE len > 0 DO
  1549. IF Bit[ORD(in), sbit] THEN
  1550. SYSTEM.PUT(dadr, mode.buf[0])
  1551. END;
  1552. INC(sbit); INC(dadr); DEC(len);
  1553. IF sbit = 8 THEN
  1554. INC(sadr); sbit := 0;
  1555. SYSTEM.GET(sadr, in)
  1556. END
  1557. END
  1558. END A1OverConst8;
  1559. PROCEDURE A1OverConst16 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1560. VAR in: CHAR;
  1561. BEGIN
  1562. SYSTEM.GET(sadr, in);
  1563. WHILE len > 0 DO
  1564. IF Bit[ORD(in), sbit] THEN
  1565. SYSTEM.MOVE(ADDRESSOF(mode.buf[0]), dadr, 2)
  1566. END;
  1567. INC(sbit); INC(dadr, 2); DEC(len);
  1568. IF sbit = 8 THEN
  1569. INC(sadr); sbit := 0;
  1570. SYSTEM.GET(sadr, in)
  1571. END
  1572. END
  1573. END A1OverConst16;
  1574. PROCEDURE A1OverConst24 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1575. VAR in: CHAR;
  1576. BEGIN
  1577. SYSTEM.GET(sadr, in);
  1578. WHILE len > 0 DO
  1579. IF Bit[ORD(in), sbit] THEN
  1580. SYSTEM.MOVE(ADDRESSOF(mode.buf[0]), dadr, 3)
  1581. END;
  1582. INC(sbit); INC(dadr, 3); DEC(len);
  1583. IF sbit = 8 THEN
  1584. INC(sadr); sbit := 0;
  1585. SYSTEM.GET(sadr, in)
  1586. END
  1587. END
  1588. END A1OverConst24;
  1589. PROCEDURE A1OverConst32 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1590. VAR in: CHAR;
  1591. BEGIN
  1592. SYSTEM.GET(sadr, in);
  1593. WHILE len > 0 DO
  1594. IF Bit[ORD(in), sbit] THEN
  1595. SYSTEM.MOVE(ADDRESSOF(mode.buf[0]), dadr, 4)
  1596. END;
  1597. INC(sbit); INC(dadr, 4); DEC(len);
  1598. IF sbit = 8 THEN
  1599. INC(sadr); sbit := 0;
  1600. SYSTEM.GET(sadr, in)
  1601. END
  1602. END
  1603. END A1OverConst32;
  1604. (* A8 *)
  1605. PROCEDURE AnyOverA8 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1606. VAR pix: Pixel; b: CHAR;
  1607. BEGIN
  1608. WHILE len > 0 DO
  1609. mode.src.unpack(mode.src, sadr, sbit, pix);
  1610. IF pix[a] = 0FFX THEN
  1611. SYSTEM.PUT(dadr, 0FFX)
  1612. ELSIF pix[a] # 0X THEN
  1613. SYSTEM.GET(dadr, b);
  1614. SYSTEM.PUT(dadr, CHR(ORD(pix[a]) + ORD(b) * LONG(255-ORD(pix[a])) DIV 255))
  1615. END;
  1616. sbit := sbit + mode.src.bpp; INC(sadr, sbit DIV 8); sbit := sbit MOD 8; INC(dadr); DEC(len)
  1617. END
  1618. END AnyOverA8;
  1619. PROCEDURE A8OverAny (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1620. VAR spix, dpix: Pixel; alpha, rc,gc,bc,ac: CHAR;
  1621. BEGIN
  1622. ac := mode.col[a];
  1623. rc := mode.col[r];
  1624. gc := mode.col[g];
  1625. bc := mode.col[b];
  1626. WHILE len > 0 DO
  1627. SYSTEM.GET(sadr, alpha);
  1628. alpha := CHR(ORD(ac) * ORD(alpha) DIV 255);
  1629. IF alpha = 0FFX THEN
  1630. mode.dst.pack(mode.dst, dadr, dbit, mode.buf)
  1631. ELSIF alpha # 0X THEN
  1632. spix[a] := alpha;
  1633. (* the following computation of the colors has to be done because the blending method seems to assume this *)
  1634. spix[r] := CHR(ORD(rc) * ORD(alpha) DIV 255);
  1635. spix[g] := CHR(ORD(gc) * ORD(alpha) DIV 255);
  1636. spix[b] := CHR(ORD(bc) * ORD(alpha) DIV 255);
  1637. mode.dst.unpack(mode.dst, dadr, dbit, dpix);
  1638. Blend(mode.op, spix, dpix);
  1639. mode.dst.pack(mode.dst, dadr, dbit, dpix);
  1640. END;
  1641. INC(sadr); DEC(len);
  1642. dbit := dbit + mode.dst.bpp; INC(dadr, dbit DIV 8); dbit := dbit MOD 8
  1643. END
  1644. END A8OverAny;
  1645. PROCEDURE A8OverA8 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1646. VAR in, out: CHAR;
  1647. BEGIN
  1648. WHILE len > 0 DO
  1649. SYSTEM.GET(sadr, in);
  1650. IF in = 0FFX THEN
  1651. SYSTEM.PUT(dadr, 0FFX)
  1652. ELSIF in # 0X THEN
  1653. SYSTEM.GET(dadr, out);
  1654. SYSTEM.PUT(dadr, CHR(ORD(in) + ORD(out) * LONG(255-ORD(in)) DIV 255))
  1655. END;
  1656. INC(sadr); INC(dadr); DEC(len)
  1657. END
  1658. END A8OverA8;
  1659. (* BGRA8888 *)
  1660. PROCEDURE BGRA8888OverAny (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1661. VAR spix, dpix: Pixel;
  1662. BEGIN
  1663. WHILE len > 0 DO
  1664. SYSTEM.GET (sadr, spix);
  1665. IF spix[a] = 0FFX THEN
  1666. mode.dst.pack(mode.dst, dadr, dbit, spix)
  1667. ELSIF spix[a] # 0X THEN
  1668. mode.dst.unpack(mode.dst, dadr, dbit, dpix);
  1669. Blend(mode.op, spix, dpix);
  1670. mode.dst.pack(mode.dst, dadr, dbit, dpix)
  1671. END;
  1672. INC(sadr, SIZEOF (Pixel)); DEC(len);
  1673. dbit := dbit + mode.dst.bpp; INC(dadr, dbit DIV 8); dbit := dbit MOD 8
  1674. END
  1675. END BGRA8888OverAny;
  1676. PROCEDURE BGRA8888OverA8 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1677. VAR in, out: CHAR;
  1678. BEGIN
  1679. WHILE len > 0 DO
  1680. SYSTEM.GET(sadr + a, in);
  1681. IF in = 0FFX THEN
  1682. SYSTEM.PUT(dadr, 0FFX)
  1683. ELSIF in # 0X THEN
  1684. SYSTEM.GET(dadr, out);
  1685. SYSTEM.PUT(dadr, CHR(ORD(in) + ORD(out) * (255 - ORD(in)) DIV 255))
  1686. END;
  1687. INC(sadr, 4); INC(dadr); DEC(len)
  1688. END
  1689. END BGRA8888OverA8;
  1690. PROCEDURE BGRA8888OverAny16 (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1691. VAR src, dst: Pixel; fd, t: LONGINT;
  1692. BEGIN
  1693. WHILE len > 0 DO
  1694. SYSTEM.GET (sadr, src);
  1695. IF src[a] = 0FFX THEN
  1696. mode.dst.pack(mode.dst, dadr, dbit, src)
  1697. ELSIF src[a] # 0X THEN
  1698. mode.dst.unpack(mode.dst, dadr, 0, dst);
  1699. fd := 255-ORD(src[a]);
  1700. t := (256 * ORD(src[0]) + fd * ORD(dst[0])) DIV 256;
  1701. IF t < 255 THEN dst[0] := CHR(t) ELSE dst[0] := CHR(255) END;
  1702. t := (256 * ORD(src[1]) + fd * ORD(dst[1])) DIV 256;
  1703. IF t < 255 THEN dst[1] := CHR(t) ELSE dst[1] := CHR(255) END;
  1704. t := (256 * ORD(src[2]) + fd * ORD(dst[2])) DIV 256;
  1705. IF t < 255 THEN dst[2] := CHR(t) ELSE dst[2] := CHR(255) END;
  1706. t := (256 * ORD(src[3]) + fd * ORD(dst[3])) DIV 256;
  1707. IF t < 255 THEN dst[3] := CHR(t) ELSE dst[3] := CHR(255) END;
  1708. mode.dst.pack(mode.dst, dadr, 0, dst);
  1709. END;
  1710. INC(dadr, 2); INC(sadr, SIZEOF (Pixel)); DEC(len)
  1711. END
  1712. END BGRA8888OverAny16;
  1713. PROCEDURE BGRA8888Over565* (VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1714. VAR src, dst: Pixel; fd, t: LONGINT;
  1715. BEGIN
  1716. WHILE len > 0 DO
  1717. SYSTEM.GET (sadr, src);
  1718. IF src[a] = 0FFX THEN
  1719. SYSTEM.PUT16(dadr, ASH(ORD(src[b]), -3) + ASH(ASH(ORD(src[g]), -2), 5) + ASH(ASH(ORD(src[r]), -3), 11));
  1720. ELSIF src[a] # 0X THEN
  1721. t := SYSTEM.GET16(dadr);
  1722. 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);
  1723. fd := 256-ORD(src[a]);
  1724. t := (256 * ORD(src[0]) + fd * ORD(dst[0])) DIV 256;
  1725. IF t < 255 THEN dst[0] := CHR(t) ELSE dst[0] := CHR(255) END;
  1726. t := (256 * ORD(src[1]) + fd * ORD(dst[1])) DIV 256;
  1727. IF t < 255 THEN dst[1] := CHR(t) ELSE dst[1] := CHR(255) END;
  1728. t := (256 * ORD(src[2]) + fd * ORD(dst[2])) DIV 256;
  1729. IF t < 255 THEN dst[2] := CHR(t) ELSE dst[2] := CHR(255) END;
  1730. t := (256 * ORD(src[3]) + fd * ORD(dst[3])) DIV 256;
  1731. IF t < 255 THEN dst[3] := CHR(t) ELSE dst[3] := CHR(255) END;
  1732. SYSTEM.PUT16(dadr, ASH(ORD(dst[b]), -3) + ASH(ASH(ORD(dst[g]), -2), 5) + ASH(ASH(ORD(dst[r]), -3), 11));
  1733. END;
  1734. INC(dadr, 2); INC(sadr, 4); DEC(len)
  1735. END
  1736. END BGRA8888Over565;
  1737. PROCEDURE MMXBGRA8888Over565(VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1738. CODE {SYSTEM.AMD64, SYSTEM.MMX}
  1739. PUSHFQ
  1740. ; CLI
  1741. MOV RSI, [RBP + sadr]
  1742. MOV RDI, [RBP + dadr]
  1743. PXOR MMX0, MMX0
  1744. PXOR MMX1, MMX1
  1745. MOV EAX, 0FFFFFFFFH
  1746. MOVD MMX7, EAX
  1747. PUNPCKLBW MMX7, MMX0 ; 00FF00FF00FF00FF
  1748. MOV ECX, [RBP + len]
  1749. loop:
  1750. CMP ECX, 0
  1751. JE WORD end
  1752. MOV EAX, [RSI]
  1753. XOR EBX, EBX
  1754. MOV BX, [RDI]
  1755. ; 255 - alpha
  1756. MOV EDX, EAX
  1757. SHR EDX, 24
  1758. CMP EDX, 0
  1759. JE WORD empty
  1760. CMP EDX, 255
  1761. JE full
  1762. alpha:
  1763. NEG EDX
  1764. ADD EDX, 255
  1765. MOVD MMX6, EDX
  1766. PUNPCKLWD MMX6, MMX6
  1767. PUNPCKLDQ MMX6, MMX6
  1768. MOVD MMX1, EAX
  1769. ; unpack dst
  1770. MOV EDX, EBX ; b
  1771. SHL EDX, 3
  1772. AND EDX, 0F8H
  1773. MOV EAX, EDX
  1774. MOV EDX, EBX ; g
  1775. SHL EDX, 5
  1776. AND EDX, 0FC00H
  1777. OR EAX, EDX
  1778. MOV EDX, EBX ; r
  1779. SHL EDX, 8
  1780. AND EDX, 0F80000H
  1781. OR EAX, EDX
  1782. MOVD MMX2, EAX
  1783. PUNPCKLBW MMX1, MMX0 ; 0000ARGB --> 0A0R0G0B
  1784. PMULLW MMX1, MMX7
  1785. PUNPCKLBW MMX2, MMX0 ; 0000ARGB --> 0A0R0G0B
  1786. PMULLW MMX2, MMX6
  1787. PADDUSW MMX1, MMX2
  1788. ; PSRLW MM1, 8 ; normalize
  1789. DB 0FH, 71H, 0D1H, 08H
  1790. PACKUSWB MMX1, MMX0
  1791. ; HUGA BIMBO Muell
  1792. MOVD EAX, MMX1
  1793. full:
  1794. ; XOR EDX, EDX
  1795. ; SHR EAX, 3
  1796. ; MOV EDX, EAX
  1797. ; AND EDX, 1FH
  1798. ; SHR EAX, 2
  1799. ; AND EAX, 0FFFFFFE0H
  1800. ; OR EDX, EAX
  1801. ; AND EDX, 7FFH
  1802. ;
  1803. ; SHR EAX, 3
  1804. ; AND EAX,
  1805. ;
  1806. ;
  1807. ; SHR AL, 3
  1808. ; SHR AH, 2
  1809. ; MOV EDX, EAX
  1810. ; SHR EAX, 3
  1811. ; AND EAX, 01F0000H
  1812. ; OR EDX, EAX
  1813. ; AND EDX, 01F3F1FH
  1814. MOV EBX, EAX
  1815. AND EBX, 0FFH
  1816. SHR EBX, 3
  1817. MOV EDX, EBX
  1818. MOV EBX, EAX
  1819. SHR EBX, 8
  1820. AND EBX, 0FFH
  1821. SHR EBX, 2
  1822. SHL EBX, 5
  1823. OR EDX, EBX
  1824. MOV EBX, EAX
  1825. SHR EBX, 16
  1826. AND EBX, 0FFH
  1827. SHR EBX, 3
  1828. SHL EBX, 11
  1829. OR EDX, EBX
  1830. MOV [RDI], DX
  1831. empty:
  1832. ADD RSI, 4;
  1833. ADD RDI, 2;
  1834. DEC ECX
  1835. JMP WORD loop
  1836. end:
  1837. EMMS ; declare FPU registers free
  1838. POPFQ
  1839. END MMXBGRA8888Over565;
  1840. PROCEDURE SSE2BGRA8888Over565(VAR mode: Mode0; sadr: ADDRESS; sbit: LONGINT; dadr: ADDRESS; dbit, len: LONGINT);
  1841. CODE {SYSTEM.AMD64, SYSTEM.MMX, SYSTEM.SSE, SYSTEM.SSE2}
  1842. PUSHFQ
  1843. PUSH RBX
  1844. ; CLI
  1845. PXOR MMX0, MMX0
  1846. PXOR MMX1, MMX1
  1847. PXOR MMX2, MMX2
  1848. PXOR MMX3, MMX3
  1849. PXOR MMX4, MMX4
  1850. PXOR MMX5, MMX5
  1851. PXOR MMX6, MMX6
  1852. PXOR MMX7, MMX7
  1853. PXOR XMM3, XMM3
  1854. PXOR XMM4, XMM4
  1855. MOV RSI, [RBP + sadr]
  1856. MOV RDI, [RBP + dadr]
  1857. MOV ECX, [RBP + len]
  1858. ; create masks
  1859. ; src only FF which is rotated -> MM3
  1860. MOV EAX, 0000000FFH
  1861. MOVD MMX3, EAX
  1862. ; dest red -> MM4
  1863. MOV EAX, 0F800F800H
  1864. MOVD MMX4, EAX
  1865. ; dest green -> MM5
  1866. MOV EAX, 07E007E0H
  1867. MOVD MMX5, EAX
  1868. ; dest blue -> MM6 ; moved as MM6 is used in singlepixel
  1869. ; MOV EAX, 001F001FH
  1870. ; MOVD MMX6, EAX
  1871. ; BEGIN
  1872. ; WHILE len > 0 DO
  1873. loop:
  1874. CMP ECX,0
  1875. JE WORD end ; jump to end if ECX = 0
  1876. ; if len < 8 then do one pixel at the time
  1877. CMP ECX, 8
  1878. JL WORD singlepixel
  1879. ; else
  1880. ; take 8 at the time
  1881. MOV EBX, ESI
  1882. AND EBX, 0FH
  1883. CMP EBX, 0
  1884. JNE WORD singlepixel
  1885. alleightpixels:
  1886. ; dest blue -> MM6
  1887. MOV EAX, 001F001FH
  1888. MOVD MMX6, EAX
  1889. ; src := SYSTEM.VAL(Pixel, SYSTEM.GET32(sadr));
  1890. ; Load data into memory
  1891. ;MOV XMM4, 0FF000000FF000000FF000000FF000000H
  1892. MOVDQA XMM2, [RSI] ;src 5-8
  1893. MOVQ2DQ XMM4, MMX3 ; 000000000000000000000000000000FFH
  1894. MOVDQA XMM1, [RSI + 16] ;src 1-4
  1895. PREFETCHNTA [RSI + 32] ; prepare src 9-15
  1896. ; get alphas
  1897. MOVDQU XMM6, XMM2
  1898. PSHUFD XMM4, XMM4, 0
  1899. MOVDQU XMM5, XMM1
  1900. PSLLD XMM4, 24
  1901. PAND XMM6, XMM4 ; alpha 5-8 in XMM6
  1902. PAND XMM5, XMM4 ; alpha 1-4 in XMM5
  1903. PSRLD XMM5, 24
  1904. PSHUFHW XMM5, XMM5, 85H
  1905. PSRLD XMM6, 24
  1906. ; put both alphas into 1 register
  1907. PSHUFHW XMM6, XMM6, 85H
  1908. PSHUFLW XMM5, XMM5, 85H
  1909. PSHUFLW XMM6, XMM6, 58H
  1910. PSHUFD XMM5, XMM5, 0D0H ; 0102030400000000
  1911. PSHUFD XMM6, XMM6, 5CH ; 0000000005060708
  1912. PXOR XMM0,XMM0
  1913. POR XMM5, XMM6 ; XMM5 = alphas 0102030405060708
  1914. PCMPEQD XMM0, XMM5
  1915. PMOVMSKB EAX, XMM0
  1916. CMP EAX, 0FFFFH ; all alphas = zero; TEST not possible, because only 8 bits compared
  1917. JE WORD endloop
  1918. ; mask out alpha = zero
  1919. ; fd := 255-ORD(src[a]); fd = XMM4
  1920. ; MOV XMM4, 00FF00FF00FF00FF00FF00FF00FF00FFH
  1921. PXOR XMM4, XMM4
  1922. MOV EAX, 00FFH
  1923. PINSRW XMM4, EAX ,0
  1924. PSHUFLW XMM4, XMM4, 0
  1925. PSHUFD XMM4, XMM4, 0
  1926. PSUBW XMM4, XMM5
  1927. MOV EAX,1H
  1928. PINSRW XMM3, EAX ,0
  1929. PSHUFLW XMM3, XMM3, 0
  1930. PSHUFD XMM3, XMM3, 0
  1931. PADDUSW XMM4, XMM3
  1932. ; new red
  1933. ; calculate red 2
  1934. ; get source
  1935. ; sred14 = src14 && (srcMask <<16)
  1936. ; srcMask << 16
  1937. MOVQ2DQ XMM3, MMX3
  1938. PSHUFD XMM3, XMM3, 0
  1939. MOVDQU XMM5, XMM1
  1940. MOVDQU XMM6, XMM2
  1941. PSLLD XMM3, 16
  1942. ; sred14 = src14 && (srcMask << 24)
  1943. ; src14 must be copied because it mustn't be changed
  1944. PAND XMM5, XMM3 ; sred14
  1945. PSRLD XMM5, 16
  1946. ; sred14s = shuffled sred14
  1947. PSHUFHW XMM5, XMM5,85H
  1948. PAND XMM6, XMM3 ; sred58
  1949. PSRLD XMM6, 16
  1950. PSHUFLW XMM5, XMM5,85H
  1951. PSHUFHW XMM6, XMM6,85H
  1952. PSHUFD XMM5, XMM5,0D0H ; sred14s
  1953. PSHUFLW XMM6, XMM6,58H
  1954. PSHUFD XMM6, XMM6,5CH ; sred58s
  1955. POR XMM5, XMM6 ; sred18
  1956. ; sred18255 = sred18 * 256- sred18
  1957. MOVDQU XMM7, XMM5
  1958. PSLLW XMM5, 8
  1959. PSUBUSW XMM5, XMM7 ; sred18255
  1960. ; src is now ready
  1961. ; destination
  1962. ; dest18 must be copied because it mustn't be changed
  1963. ; Load data into memory
  1964. MOVDQU XMM3, [RDI] ;dest 1-8
  1965. MOVQ2DQ XMM6, MMX4
  1966. PSHUFD XMM6, XMM6, 0
  1967. MOVDQU XMM7, XMM3
  1968. PAND XMM7, XMM6 ; dred18
  1969. PSRLW XMM7, 8
  1970. ; dred18alpha = dred18 * negalpha
  1971. PMULLW XMM7, XMM4 ; dred18alpha
  1972. ; dest is prepared
  1973. ; combining dest and src
  1974. ; dred18big = sred18255 + dred18alpha
  1975. PADDUSW XMM7, XMM5 ; dred18big
  1976. ; dred18f = dred18big && destMaskred128 because >> 11 and << 11 is && mask
  1977. PAND XMM7, XMM6 ; dred18f
  1978. ; dest18nr0 = dest18 && (~destMaskred128)
  1979. PANDN XMM6, XMM3 ; dest18nr0
  1980. ; dest18nrf = dest18nr0 || dred18f
  1981. POR XMM6, XMM7
  1982. MOVDQU XMM3, XMM6
  1983. ; red is calculated
  1984. ; calculate green:
  1985. ; get source
  1986. ; sgreen14 = src14 && (srcMask <<8)
  1987. ; srcMask << 8
  1988. MOVQ2DQ XMM7, MMX3
  1989. PSHUFD XMM7, XMM7, 0
  1990. MOVDQU XMM5, XMM1
  1991. PSLLD XMM7, 8
  1992. PAND XMM5, XMM7 ; sgreen14
  1993. PSRLD XMM5, 8
  1994. ; sgreen14s = shuffled sgreen14
  1995. PSHUFHW XMM5, XMM5,85H
  1996. MOVDQU XMM6, XMM2
  1997. PSHUFLW XMM5, XMM5,85H
  1998. PAND XMM6, XMM7 ; sgreen58
  1999. PSRLD XMM6, 8
  2000. PSHUFD XMM5, XMM5,0D0H ; sgreen14s
  2001. ; sgreen58 = src58&& (srcMask << 8)
  2002. ; src58 must be copied because it mustn't be changed
  2003. ; sgreen58s = shuffled sgreen58
  2004. PSHUFHW XMM6, XMM6,85H
  2005. PSHUFLW XMM6, XMM6,58H
  2006. PSHUFD XMM6, XMM6,5CH ; sgreen58s
  2007. ; sgreen18 = sgreen14s || sgreen58s
  2008. POR XMM5, XMM6 ; sgreen18
  2009. ; sgreen18255 = sgreen18 * 256- sgreen18
  2010. MOVDQU XMM7, XMM5
  2011. MOVQ2DQ XMM6, MMX5
  2012. PSLLW XMM5, 8
  2013. PSUBUSW XMM5, XMM7 ; sgreen18255
  2014. PSHUFD XMM6, XMM6, 0
  2015. MOVDQU XMM7, XMM3
  2016. PAND XMM7, XMM6 ; dgreen18
  2017. PSRLW XMM7,3
  2018. ; dgreen18alpha = dgreen18 * negalpha
  2019. PMULLW XMM7, XMM4 ; dgreen18alpha
  2020. ; dest is prepared
  2021. ; combining dest and src
  2022. ; dgreen18big = sgreen18255 + dgreen18alpha
  2023. PADDUSW XMM7, XMM5 ; dgreen18big
  2024. PANDN XMM6, XMM3 ; dest18ng0
  2025. ; dgreen18f = (dgreen18big >> 11) <<5
  2026. PSRLW XMM7, 10 ; dgreen18f
  2027. PSLLW XMM7, 5
  2028. ; dest18ng0 = dest18 && (~destMaskgreen128)
  2029. ; dest18ngf = dest18ng0 || dred18f
  2030. POR XMM6, XMM7
  2031. MOVDQU XMM3, XMM6
  2032. ; green is calculated
  2033. ; calculate blue
  2034. ; get source
  2035. ; sblue14 = src14 && (srcMask)
  2036. ; srcMask
  2037. MOVQ2DQ XMM7, MMX3
  2038. MOVDQU XMM5, XMM1
  2039. PSHUFD XMM7, XMM7, 0
  2040. MOVDQU XMM6, XMM2
  2041. ; sblue14 = src14 && (srcMask)
  2042. ; src14 must be copied because it mustn't be changed
  2043. PAND XMM5, XMM7 ; sblue14
  2044. ; sblue14s = shuffled sblue14
  2045. PSHUFHW XMM5, XMM5,85H
  2046. PAND XMM6, XMM7 ; sblue58
  2047. PSHUFHW XMM6, XMM6,85H
  2048. PSHUFLW XMM5, XMM5,85H
  2049. PSHUFLW XMM6, XMM6,58H
  2050. PSHUFD XMM5, XMM5,0D0H ; sblue14s
  2051. PSHUFD XMM6, XMM6,5CH ; sblue58s
  2052. POR XMM5, XMM6 ; sblue18
  2053. ; sblue18255 = sblue18 * 256- sblue18
  2054. MOVDQU XMM7, XMM5
  2055. PSLLW XMM5, 8
  2056. PSUBUSW XMM5, XMM7 ; sblue18255
  2057. MOVQ2DQ XMM6, MMX6
  2058. PSHUFD XMM6, XMM6, 0
  2059. MOVDQU XMM7, XMM3
  2060. PAND XMM7, XMM6 ; dblue18
  2061. PSLLW XMM7, 3
  2062. PMULLW XMM7, XMM4 ; dblue18alpha
  2063. ; dest is prepared
  2064. ; combining dest and src
  2065. ; dblue18big = sblue18255 + dblue18alpha
  2066. PADDUSW XMM7, XMM5 ; dblue18big
  2067. ; dblue18f = (dblue18big >> 11)
  2068. PANDN XMM6, XMM3 ; dest18nr0
  2069. PSRLW XMM7, 11 ; dblue18f
  2070. ; dest18nr0 = dest18 && (~destMaskblue128)
  2071. ; dest18nbf = dest18nb0 || dblue18f
  2072. POR XMM6, XMM7
  2073. MOVDQU XMM3, XMM6
  2074. ; blue is calculated
  2075. ; now dest is calculated, store it
  2076. ; get 0 stuff
  2077. MOVDQU XMM5, [RDI]
  2078. PAND XMM5,XMM0
  2079. PANDN XMM0, XMM3
  2080. POR XMM0, XMM5
  2081. MOVDQU [RDI],XMM0
  2082. PREFETCHNTA [RDI + 16] ; prepare dest 9-15
  2083. endloop:
  2084. ADD RSI, 32 ; num of bytes
  2085. ADD RDI, 16
  2086. SUB ECX, 8
  2087. JMP WORD loop
  2088. singlepixel: ; original code from MMXBGRA8888Over565, adjusted to fit this procedure
  2089. MOV EAX, 0FFFFFFFFH
  2090. MOVD MMX7, EAX
  2091. PUNPCKLBW MMX7, MMX0 ; 00FF00FF00FF00FF
  2092. MOV EAX,[RSI]
  2093. XOR EBX, EBX
  2094. MOV BX, [RDI]
  2095. ; 255 - alpha
  2096. MOV EDX, EAX
  2097. SHR EDX, 24
  2098. CMP EDX, 0
  2099. JE WORD empty
  2100. CMP EDX, 255
  2101. JE full
  2102. alpha:
  2103. NEG EDX
  2104. ADD EDX, 255
  2105. MOVD MMX6, EDX
  2106. PUNPCKLWD MMX6, MMX6
  2107. PUNPCKLDQ MMX6, MMX6
  2108. MOVD MMX1, EAX
  2109. ; unpack dst
  2110. MOV EDX, EBX ; b
  2111. SHL EDX, 3
  2112. AND EDX, 0F8H
  2113. MOV EAX, EDX
  2114. MOV EDX, EBX ; g
  2115. SHL EDX, 5
  2116. AND EDX, 0FC00H
  2117. OR EAX, EDX
  2118. MOV EDX, EBX ; r
  2119. SHL EDX, 8
  2120. AND EDX, 0F80000H
  2121. OR EAX, EDX
  2122. MOVD MMX2, EAX
  2123. PUNPCKLBW MMX1, MMX0 ; 0000ARGB --> 0A0R0G0B
  2124. PMULLW MMX1, MMX7
  2125. PUNPCKLBW MMX2, MMX0 ; 0000ARGB --> 0A0R0G0B
  2126. PMULLW MMX2, MMX6
  2127. PADDUSW MMX1, MMX2
  2128. ; PSRLW MM1, 8 ; normalize
  2129. DB 0FH, 71H, 0D1H, 08H
  2130. PACKUSWB MMX1, MMX0
  2131. ; HUGA BIMBO Muell
  2132. MOVD EAX, MMX1
  2133. full:
  2134. MOV EBX, EAX
  2135. AND EBX, 0FFH
  2136. SHR EBX, 3
  2137. MOV EDX, EBX
  2138. MOV EBX, EAX
  2139. SHR EBX, 8
  2140. AND EBX, 0FFH
  2141. SHR EBX, 2
  2142. SHL EBX, 5
  2143. OR EDX, EBX
  2144. MOV EBX, EAX
  2145. SHR EBX, 16
  2146. AND EBX, 0FFH
  2147. SHR EBX, 3
  2148. SHL EBX, 11
  2149. OR EDX, EBX
  2150. MOV [RDI], DX
  2151. empty:
  2152. ADD RSI, 4;
  2153. ADD RDI, 2;
  2154. DEC ECX
  2155. JMP WORD loop
  2156. end:
  2157. EMMS ; declare FPU registers free
  2158. POP RBX
  2159. POPFQ
  2160. END SSE2BGRA8888Over565;
  2161. (** find (optimized) pixel transfer procedure for transfer mode and given source and destination formats **)
  2162. PROCEDURE Bind* (VAR mode: Mode; VAR src, dst: Format);
  2163. VAR op: LONGINT; val,i: LONGINT;
  2164. BEGIN
  2165. IF Same(src, mode.src) & Same(dst, mode.dst) THEN
  2166. ASSERT(mode.transfer # NIL, 120);
  2167. RETURN (* assume transfer procedure is still valid *)
  2168. END;
  2169. mode.src := src; mode.dst := dst; mode.buf := mode.col;
  2170. IF (src.pal # NIL) & ((mode.map = NIL) OR (LEN(mode.map^) # src.pal.used) ) THEN
  2171. NEW(mode.map, src.pal.used)
  2172. END;
  2173. (* try to convert complex composite operations into simpler ones *)
  2174. IF alpha IN src.components * dst.components THEN (* source and destination contain alpha information *)
  2175. op := mode.op
  2176. ELSIF alpha IN src.components THEN (* only source contains alpha *)
  2177. CASE mode.op OF
  2178. | dstOverSrc: op := dstCopy
  2179. | srcInDst: op := srcCopy
  2180. | srcWithoutDst: op := clear
  2181. | srcAtopDst: op := srcOverDst
  2182. | dstAtopSrc: op := dstInSrc
  2183. | srcXorDst: op := dstWithoutSrc
  2184. ELSE op := mode.op
  2185. END
  2186. ELSIF alpha IN dst.components THEN (* only destination contains alpha *)
  2187. CASE mode.op OF
  2188. | srcOverDst: op := srcCopy
  2189. | dstInSrc: op := dstCopy
  2190. | dstWithoutSrc: op := clear
  2191. | srcAtopDst: op := srcInDst
  2192. | dstAtopSrc: op := dstOverSrc
  2193. | srcXorDst: op := srcWithoutDst
  2194. ELSE op := mode.op
  2195. END
  2196. ELSE (* no alpha in either source or destination *)
  2197. CASE mode.op OF
  2198. | srcOverDst, srcInDst, srcAtopDst: op := srcCopy
  2199. | dstOverSrc, dstInSrc, dstAtopSrc: op := dstCopy
  2200. | srcWithoutDst, dstWithoutSrc, srcXorDst: op := clear
  2201. ELSE op := mode.op
  2202. END
  2203. END;
  2204. IF op = InvDst THEN
  2205. mode.transfer:=InvAny;
  2206. ELSIF op = InvOverDst THEN
  2207. mode.transfer:=InvOverAny;
  2208. ELSIF op = clear THEN
  2209. CASE dst.code OF
  2210. | a1: mode.transfer := Clear1
  2211. | a8, bgr555, bgr565, bgr466, bgr888, bgra8888: mode.transfer := ClearBytes
  2212. | p8:
  2213. mode.buf[0] := CHR(CLUTs.Match(dst.pal.clut, 0));
  2214. IF mode.buf[0] = 0X THEN mode.transfer := ClearBytes
  2215. ELSE mode.transfer := ConstCopy8
  2216. END
  2217. | d8:
  2218. mode.buf[0] := CHR(ColorToIndex(0));
  2219. IF mode.buf[0] = 0X THEN mode.transfer := ClearBytes
  2220. ELSE mode.transfer := ConstCopy8
  2221. END
  2222. | p16:
  2223. val:=CLUTs.Match(dst.pal.clut, 0);
  2224. IF dst.pal.used>256 THEN val:=val*dst.pal.used DIV 256 END;
  2225. SYSTEM.PUT16(ADDRESSOF(mode.buf[0]),SHORT(val)); (*PH090122*)
  2226. (*mode.buf[0] := CHR(PaletteIndex(dst.pal, 0, 0, 0));*)
  2227. IF val = 0 THEN mode.transfer := ClearBytes
  2228. ELSE mode.transfer := ConstCopy16
  2229. END
  2230. ELSE mode.transfer := ClearAny
  2231. END
  2232. ELSIF op = srcCopy THEN
  2233. CASE dst.code OF
  2234. | a1:
  2235. CASE src.code OF
  2236. | a1: mode.transfer := Copy1
  2237. | a8: mode.transfer := A8CopyA1
  2238. | bgra8888: mode.transfer := BGRA8888CopyA1
  2239. ELSE
  2240. IF alpha IN src.components THEN mode.transfer := AnyCopyA1
  2241. ELSE mode.transfer := Set1
  2242. END
  2243. END
  2244. | a8:
  2245. CASE src.code OF
  2246. | a1: mode.transfer := A1CopyA8
  2247. | a8: mode.transfer := Copy8
  2248. | bgra8888: mode.transfer := BGRA8888CopyA8
  2249. ELSE
  2250. IF alpha IN src.components THEN mode.transfer := AnyCopyA8
  2251. ELSE mode.buf[0] := 0FFX; mode.transfer := ConstCopy8
  2252. END
  2253. END
  2254. | p8:
  2255. CASE src.code OF
  2256. | a1, a8:
  2257. mode.buf[0] := CHR(CLUTs.Match(dst.pal.clut, ORD(mode.col[b]) + ASH(ORD(mode.col[g]), 8) +
  2258. ASH(ORD(mode.col[r]), 16)));
  2259. mode.transfer := ConstCopy8
  2260. | p8:
  2261. IF src.pal = dst.pal THEN mode.transfer := Copy8
  2262. ELSE
  2263. FOR i := 0 TO src.pal.used-1 DO
  2264. mode.map[i] := SHORT(CLUTs.Match(dst.pal.clut, ORD(src.pal.col[i, b]) + ASH(ORD(src.pal.col[i, g]), 8) +
  2265. ASH(ORD(src.pal.col[i, r]), 16)))
  2266. END;
  2267. mode.transfer := I8CopyI8
  2268. END
  2269. | d8:
  2270. FOR i := 0 TO 255 DO
  2271. mode.map[i] := SHORT(CLUTs.Match(dst.pal.clut, IndexToColor(i) MOD 1000000H))
  2272. END;
  2273. mode.transfer := I8CopyI8
  2274. | bgr555, bgr565, bgr466,p16: mode.transfer := Any16CopyP8
  2275. | bgr888: mode.transfer := BGR888CopyP8
  2276. | bgra8888: mode.transfer := BGRA8888CopyP8
  2277. ELSE mode.transfer := AnyCopyP8
  2278. END
  2279. | d8:
  2280. CASE src.code OF
  2281. | a1, a8:
  2282. mode.buf[0] := CHR(ColorToIndex(
  2283. ORD(mode.col[b]) + ASH(ORD(mode.col[g]), 8) + ASH(ORD(mode.col[r]), 16)));
  2284. mode.transfer := ConstCopy8
  2285. | p8:
  2286. FOR i := 0 TO src.pal.used-1 DO
  2287. mode.map[i] := SHORT(ColorToIndex(
  2288. ORD(src.pal.col[i, b]) + ASH(ORD(src.pal.col[i, g]), 8) + ASH(ORD(src.pal.col[i, r]), 16)))
  2289. END;
  2290. mode.transfer := I8CopyI8
  2291. | d8: mode.transfer := Copy8
  2292. | bgr555, bgr565, bgr466, p16: mode.transfer := Any16CopyD8
  2293. | bgr888: mode.transfer := BGR888CopyD8
  2294. | bgra8888: mode.transfer := BGRA8888CopyD8
  2295. ELSE mode.transfer := AnyCopyD8
  2296. END
  2297. | p16:
  2298. CASE src.code OF
  2299. | a1, a8: dst.pack(dst, ADDRESSOF(mode.buf[0]), 0, mode.col); mode.transfer := ConstCopy16
  2300. | p8: mode.transfer := P8CopyAny16
  2301. | d8: mode.transfer := D8CopyAny16
  2302. | p16:
  2303. IF src.pal = dst.pal THEN mode.transfer := Copy16
  2304. ELSE
  2305. FOR i := 0 TO src.pal.used-1 DO
  2306. val:=CLUTs.Match(dst.pal.clut, ORD(src.pal.col[i, b]) + ASH(ORD(src.pal.col[i, g]), 8) +
  2307. ASH(ORD(src.pal.col[i, r]), 16));
  2308. IF dst.pal.used>256 THEN val := val * dst.pal.used DIV 256 END;
  2309. mode.map[i] := SHORT(val)
  2310. END;
  2311. mode.transfer := I16CopyI16
  2312. END
  2313. | bgr555, bgr565, bgr466: mode.transfer := Any16CopyAny16
  2314. | bgr888: mode.transfer := BGR888CopyAny16
  2315. | bgra8888: mode.transfer := BGRA8888CopyAny16
  2316. ELSE mode.transfer := AnyCopyAny16
  2317. END;
  2318. | bgr555, bgr565, bgr466:
  2319. CASE src.code OF
  2320. | a1, a8: dst.pack(dst, ADDRESSOF(mode.buf[0]), 0, mode.col); mode.transfer := ConstCopy16
  2321. | p8: mode.transfer := P8CopyAny16
  2322. | d8: mode.transfer := D8CopyAny16
  2323. | bgr555, bgr565, bgr466,p16:
  2324. IF src.code = dst.code THEN mode.transfer := Copy16
  2325. ELSE mode.transfer := Any16CopyAny16
  2326. END
  2327. | bgr888: mode.transfer := BGR888CopyAny16
  2328. | bgra8888: mode.transfer := BGRA8888CopyAny16
  2329. ELSE mode.transfer := AnyCopyAny16
  2330. END;
  2331. | bgr888:
  2332. CASE src.code OF
  2333. | a1, a8: mode.buf := mode.col; mode.transfer := ConstCopy24
  2334. | p8: mode.transfer := P8CopyBGR888
  2335. | d8: mode.transfer := D8CopyBGR888
  2336. | p16: mode.transfer := P16CopyBGR888 (*PH090122*)
  2337. | bgr555, bgr565, bgr466: mode.transfer := Any16CopyBGR888
  2338. | bgr888: mode.transfer := Copy24
  2339. | bgra8888: IF SSE2enabled THEN mode.transfer := SSE2BGRA8888CopyBGR888
  2340. ELSE mode.transfer := BGRA8888CopyBGR888
  2341. END;
  2342. ELSE mode.transfer := AnyCopyBGR888
  2343. END
  2344. | bgra8888:
  2345. CASE src.code OF
  2346. | a1: mode.transfer := A1CopyBGRA8888
  2347. | a8: mode.transfer := A8CopyBGRA8888
  2348. | p8: mode.transfer := P8CopyBGRA8888
  2349. | d8: mode.transfer := D8CopyBGRA8888
  2350. | p16: mode.transfer := P16CopyBGRA8888 (*PH090122*)
  2351. | bgr555, bgr565, bgr466: mode.transfer := Any16CopyBGRA8888
  2352. | bgr888: IF SSE2enabled THEN mode.transfer := SSE2BGR888CopyBGRA8888
  2353. ELSE mode.transfer :=BGR888CopyBGRA8888;
  2354. END;
  2355. | bgra8888: mode.transfer := Copy32
  2356. ELSE mode.transfer := AnyCopyBGRA8888
  2357. END
  2358. ELSE
  2359. CASE src.code OF
  2360. | a1: mode.transfer := A1CopyAny
  2361. | p8: mode.transfer := P8CopyAny
  2362. | d8: mode.transfer := D8CopyAny
  2363. | bgr555, bgr565, bgr466,p16: mode.transfer := Any16CopyAny
  2364. | bgr888: mode.transfer := BGR888CopyAny
  2365. | bgra8888: mode.transfer := BGRA8888CopyAny
  2366. ELSE
  2367. IF (src.bpp MOD 8 = 0) & (dst.bpp MOD 8 = 0) THEN mode.transfer := AnyBytesCopyAnyBytes
  2368. ELSE mode.transfer := AnyCopyAny
  2369. END
  2370. END
  2371. END
  2372. ELSIF op = dstOverSrc THEN
  2373. mode.transfer := EmptyTransfer
  2374. ELSIF op = srcOverDst THEN
  2375. CASE dst.code OF
  2376. | a1:
  2377. CASE src.code OF
  2378. | a1: mode.transfer := A1OverA1
  2379. | a8: mode.transfer := A8OverA1
  2380. | bgra8888: mode.transfer := BGRA8888OverA1
  2381. ELSE mode.transfer := AnyOverA1
  2382. END
  2383. | a8:
  2384. CASE src.code OF
  2385. | a1: mode.buf[0] := 0FFX; mode.transfer := A1OverConst8
  2386. | a8: mode.transfer := A8OverA8
  2387. | bgra8888: mode.transfer := BGRA8888OverA8
  2388. ELSE mode.transfer := AnyOverA8
  2389. END
  2390. | bgra8888:
  2391. CASE src.code OF
  2392. | a1: mode.buf := mode.col; mode.transfer := A1OverConst32
  2393. | a8: mode.buf := mode.col; mode.transfer := A8OverAny
  2394. ELSE mode.transfer := BGRA8888OverAny
  2395. END
  2396. ELSE
  2397. CASE src.code OF
  2398. | a1:
  2399. CASE dst.code OF
  2400. | p8:
  2401. mode.buf[0] := CHR(CLUTs.Match(dst.pal.clut, ORD(mode.col[b]) + ASH(ORD(mode.col[g]), 8) +
  2402. ASH(ORD(mode.col[r]), 16)));
  2403. mode.transfer := A1OverConst8
  2404. | d8:
  2405. mode.buf[0] := CHR(ColorToIndex(ORD(mode.col[b]) + ASH(ORD(mode.col[g]), 8) +
  2406. ASH(ORD(mode.col[r]), 16)));
  2407. mode.transfer := A1OverConst8
  2408. | p16: (* this is probably not correct ... *)
  2409. mode.buf[0] := CHR(PaletteIndex(dst.pal, ORD(mode.col[r]), ORD(mode.col[g]), ORD(mode.col[b])));
  2410. mode.transfer := A1OverConst16
  2411. | bgr555, bgr565, bgr466: dst.pack(dst, ADDRESSOF(mode.buf[0]), 0, mode.col); mode.transfer := A1OverConst16
  2412. | bgr888: mode.buf := mode.col; mode.transfer := A1OverConst24
  2413. ELSE mode.transfer := A1OverAny
  2414. END
  2415. | a8: mode.buf := mode.col; mode.transfer := A8OverAny
  2416. | bgra8888:
  2417. CASE dst.code OF
  2418. | bgr555, bgr466, p16: mode.transfer := BGRA8888OverAny16
  2419. | bgr565 : IF MMXenabled THEN
  2420. mode.transfer := MMXBGRA8888Over565;
  2421. IF SSE2enabled THEN mode.transfer := SSE2BGRA8888Over565; END;
  2422. ELSE mode.transfer := BGRA8888Over565
  2423. END
  2424. ELSE mode.transfer := BGRA8888OverAny
  2425. END
  2426. ELSE
  2427. mode.transfer := AnyBlendAny
  2428. END
  2429. END
  2430. ELSE
  2431. mode.transfer := AnyBlendAny
  2432. END;
  2433. ASSERT(mode.transfer # NIL, 120)
  2434. END Bind;
  2435. (**--- Image Operations ---**)
  2436. (** get pixel from image **)
  2437. PROCEDURE Get* (img: Image; x, y: LONGINT; VAR pix: Pixel; VAR mode: Mode);
  2438. VAR bit: LONGINT; adr: ADDRESS;
  2439. BEGIN
  2440. ASSERT((0 <= x) & (x < img.width) & (0 <= y) & (y < img.height), 100);
  2441. bit := x * img.fmt.bpp; adr := img.adr + y * img.bpr + bit DIV 8; bit := bit MOD 8;
  2442. Bind(mode, img.fmt, PixelFormat);
  2443. (*mode.transfer(mode, adr, bit, ADDRESSOF(pix), 0, 1)*)
  2444. mode.transfer(mode, adr, bit, ADDRESSOF(pix[0]), 0, 1) (*PH090122*)
  2445. END Get;
  2446. (** put pixel into image **)
  2447. PROCEDURE Put* (img: Image; x, y: LONGINT; pix: Pixel; VAR mode: Mode);
  2448. VAR bit: LONGINT; adr: ADDRESS;
  2449. BEGIN
  2450. (*ASSERT((0 <= x) & (x < img.width) & (0 <= y) & (y < img.height), 100);*) (*avoid a HALT if roundoff errors from higher levels occur here*)
  2451. IF (0 > x) OR (x >= img.width) OR (0 > y) & (y >= img.height) THEN RETURN END;
  2452. bit := x * img.fmt.bpp; adr := img.adr + y * img.bpr + bit DIV 8; bit := bit MOD 8;
  2453. Bind(mode, PixelFormat, img.fmt);
  2454. mode.transfer(mode, ADDRESSOF(pix[0]), 0, adr, bit, 1)
  2455. END Put;
  2456. (** fill rectangular area **)
  2457. PROCEDURE Fill* (img: Image; llx, lly, urx, ury: LONGINT; pix: Pixel; VAR mode: Mode);
  2458. VAR bit, bb, x, c, t: LONGINT; m: Mode; adr, aa: ADDRESS;
  2459. PROCEDURE Fill16(destAdr: ADDRESS; size: SIZE; filler: LONGINT);
  2460. CODE {SYSTEM.AMD64}
  2461. MOV RDI, [RBP + destAdr]
  2462. MOV RCX, [RBP + size]
  2463. MOV EAX, [RBP + filler]
  2464. CLD
  2465. REP STOSW
  2466. END Fill16;
  2467. BEGIN
  2468. ASSERT((0 <= llx) & (llx < urx) & (urx <= img.width) & (0 <= lly) & (lly < ury) & (ury <= img.height), 100);
  2469. bit := llx * img.fmt.bpp; adr := img.adr + lly * img.bpr + bit DIV 8; bit := bit MOD 8;
  2470. IF (mode.op = srcCopy) & (img.fmt.code IN {bgr565}) THEN (* shortcut for speed in important cases *)
  2471. c := ASH(ORD(pix[b]), -3) + ASH(ASH(ORD(pix[g]), -2), 5) + ASH(ASH(ORD(pix[r]), -3), 11);
  2472. t := urx - llx;
  2473. WHILE lly < ury DO
  2474. Fill16(adr, t, c);
  2475. INC(lly); INC(adr, img.bpr)
  2476. END
  2477. ELSE
  2478. Bind(mode, PixelFormat, img.fmt);
  2479. IF (mode.op IN {clear, srcCopy}) OR (pix[a] = 0FFX) & (mode.op IN {srcOverDst, dstWithoutSrc}) THEN (* dst is replaced *)
  2480. (* copy one pixel to lower left corner of rect *)
  2481. mode.transfer(mode, ADDRESSOF(pix[0]), 0, adr, bit, 1);
  2482. (* copy pixel to rest of bottom row *)
  2483. InitMode(m, srcCopy); Bind(m, img.fmt, img.fmt);
  2484. IF (bit = 0) & (img.fmt.bpp MOD 8 = 0) THEN (* use simple address calculation *)
  2485. bb := img.fmt.bpp DIV 8; aa := adr + bb; x := llx+1;
  2486. WHILE x < urx DO
  2487. m.transfer(m, adr, 0, aa, 0, 1);
  2488. INC(aa, bb); INC(x)
  2489. END
  2490. ELSE
  2491. bb := bit + img.fmt.bpp; aa := adr + bb DIV 8; bb := bb MOD 8; x := llx+1;
  2492. WHILE x < urx DO
  2493. m.transfer(m, adr, bit, aa, bb, 1);
  2494. bb := bb + img.fmt.bpp; aa := aa + bb DIV 8; bb := bb MOD 8; INC(x)
  2495. END
  2496. END;
  2497. (* now copy bottom row to others *)
  2498. INC(lly); aa := adr + img.bpr;
  2499. WHILE lly < ury DO
  2500. m.transfer(m, adr, bit, aa, bit, urx - llx);
  2501. INC(lly); INC(aa, img.bpr)
  2502. END
  2503. ELSE (* fill pixel by pixel *)
  2504. WHILE lly < ury DO
  2505. x := llx; aa := adr; bb := bit;
  2506. WHILE x < urx DO
  2507. mode.transfer(mode, ADDRESSOF(pix[0]), 0, aa, bb, 1);
  2508. bb := bb + img.fmt.bpp; aa := aa + bb DIV 8; bb := bb MOD 8; INC(x)
  2509. END;
  2510. INC(lly); INC(adr, img.bpr)
  2511. END
  2512. END
  2513. END
  2514. END Fill;
  2515. (** clear image **)
  2516. PROCEDURE Clear* (img: Image);
  2517. VAR mode: Mode;
  2518. BEGIN
  2519. InitMode(mode, clear);
  2520. Bind(mode, PixelFormat, img.fmt);
  2521. Fill(img, 0, 0, img.width, img.height, Zero, mode)
  2522. END Clear;
  2523. (** get several pixels and store them in array in requested format **)
  2524. PROCEDURE GetPixels* (img: Image; x, y, w: LONGINT; VAR fmt: Format; VAR buf: ARRAY OF CHAR; ofs : LONGINT; VAR mode: Mode);
  2525. VAR sbit: LONGINT; sadr: ADDRESS;
  2526. BEGIN
  2527. ASSERT((0 <= x) & (x + w <= img.width) & (0 <= y) & (y <= img.height), 100);
  2528. ASSERT(ofs + w * fmt.bpp DIV 8 <= LEN(buf), 101);
  2529. Bind(mode, img.fmt, fmt);
  2530. sbit := x * img.fmt.bpp; sadr := img.adr + y * img.bpr + sbit DIV 8; sbit := sbit MOD 8;
  2531. mode.transfer(mode, sadr, sbit, ADDRESSOF(buf[ofs]), 0, w)
  2532. END GetPixels;
  2533. (** put several pixels from array in given format into image **)
  2534. PROCEDURE PutPixels* (img: Image; x, y, w: LONGINT; VAR fmt: Format; VAR buf: ARRAY OF CHAR; ofs : LONGINT; VAR mode: Mode);
  2535. VAR dbit: LONGINT; dadr: ADDRESS;
  2536. BEGIN
  2537. ASSERT((0 <= x) & (x + w <= img.width) & (0 <= y) & (y <= img.height), 100);
  2538. ASSERT(ofs + w * fmt.bpp DIV 8 <= LEN(buf), 101);
  2539. dbit := x * img.fmt.bpp; dadr := img.adr + y * img.bpr + dbit DIV 8; dbit := dbit MOD 8;
  2540. Bind(mode, fmt, img.fmt);
  2541. mode.transfer(mode, ADDRESSOF(buf[ofs]), 0, dadr, dbit, w)
  2542. END PutPixels;
  2543. (** copy rectangular area to the same or another image in specified mode **)
  2544. PROCEDURE Copy* (src, dst: Image; llx, lly, urx, ury, dx, dy: LONGINT; VAR mode: Mode);
  2545. VAR w, h, sbit, dbit, slen, sb, db, len, l: LONGINT; sadr, dadr, sa, da: ADDRESS;
  2546. BEGIN
  2547. ASSERT((0 <= llx) & (llx <= urx) & (urx <= src.width) & (0 <= lly) & (lly <= ury) & (ury <= src.height), 100);
  2548. ASSERT((0 <= dx) & (dx + urx - llx <= dst.width) & (0 <= dy) & (dy + ury - lly <= dst.height), 101);
  2549. Bind(mode, src.fmt, dst.fmt);
  2550. w := urx - llx; h := ury - lly;
  2551. IF (src # dst) OR (lly > dy) OR (lly = dy) & ((llx > dx) OR (urx <= dx)) THEN (* copy lines bottom-up *)
  2552. sbit := llx * src.fmt.bpp; sadr := src.adr + lly * src.bpr + sbit DIV 8; sbit := sbit MOD 8;
  2553. dbit := dx * dst.fmt.bpp; dadr := dst.adr + dy * dst.bpr + dbit DIV 8; dbit := dbit MOD 8;
  2554. WHILE h > 0 DO
  2555. mode.transfer(mode, sadr, sbit, dadr, dbit, w);
  2556. INC(sadr, src.bpr); INC(dadr, dst.bpr); DEC(h)
  2557. END
  2558. ELSIF lly < dy THEN (* copy lines top-down *)
  2559. sbit := llx * src.fmt.bpp; sadr := src.adr + ury * src.bpr + sbit DIV 8; sbit := sbit MOD 8;
  2560. dbit := dx * dst.fmt.bpp; dadr := dst.adr + (dy + h) * dst.bpr + dbit DIV 8; dbit := dbit MOD 8;
  2561. WHILE h > 0 DO
  2562. DEC(sadr, src.bpr); DEC(dadr, dst.bpr); DEC(h);
  2563. mode.transfer(mode, sadr, sbit, dadr, dbit, w)
  2564. END
  2565. ELSIF llx # dx THEN (* uh oh! overlapping spans *)
  2566. slen := dx + w - urx; (* maximal span length guaranteeing non-overlapping spans *)
  2567. sbit := urx * src.fmt.bpp; sadr := src.adr + lly * src.bpr + sbit DIV 8; sbit := sbit MOD 8;
  2568. dbit := (dx + w) * dst.fmt.bpp; dadr := dst.adr + dy * dst.bpr + dbit DIV 8; dbit := dbit MOD 8;
  2569. WHILE h > 0 DO
  2570. sa := sadr; sb := sbit; da := dadr; db := dbit; len := w;
  2571. WHILE len > 0 DO
  2572. l := slen;
  2573. IF l > len THEN l := len END;
  2574. DEC(sb, l * src.fmt.bpp); INC(sa, sb DIV 8); sb := sb MOD 8;
  2575. DEC(db, l * dst.fmt.bpp); INC(da, db DIV 8); db := db MOD 8;
  2576. mode.transfer(mode, sa, sb, da, db, l);
  2577. DEC(len, l)
  2578. END;
  2579. INC(sadr, src.bpr); INC(dadr, dst.bpr); DEC(h)
  2580. END
  2581. END
  2582. END Copy;
  2583. (** replicate pattern within rectangular area of image using given mode **)
  2584. PROCEDURE FillPattern* (pat, dst: Image; llx, lly, urx, ury, px, py: LONGINT; VAR mode: Mode);
  2585. VAR pw, ph, olx, oby, ilx, olw, irw, dy, sy, dx, sx, ty: LONGINT;
  2586. BEGIN
  2587. ASSERT((0 <= llx) & (llx <= urx) & (urx <= dst.width) & (0 <= lly) & (lly <= ury) & (ury <= dst.height), 100);
  2588. pw := pat.width; ph := pat.height;
  2589. olx := px + (llx - px) DIV pw * pw;
  2590. oby := py + (lly - py) DIV ph * ph;
  2591. ilx := olx + pw; olw := llx - olx;
  2592. irw := (urx - px) MOD pw;
  2593. IF urx - irw < ilx THEN irw := olw + urx - llx END;
  2594. dy := lly; sy := lly - oby;
  2595. IF (oby < lly) & (oby + ph <= ury) THEN
  2596. dx := llx; sx := olw;
  2597. IF (olx < llx) & (ilx <= urx) THEN
  2598. Copy(pat, dst, sx, sy, pw, ph, llx, lly, mode);
  2599. dx := ilx; sx := 0
  2600. END;
  2601. WHILE dx + pw <= urx DO
  2602. Copy(pat, dst, 0, sy, pw, ph, dx, lly, mode);
  2603. INC(dx, pw)
  2604. END;
  2605. IF dx < urx THEN
  2606. Copy(pat, dst, sx, sy, irw, ph, dx, lly, mode)
  2607. END;
  2608. dy := oby + ph; sy := 0
  2609. END;
  2610. WHILE dy + ph <= ury DO
  2611. dx := llx; sx := olw;
  2612. IF (olx < llx) & (ilx <= urx) THEN
  2613. Copy(pat, dst, sx, 0, pw, ph, llx, dy, mode);
  2614. dx := ilx; sx := 0
  2615. END;
  2616. WHILE dx + pw <= urx DO
  2617. Copy(pat, dst, 0, 0, pw, ph, dx, dy, mode);
  2618. INC(dx, pw)
  2619. END;
  2620. IF dx < urx THEN
  2621. Copy(pat, dst, sx, 0, irw, ph, dx, dy, mode)
  2622. END;
  2623. INC(dy, ph)
  2624. END;
  2625. IF dy < ury THEN
  2626. ty := sy + ury - dy;
  2627. dx := llx; sx := olw;
  2628. IF (olx < llx) & (ilx <= urx) THEN
  2629. Copy(pat, dst, sx, sy, pw, ty, llx, dy, mode);
  2630. dx := ilx; sx := 0
  2631. END;
  2632. WHILE dx + pw <= urx DO
  2633. Copy(pat, dst, 0, sy, pw, ty, dx, dy, mode);
  2634. INC(dx, pw)
  2635. END;
  2636. IF dx < urx THEN
  2637. Copy(pat, dst, sx, sy, irw, ty, dx, dy, mode)
  2638. END
  2639. END
  2640. END FillPattern;
  2641. (** darken image while maintaining coverage **)
  2642. PROCEDURE Darken* (img: Image; factor: REAL);
  2643. VAR s, i, j, k, y, x, bit: LONGINT; adr: ADDRESS; clamp: ARRAY 256 OF CHAR; pix: Pixel;
  2644. BEGIN
  2645. s := ABS(ENTIER(255*factor + 0.5));
  2646. IF (s # 255) & (img.fmt.components # {alpha}) THEN
  2647. i := 256; j := 256*s;
  2648. REPEAT
  2649. DEC(i); DEC(j, s); k := j DIV 255;
  2650. IF k <= 255 THEN clamp[i] := CHR(k) ELSE clamp[i] := 0FFX END
  2651. UNTIL i = 0;
  2652. y := 0;
  2653. WHILE y < img.height DO
  2654. x := 0; adr := img.adr + y * img.bpr; bit := 0;
  2655. WHILE x < img.width DO
  2656. img.fmt.unpack(img.fmt, adr, bit, pix);
  2657. pix[r] := clamp[ORD(pix[r])]; pix[g] := clamp[ORD(pix[g])]; pix[b] := clamp[ORD(pix[b])];
  2658. img.fmt.pack(img.fmt, adr, bit, pix);
  2659. bit := bit + img.fmt.bpp; INC(adr, bit); bit := bit MOD 8;
  2660. INC(x)
  2661. END;
  2662. INC(y)
  2663. END
  2664. END
  2665. END Darken;
  2666. (** fade image **)
  2667. PROCEDURE Fade* (img: Image; factor: REAL);
  2668. VAR s, i, j, k, y, x, bit: LONGINT; adr: ADDRESS; clamp: ARRAY 256 OF CHAR; pix: Pixel;
  2669. BEGIN
  2670. s := ABS(ENTIER(255*factor + 0.5));
  2671. IF s = 0 THEN
  2672. Clear(img)
  2673. ELSIF s # 255 THEN
  2674. i := 256; j := 256*s;
  2675. REPEAT
  2676. DEC(i); DEC(j, s); k := j DIV 255;
  2677. IF k <= 255 THEN clamp[i] := CHR(k) ELSE clamp[i] := 0FFX END
  2678. UNTIL i = 0;
  2679. y := 0;
  2680. WHILE y < img.height DO
  2681. x := 0; adr := img.adr + y * img.bpr; bit := 0;
  2682. WHILE x < img.width DO
  2683. img.fmt.unpack(img.fmt, adr, bit, pix);
  2684. pix[r] := clamp[ORD(pix[r])]; pix[g] := clamp[ORD(pix[g])];
  2685. pix[b] := clamp[ORD(pix[b])]; pix[a] := clamp[ORD(pix[a])];
  2686. img.fmt.pack(img.fmt, adr, bit, pix);
  2687. bit := bit + img.fmt.bpp; INC(adr, bit); bit := bit MOD 8;
  2688. INC(x)
  2689. END;
  2690. INC(y)
  2691. END
  2692. END
  2693. END Fade;
  2694. (** make image brighter and more transparent; Opaque(I, f) = Darken(Fade(I, f), 1/f) **)
  2695. PROCEDURE Opaque* (img: Image; factor: REAL);
  2696. VAR s, i, j, k, y, x, bit: LONGINT; adr: ADDRESS; clamp: ARRAY 256 OF CHAR; pix: Pixel;
  2697. BEGIN
  2698. s := ABS(ENTIER(255*factor + 0.5));
  2699. IF s = 0 THEN
  2700. Clear(img)
  2701. ELSIF s # 255 THEN
  2702. i := 256; j := 256*s;
  2703. REPEAT
  2704. DEC(i); DEC(j, s); k := j DIV 255;
  2705. IF k <= 255 THEN clamp[i] := CHR(k) ELSE clamp[i] := 0FFX END
  2706. UNTIL i = 0;
  2707. y := 0;
  2708. WHILE y < img.height DO
  2709. x := 0; adr := img.adr + y * img.bpr; bit := 0;
  2710. WHILE x < img.width DO
  2711. img.fmt.unpack(img.fmt, adr, bit, pix);
  2712. pix[a] := clamp[ORD(pix[a])];
  2713. img.fmt.pack(img.fmt, adr, bit, pix);
  2714. bit := bit + img.fmt.bpp; INC(adr, bit); bit := bit MOD 8;
  2715. INC(x)
  2716. END;
  2717. INC(y)
  2718. END
  2719. END
  2720. END Opaque;
  2721. (** add components of two (faded) images **)
  2722. PROCEDURE Add* (i, j, res: Image);
  2723. VAR y, x, ibit, jbit, rbit, k: LONGINT; iadr, jadr, radr: ADDRESS; ipix, jpix, rpix: Pixel;
  2724. BEGIN
  2725. ASSERT((i.width = j.width) & (i.height = j.height) & (i.width <= res.width) & (i.height <= res.height), 100);
  2726. y := 0;
  2727. WHILE y < i.height DO
  2728. 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;
  2729. WHILE x < i.width DO
  2730. i.fmt.unpack(i.fmt, iadr, ibit, ipix); j.fmt.unpack(j.fmt, jadr, jbit, jpix);
  2731. FOR k := 0 TO 3 DO
  2732. rpix[k] := Clamp[ORD(ipix[k]) + ORD(jpix[k])]
  2733. END;
  2734. res.fmt.pack(res.fmt, radr, rbit, rpix);
  2735. ibit := ibit + i.fmt.bpp; INC(iadr, ibit); ibit := ibit MOD 8;
  2736. jbit := jbit + j.fmt.bpp; INC(jadr, jbit); jbit := jbit MOD 8;
  2737. rbit := rbit + res.fmt.bpp; INC(radr, rbit); rbit := rbit MOD 8;
  2738. INC(x)
  2739. END;
  2740. INC(y)
  2741. END
  2742. END Add;
  2743. (** copy image to another using error diffusion dithering (Floyd-Steinberg) **)
  2744. PROCEDURE Dither* (src, dst: Image);
  2745. TYPE
  2746. error = RECORD r, g, b: LONGINT END;
  2747. VAR
  2748. e351: POINTER TO ARRAY OF error;
  2749. y, x, sb, db, ex, e, e3, e5: LONGINT;
  2750. sadr, dadr, sa, da: ADDRESS;
  2751. e7, e51, e1: error;
  2752. spix, dpix: Pixel;
  2753. BEGIN
  2754. ASSERT((src.width <= dst.width) & (src.height <= dst.height), 100);
  2755. NEW(e351, src.width+2); (* accumulated error for next row *)
  2756. y := 0; sadr := src.adr; dadr := dst.adr;
  2757. WHILE y < src.height DO (* scan from left to right *)
  2758. e7.r := 0; e7.g := 0; e7.b := 0;
  2759. e51.r := 0; e51.g := 0; e51.b := 0;
  2760. e1.r := 0; e1.g := 0; e1.b := 0;
  2761. x := 0; sa := sadr; sb := 0; da := dadr; db := 0;
  2762. WHILE x < src.width DO
  2763. ex := x+1;
  2764. src.fmt.unpack(src.fmt, sa, sb, spix);
  2765. spix[r] := Clamp[200H + ORD(spix[r]) + e351[ex].r + e7.r];
  2766. spix[g] := Clamp[200H + ORD(spix[g]) + e351[ex].g + e7.g];
  2767. spix[b] := Clamp[200H + ORD(spix[b]) + e351[ex].b + e7.b];
  2768. dst.fmt.pack(dst.fmt, da, db, spix);
  2769. dst.fmt.unpack(dst.fmt, da, db, dpix);
  2770. e := ORD(spix[r]) - ORD(dpix[r]); e3 := 3*e DIV 16; e5 := 5*e DIV 16;
  2771. e7.r := 7*e DIV 16; e351[x].r := e3 + e51.r; e51.r := e5 + e1.r; e1.r := e - e3 - e5 - e7.r;
  2772. e := ORD(spix[g]) - ORD(dpix[g]); e3 := 3*e DIV 16; e5 := 5*e DIV 16;
  2773. e7.g := 7*e DIV 16; e351[x].g := e3 + e51.g; e51.g := e5 + e1.g; e1.g := e - e3 - e5 - e7.g;
  2774. e := ORD(spix[b]) - ORD(dpix[b]); e3 := 3*e DIV 16; e5 := 5*e DIV 16;
  2775. e7.b := 7*e DIV 16; e351[x].b := e3 + e51.b; e51.b := e5 + e1.b; e1.b := e - e3 - e5 - e7.b;
  2776. sb := sb + src.fmt.bpp; INC(sa, sb DIV 8); sb := sb MOD 8;
  2777. db := db + dst.fmt.bpp; INC(da, db DIV 8); db := db MOD 8;
  2778. x := ex
  2779. END;
  2780. INC(y); INC(sadr, src.bpr); INC(dadr, dst.bpr);
  2781. IF y < src.height THEN (* scan from right to left *)
  2782. e351[x] := e51;
  2783. e7.r := 0; e7.g := 0; e7.b := 0;
  2784. e51.r := 0; e51.g := 0; e51.b := 0;
  2785. e1.r := 0; e1.g := 0; e1.b := 0;
  2786. INC(sa, src.bpr); INC(da, dst.bpr);
  2787. WHILE x > 0 DO
  2788. ex := x; DEC(x);
  2789. sb := sb - src.fmt.bpp; INC(sa, sb DIV 8); sb := sb MOD 8;
  2790. db := db - dst.fmt.bpp; INC(da, db DIV 8); db := db MOD 8;
  2791. src.fmt.unpack(src.fmt, sa, sb, spix);
  2792. spix[r] := Clamp[200H + ORD(spix[r]) + e351[ex].r + e7.r];
  2793. spix[g] := Clamp[200H + ORD(spix[g]) + e351[ex].g + e7.g];
  2794. spix[b] := Clamp[200H + ORD(spix[b]) + e351[ex].b + e7.b];
  2795. dst.fmt.pack(dst.fmt, da, db, spix);
  2796. dst.fmt.unpack(dst.fmt, da, db, dpix);
  2797. INC(ex);
  2798. e := ORD(spix[r]) - ORD(dpix[r]); e3 := 3*e DIV 16; e5 := 5*e DIV 16;
  2799. e7.r := 7*e DIV 16; e351[x].r := e3 + e51.r; e51.r := e5 + e1.r; e1.r := e - e3 - e5 - e7.r;
  2800. e := ORD(spix[g]) - ORD(dpix[g]); e3 := 3*e DIV 16; e5 := 5*e DIV 16;
  2801. e7.g := 7*e DIV 16; e351[x].g := e3 + e51.g; e51.g := e5 + e1.g; e1.g := e - e3 - e5 - e7.g;
  2802. e := ORD(spix[b]) - ORD(dpix[b]); e3 := 3*e DIV 16; e5 := 5*e DIV 16;
  2803. e7.b := 7*e DIV 16; e351[x].b := e3 + e51.b; e51.b := e5 + e1.b; e1.b := e - e3 - e5 - e7.b
  2804. END;
  2805. e351[1] := e51;
  2806. INC(y); INC(sadr, src.bpr); INC(dadr, dst.bpr)
  2807. END
  2808. END
  2809. END Dither;
  2810. (**--- File I/O ---**)
  2811. (** write image to file rider **)
  2812. PROCEDURE Write* (VAR fr: Streams.Writer; img: Image);
  2813. VAR m: Image; h, w, len: LONGINT; adr, aa: ADDRESS; buf: ARRAY 256 OF CHAR;
  2814. SrcCopy:Mode;
  2815. BEGIN
  2816. InitMode(SrcCopy, srcCopy);
  2817. IF ~(img.fmt.code IN {a1..bgra8888,p16}) THEN
  2818. NEW(m);
  2819. IF img.fmt.components = {color} THEN Create(m, img.width, img.height, BGR888)
  2820. ELSIF img.fmt.components = {alpha} THEN Create(m, img.width, img.height, A8)
  2821. ELSIF img.fmt.components = {index} THEN Create(m, img.width, img.height, D8)
  2822. ELSE Create(m, img.width, img.height, BGRA8888)
  2823. END;
  2824. Copy(img, m, 0, 0, img.width, img.height, 0, 0, SrcCopy);
  2825. img := m
  2826. END;
  2827. fr.RawNum(2); (* version *)
  2828. fr.RawNum(img.fmt.code);
  2829. fr.RawNum(img.width); fr.RawNum(img.height);
  2830. fr.RawNum(ABS(img.bpr));
  2831. h := img.height; adr := img.adr;
  2832. WHILE h > 0 DO
  2833. w := ABS(img.bpr); aa := adr;
  2834. WHILE w > 0 DO
  2835. len := 256;
  2836. IF len > w THEN len := w END;
  2837. SYSTEM.MOVE(aa, ADDRESSOF(buf[0]), len);
  2838. fr.Bytes(buf, 0, len);
  2839. DEC(w, len); INC(aa, len)
  2840. END;
  2841. DEC(h); INC(adr, img.bpr)
  2842. END;
  2843. IF img.fmt.code IN {p8,p16} THEN
  2844. fr.RawNum(img.fmt.pal.used);
  2845. len := 0;
  2846. WHILE len < img.fmt.pal.used DO
  2847. fr.Char(img.fmt.pal.col[len, r]);
  2848. fr.Char(img.fmt.pal.col[len, g]);
  2849. fr.Char(img.fmt.pal.col[len, b]);
  2850. INC(len)
  2851. END
  2852. END;
  2853. fr.Update (* optional *)
  2854. END Write;
  2855. (** read image from file rider **)
  2856. PROCEDURE Read* (VAR fr: Streams.Reader; img: Image);
  2857. VAR ver, code, w, h, bpr, len, bytesRead: LONGINT; adr, aa: ADDRESS; fmt: Format; buf: ARRAY 256 OF CHAR; used: LONGINT;
  2858. BEGIN
  2859. ASSERT(img#NIL,100);
  2860. fr.RawNum(ver); (* know version 1&2*)
  2861. ASSERT(ver IN {1,2},101);
  2862. fr.RawNum(code);
  2863. CASE code OF
  2864. | a1: fmt := A1
  2865. | a8: fmt := A8
  2866. | p8: InitFormat(fmt, p8, 8, 1, {index}, NIL, PackP8, UnpackP8)
  2867. | d8: fmt := D8
  2868. | p16: InitFormat(fmt, p16, 16, 2, {index}, NIL, PackP16, UnpackP16);
  2869. | bgr555: fmt := BGR555
  2870. | bgr565: fmt := BGR565
  2871. | bgr466: fmt := BGR466
  2872. | bgr888: fmt := BGR888
  2873. | bgra8888: fmt := BGRA8888
  2874. END;
  2875. fr.RawNum(w); fr.RawNum(h);
  2876. Create(img, SHORT(w), SHORT(h), fmt);
  2877. fr.RawNum(bpr);
  2878. ASSERT(bpr <= img.bpr);
  2879. adr := img.adr;
  2880. WHILE h > 0 DO
  2881. w := bpr; aa := adr;
  2882. WHILE w > 0 DO
  2883. len := 256;
  2884. IF len > w THEN len := w END;
  2885. fr.Bytes(buf, 0, len, bytesRead); (* ignore bytesRead *)
  2886. SYSTEM.MOVE(ADDRESSOF(buf[0]), aa, len);
  2887. DEC(w, len); INC(aa, len)
  2888. END;
  2889. DEC(h); INC(adr, img.bpr)
  2890. END;
  2891. IF code IN {p8,p16} THEN
  2892. fr.RawNum(used);
  2893. len := 0;
  2894. NEW(img.fmt.pal); img.fmt.pal.Init(used);
  2895. WHILE len < used DO
  2896. fr.Char(img.fmt.pal.col[len, r]);
  2897. fr.Char(img.fmt.pal.col[len, g]);
  2898. fr.Char(img.fmt.pal.col[len, b]);
  2899. img.fmt.pal.col[len, a] := 0FFX;
  2900. INC(len)
  2901. END;
  2902. InitPalette(img.fmt.pal, used, 4)
  2903. END
  2904. END Read;
  2905. (*--- Initialization ---*)
  2906. PROCEDURE InitBitTables;
  2907. VAR b, i: LONGINT;
  2908. BEGIN
  2909. FOR b := 0 TO 0FFH DO
  2910. FOR i := 0 TO 7 DO
  2911. IF ODD(ASH(b, -i)) THEN
  2912. Bit[b, i] := TRUE; Set[b, i] := CHR(b); Clr[b, i] := CHR(b - ASH(1, i))
  2913. ELSE
  2914. Bit[b, i] := FALSE; Set[b, i] := CHR(b + ASH(1, i)); Clr[b, i] := CHR(b)
  2915. END
  2916. END
  2917. END
  2918. END InitBitTables;
  2919. PROCEDURE InitClamp;
  2920. VAR i: LONGINT;
  2921. BEGIN
  2922. FOR i := 0 TO 1FFH DO Clamp[i] := 0X END;
  2923. FOR i := 0 TO 0FFH DO Clamp[200H+i] := CHR(i) END;
  2924. FOR i := 300H TO 4FFH DO Clamp[i] := 0FFX END
  2925. END InitClamp;
  2926. PROCEDURE ToggleMMX*;
  2927. BEGIN
  2928. MMXenabled := ~MMXenabled
  2929. END ToggleMMX;
  2930. PROCEDURE ToggleSSE2*;
  2931. BEGIN
  2932. SSE2enabled := ~SSE2enabled;
  2933. KernelLog.String("SSE2 toggled! Is now: "); KernelLog.Boolean(SSE2enabled);KernelLog.Ln;
  2934. END ToggleSSE2;
  2935. (** Map a color value to an 8-bit CLUT index. Only used if format = index8. *)
  2936. PROCEDURE ColorToIndex*(col: LONGINT): LONGINT;
  2937. BEGIN
  2938. (* default implementation is not very useful and should be overridden. *)
  2939. RETURN SYSTEM.VAL(LONGINT,
  2940. SYSTEM.VAL(SET, ASH(col, 7-23)) * {5..7} +
  2941. SYSTEM.VAL(SET, ASH(col, 4-15)) * {2..4} +
  2942. SYSTEM.VAL(SET, ASH(col, 1-7)) * {0..1})
  2943. END ColorToIndex;
  2944. (** Map an 8-bit CLUT index to a color value. Only used if format = index8. *)
  2945. PROCEDURE IndexToColor*(index: LONGINT): LONGINT;
  2946. BEGIN
  2947. (* default implementation is not very useful and should be overridden. *)
  2948. RETURN
  2949. ASH(SYSTEM.VAL(LONGINT, SYSTEM.VAL(SET, index) * {5..7}), 23-7) +
  2950. ASH(SYSTEM.VAL(LONGINT, SYSTEM.VAL(SET, index) * {2..4}), 15-4) +
  2951. ASH(SYSTEM.VAL(LONGINT, SYSTEM.VAL(SET, index) * {0..1}), 7-1)
  2952. END IndexToColor;
  2953. BEGIN
  2954. MMXenabled := 23 IN Machine.features;
  2955. SSE2enabled := Machine.SSE2Support;
  2956. (* plugin := Displays.registry.Await(""); (* assume only one system-wide D8 display driver *)
  2957. d8display := plugin(Displays.Display); *)
  2958. InitFormat(A1, a1, 1, 1, {alpha}, NIL, PackA1, UnpackA1);
  2959. InitFormat(A8, a8, 8, 1, {alpha}, NIL, PackA8, UnpackA8);
  2960. InitFormat(D8, d8, 8, 1, {index}, NIL, PackD8, UnpackD8);
  2961. InitFormat(BGR555, bgr555, 16, 2, {color}, NIL, PackBGR555, UnpackBGR555);
  2962. InitFormat(BGR565, bgr565, 16, 2, {color}, NIL, PackBGR565, UnpackBGR565);
  2963. InitFormat(BGR466, bgr466, 16, 2, {color}, NIL, PackBGR466, UnpackBGR466);
  2964. InitFormat(BGR888, bgr888, 24, 4, {color}, NIL, PackBGR888, UnpackBGR888);
  2965. InitFormat(BGRA8888, bgra8888, 32, 4, {color, alpha}, NIL, PackBGRA8888, UnpackBGRA8888);
  2966. PixelFormat := BGRA8888;
  2967. Zero[0] := 0X; Zero[1] := 0X; Zero[2] := 0X; Zero[3] := 0X;
  2968. InitBitTables; InitClamp
  2969. END Raster.
  2970. (**
  2971. Remarks
  2972. 1. Images
  2973. 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:
  2974. * an image references a contiguous block of memory holding pixel data
  2975. * the point of reference is the address of the pixel in the lower-left corner
  2976. * pixels are organized in rows (either bottom-up or top-down)
  2977. * rows can be aligned to an arbitrary number of bytes
  2978. * the leftmost pixel in a row has the lowest address of all pixels in that row
  2979. * every pixel uses the same number of bits
  2980. 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()).
  2981. 2. Pixels
  2982. 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.
  2983. 3. Palettes
  2984. 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).
  2985. 4. Formats
  2986. 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
  2987. * the number of bits used per pixel (must be 1, 2, 4, 8, 16, 24 or 32)
  2988. * the set of components stored in a pixel (color, index and/or alpha)
  2989. * a palette if the format uses one
  2990. * procedures for storing (packing) and loading (unpacking) a general pixel
  2991. 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).
  2992. 5. Predefined Formats
  2993. 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.
  2994. * A1 (code a1): one bit alpha, MSB leftmost (corresponds to Oberon display patterns)
  2995. * A8 (code a8): 8 bit alpha (mainly for anti-aliased character patterns)
  2996. * - (code p8): 8 bit indexed with custom palette (Oberon pictures, use InitPaletteFormat to initialize)
  2997. * D8 (code d8): 8 bit indexed with display palette (no palette structure attached)
  2998. * - (code p16): 16 bit indexed with 16bit Palette. This type is, e.g., often used in medical imaging (DICOM-3 standard) (*PH 2004*)
  2999. * BGR555 (code bgr555), BGR565 (code bgr565), BGR466 (code bgr466): 16 bit hi-color
  3000. * BGR888 (code bgr888): 24 bit true-color
  3001. * BGRA8888 (code bgra8888), PixelFormat: 32 bit true-color with alpha channel (general pixel format)
  3002. 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.
  3003. 6. Compositing
  3004. 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:
  3005. * clear: destination becomes black and completely transparent
  3006. * srcCopy: source completely replaces destination (cf. Display.replace)
  3007. * dstCopy: no effect
  3008. * srcOverDst: source replaces destination where source is opaque (cf. Display.paint)
  3009. * dstOverSrc: destination replaces source where destination is opaque
  3010. * srcInDst: source where destination is opaque
  3011. * dstInSrc: destination where source is opaque
  3012. * srcWithoutDest*: source is cleared where destination is opaque
  3013. * dstWithoutSrc*: destination is cleared where source is opaque
  3014. * srcAtopDst*: source replaces destination where destination is opaque
  3015. * dstAtopSrc*: destination replaces source where source is opaque
  3016. * srcXorDst*: destination is cleared where both source and destination are opaque (cf. Display.invert)
  3017. 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.
  3018. 7. Internalization and Externalization
  3019. 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.
  3020. **)