]> git.sesse.net Git - pistorm/blob - platforms/amiga/rtg/rtg_driver_amiga/pigfx.c
Add mask handling to all RTG ops, add real time disassembly output
[pistorm] / platforms / amiga / rtg / rtg_driver_amiga / pigfx.c
1 // PiStorm RTG driver, VBCC edition.
2 // Based in part on the ZZ9000 RTG driver.
3
4 #include <proto/exec.h>
5 #include <proto/expansion.h>
6 #include <proto/dos.h>
7 #include <proto/intuition.h>
8 #include <exec/types.h>
9 #include <exec/memory.h>
10 #include <exec/libraries.h>
11 #include <exec/execbase.h>
12 #include <exec/resident.h>
13 #include <exec/initializers.h>
14 #include <clib/debug_protos.h>
15 #include <string.h>
16 #include <stdint.h>
17 #include "boardinfo.h"
18 #include "rtg_enums.h"
19
20 #define WRITESHORT(cmd, val) *(unsigned short *)((unsigned long)(b->RegisterBase)+cmd) = val;
21 #define WRITELONG(cmd, val) *(unsigned long *)((unsigned long)(b->RegisterBase)+cmd) = val;
22 #define WRITEBYTE(cmd, val) *(unsigned char *)((unsigned long)(b->RegisterBase)+cmd) = val;
23
24 #define CARD_OFFSET   0x70000000
25 #define CARD_REGSIZE  0x00010000
26 #define CARD_MEMSIZE  0x02000000 // 32MB "VRAM"
27 #define CARD_SCRATCH  0x72010000
28
29 #define CHIP_RAM_SIZE 0x00200000 // Chip RAM offset, 2MB
30
31 const unsigned short rgbf_to_rtg[16] = {
32   RTGFMT_8BIT,      // 0x00
33   RTGFMT_8BIT,      // 0x01
34   0,                // 0x02
35   0,                // 0x03
36   0,                // 0x04
37   RTGFMT_RGB555,    // 0x05
38   0,                // 0x06
39   0,                // 0x07
40   RTGFMT_RGB32,     // 0x08
41   RTGFMT_RGB32,     // 0x09
42   RTGFMT_RBG565,    // 0x0A
43   RTGFMT_RGB555,    // 0x0B
44   0,                // 0x0C
45   RTGFMT_RGB555,    // 0x0D
46   0,                // 0x0E
47   0,                // 0x0F
48 };
49
50 struct GFXBase {
51   struct Library libNode;
52   BPTR segList;
53   struct ExecBase* sysBase;
54   struct ExpansionBase* expansionBase;
55 };
56
57 int FindCard(__REGA0(struct BoardInfo* b));
58 int InitCard(__REGA0(struct BoardInfo* b));
59
60 void SetDAC (__REGA0(struct BoardInfo *b), __REGD7(RGBFTYPE format));
61 void SetGC (__REGA0(struct BoardInfo *b), __REGA1(struct ModeInfo *mode_info), __REGD0(BOOL border));
62 void SetColorArray (__REGA0(struct BoardInfo *b), __REGD0(UWORD start), __REGD1(UWORD num));
63 void SetPanning (__REGA0(struct BoardInfo *b), __REGA1(UBYTE *addr), __REGD0(UWORD width), __REGD1(WORD x_offset), __REGD2(WORD y_offset), __REGD7(RGBFTYPE format));
64 UWORD SetSwitch (__REGA0(struct BoardInfo *b), __REGD0(UWORD enabled));
65 UWORD SetDisplay (__REGA0(struct BoardInfo *b), __REGD0(UWORD enabled));
66
67 UWORD CalculateBytesPerRow (__REGA0(struct BoardInfo *b), __REGD0(UWORD width), __REGD7(RGBFTYPE format));
68 APTR CalculateMemory (__REGA0(struct BoardInfo *b), __REGA1(unsigned long addr), __REGD7(RGBFTYPE format));
69 ULONG GetCompatibleFormats (__REGA0(struct BoardInfo *b), __REGD7(RGBFTYPE format));
70
71 LONG ResolvePixelClock (__REGA0(struct BoardInfo *b), __REGA1(struct ModeInfo *mode_info), __REGD0(ULONG pixel_clock), __REGD7(RGBFTYPE format));
72 ULONG GetPixelClock (__REGA0(struct BoardInfo *b), __REGA1(struct ModeInfo *mode_info), __REGD0(ULONG index), __REGD7(RGBFTYPE format));
73 void SetClock (__REGA0(struct BoardInfo *b));
74
75 void SetMemoryMode (__REGA0(struct BoardInfo *b), __REGD7(RGBFTYPE format));
76 void SetWriteMask (__REGA0(struct BoardInfo *b), __REGD0(UBYTE mask));
77 void SetClearMask (__REGA0(struct BoardInfo *b), __REGD0(UBYTE mask));
78 void SetReadPlane (__REGA0(struct BoardInfo *b), __REGD0(UBYTE plane));
79
80 void WaitVerticalSync (__REGA0(struct BoardInfo *b), __REGD0(BOOL toggle));
81
82 void FillRect (__REGA0(struct BoardInfo *b), __REGA1(struct RenderInfo *r), __REGD0(WORD x), __REGD1(WORD y), __REGD2(WORD w), __REGD3(WORD h), __REGD4(ULONG color), __REGD5(UBYTE mask), __REGD7(RGBFTYPE format));
83 void InvertRect (__REGA0(struct BoardInfo *b), __REGA1(struct RenderInfo *r), __REGD0(WORD x), __REGD1(WORD y), __REGD2(WORD w), __REGD3(WORD h), __REGD4(UBYTE mask), __REGD7(RGBFTYPE format));
84 void BlitRect (__REGA0(struct BoardInfo *b), __REGA1(struct RenderInfo *r), __REGD0(WORD x), __REGD1(WORD y), __REGD2(WORD dx), __REGD3(WORD dy), __REGD4(WORD w), __REGD5(WORD h), __REGD6(UBYTE mask), __REGD7(RGBFTYPE format));
85 void BlitRectNoMaskComplete (__REGA0(struct BoardInfo *b), __REGA1(struct RenderInfo *rs), __REGA2(struct RenderInfo *rt), __REGD0(WORD x), __REGD1(WORD y), __REGD2(WORD dx), __REGD3(WORD dy), __REGD4(WORD w), __REGD5(WORD h), __REGD6(UBYTE minterm), __REGD7(RGBFTYPE format));
86 void BlitTemplate (__REGA0(struct BoardInfo *b), __REGA1(struct RenderInfo *r), __REGA2(struct Template *t), __REGD0(WORD x), __REGD1(WORD y), __REGD2(WORD w), __REGD3(WORD h), __REGD4(UBYTE mask), __REGD7(RGBFTYPE format));
87 void BlitPattern (__REGA0(struct BoardInfo *b), __REGA1(struct RenderInfo *r), __REGA2(struct Pattern *p), __REGD0(WORD x), __REGD1(WORD y), __REGD2(WORD w), __REGD3(WORD h), __REGD4(UBYTE mask), __REGD7(RGBFTYPE format));
88 void DrawLine (__REGA0(struct BoardInfo *b), __REGA1(struct RenderInfo *r), __REGA2(struct Line *l), __REGD0(UBYTE mask), __REGD7(RGBFTYPE format));
89
90 void BlitPlanar2Chunky (__REGA0(struct BoardInfo *b), __REGA1(struct BitMap *bm), __REGA2(struct RenderInfo *r), __REGD0(SHORT x), __REGD1(SHORT y), __REGD2(SHORT dx), __REGD3(SHORT dy), __REGD4(SHORT w), __REGD5(SHORT h), __REGD6(UBYTE minterm), __REGD7(UBYTE mask));
91 void BlitPlanar2Direct (__REGA0(struct BoardInfo *b), __REGA1(struct BitMap *bmp), __REGA2(struct RenderInfo *r), __REGA3(struct ColorIndexMapping *clut), __REGD0(SHORT x), __REGD1(SHORT y), __REGD2(SHORT dx), __REGD3(SHORT dy), __REGD4(SHORT w), __REGD5(SHORT h), __REGD6(UBYTE minterm), __REGD7(UBYTE mask));
92
93 static ULONG LibStart(void) {
94   return(-1);
95 }
96
97 static const char LibraryName[] = "PiRTG.card";
98 static const char LibraryID[]   = "$VER: PiRTG.card 0.01\r\n";
99
100 __saveds struct GFXBase* OpenLib(__REGA6(struct GFXBase *gfxbase));
101 BPTR __saveds CloseLib(__REGA6(struct GFXBase *gfxbase));
102 BPTR __saveds ExpungeLib(__REGA6(struct GFXBase *exb));
103 ULONG ExtFuncLib(void);
104 __saveds struct GFXBase* InitLib(__REGA6(struct ExecBase *sysbase),
105                                  __REGA0(BPTR seglist),
106                                  __REGD0(struct GFXBase *exb));
107
108 static const APTR FuncTab[] = {
109   (APTR)OpenLib,
110   (APTR)CloseLib,
111   (APTR)ExpungeLib,
112   (APTR)ExtFuncLib,
113
114   (APTR)FindCard,
115   (APTR)InitCard,
116   (APTR)((LONG)-1)
117 };
118
119 struct InitTable
120 {
121   ULONG LibBaseSize;
122   APTR  FunctionTable;
123   APTR  DataTable;
124   APTR  InitLibTable;
125 };
126
127 static struct InitTable InitTab = {
128   (ULONG) sizeof(struct GFXBase),
129   (APTR) FuncTab,
130   (APTR) NULL,
131   (APTR) InitLib
132 };
133
134 static const struct Resident ROMTag = {
135         RTC_MATCHWORD,
136   &ROMTag,
137   &ROMTag + 1,
138   RTF_AUTOINIT,
139         83,
140   NT_LIBRARY,
141   0,
142   (char *)LibraryName,
143   (char *)LibraryID,
144   (APTR)&InitTab
145 };
146
147 #define CLOCK_HZ 100000000
148
149 static struct GFXBase *_gfxbase;
150 const char *gfxname = "PiStorm RTG";
151 char dummies[128];
152
153 __saveds struct GFXBase* InitLib(__REGA6(struct ExecBase *sysbase),
154                                           __REGA0(BPTR seglist),
155                                           __REGD0(struct GFXBase *exb))
156 {
157   _gfxbase = exb;
158   return _gfxbase;
159 }
160
161 __saveds struct GFXBase* OpenLib(__REGA6(struct GFXBase *gfxbase))
162 {
163   gfxbase->libNode.lib_OpenCnt++;
164   gfxbase->libNode.lib_Flags &= ~LIBF_DELEXP;
165
166   return gfxbase;
167 }
168
169 BPTR __saveds CloseLib(__REGA6(struct GFXBase *gfxbase))
170 {
171   gfxbase->libNode.lib_OpenCnt--;
172
173   if (!gfxbase->libNode.lib_OpenCnt) {
174     if (gfxbase->libNode.lib_Flags & LIBF_DELEXP) {
175       return (ExpungeLib(gfxbase));
176     }
177   }
178   return 0;
179 }
180
181 BPTR __saveds ExpungeLib(__REGA6(struct GFXBase *exb))
182 {
183   BPTR seglist;
184   struct ExecBase *SysBase = *(struct ExecBase **)4L;
185
186   if(!exb->libNode.lib_OpenCnt) {
187     ULONG negsize, possize, fullsize;
188     UBYTE *negptr = (UBYTE *)exb;
189
190     seglist = exb->segList;
191
192     Remove((struct Node *)exb);
193
194     negsize  = exb->libNode.lib_NegSize;
195     possize  = exb->libNode.lib_PosSize;
196     fullsize = negsize + possize;
197     negptr  -= negsize;
198
199     FreeMem(negptr, fullsize);
200     return(seglist);
201   }
202
203   exb->libNode.lib_Flags |= LIBF_DELEXP;
204   return 0;
205 }
206
207 ULONG ExtFuncLib(void)
208 {
209   return 0;
210 }
211
212 static LONG zorro_version = 0;
213
214 static struct GFXData *gfxdata;
215 //MNTZZ9KRegs* registers;
216
217 #define LOADLIB(a, b) if ((a = (struct a*)OpenLibrary(b,0L))==NULL) { \
218     KPrintF("Failed to load %s.\n", b); \
219     return 0; \
220   } \
221
222 static BYTE card_already_found;
223 static BYTE card_initialized;
224
225 int FindCard(__REGA0(struct BoardInfo* b)) {
226   //if (card_already_found)
227 //    return 1;
228   struct ConfigDev* cd = NULL;
229   struct ExpansionBase *ExpansionBase = NULL;
230   struct DOSBase *DOSBase = NULL;
231   struct IntuitionBase *IntuitionBase = NULL;
232   struct ExecBase *SysBase = *(struct ExecBase **)4L;
233
234   LOADLIB(ExpansionBase, "expansion.library");
235   LOADLIB(DOSBase, "dos.library");
236   LOADLIB(IntuitionBase, "intuition.library");
237
238   b->MemorySize = CARD_MEMSIZE;
239   b->RegisterBase = (void *)CARD_OFFSET;
240   b->MemoryBase = (void *)(CARD_OFFSET + CARD_REGSIZE);
241
242   return 1;
243 }
244
245 #define HWSPRITE 1
246 #define VGASPLIT (1 << 6)
247 #define FLICKERFIXER (1 << 12)
248 #define INDISPLAYCHAIN (1 << 20)
249 #define DIRECTACCESS (1 << 26)
250
251 int InitCard(__REGA0(struct BoardInfo* b)) {
252   //if (!card_initialized)
253 //    card_initialized = 1;
254 //  else
255     //return 1;
256
257   int max, i;
258   struct ExecBase *SysBase = *(struct ExecBase **)4L;
259
260   b->CardBase = (struct CardBase *)_gfxbase;
261   b->ExecBase = SysBase;
262   b->BoardName = "PiStorm RTG";
263   b->BoardType = BT_MNT_ZZ9000;
264   b->PaletteChipType = PCT_MNT_ZZ9000;
265   b->GraphicsControllerType = GCT_MNT_ZZ9000;
266
267   b->Flags = BIF_INDISPLAYCHAIN | BIF_GRANTDIRECTACCESS;
268   b->RGBFormats = 1 | 2 | 512 | 1024 | 2048;
269   b->SoftSpriteFlags = 0;
270   b->BitsPerCannon = 8;
271
272   for(i = 0; i < MAXMODES; i++) {
273     b->MaxHorValue[i] = 1920;
274     b->MaxVerValue[i] = 1080;
275     b->MaxHorResolution[i] = 1920;
276     b->MaxVerResolution[i] = 1080;
277     b->PixelClockCount[i] = 1;
278   }
279
280   b->MemoryClock = CLOCK_HZ;
281
282   //b->AllocCardMem = (void *)NULL;
283   //b->FreeCardMem = (void *)NULL;
284   b->SetSwitch = (void *)SetSwitch;
285   b->SetColorArray = (void *)SetColorArray;
286   b->SetDAC = (void *)SetDAC;
287   b->SetGC = (void *)SetGC;
288   b->SetPanning = (void *)SetPanning;
289   b->CalculateBytesPerRow = (void *)CalculateBytesPerRow;
290   b->CalculateMemory = (void *)CalculateMemory;
291   b->GetCompatibleFormats = (void *)GetCompatibleFormats;
292   b->SetDisplay = (void *)SetDisplay;
293
294   b->ResolvePixelClock = (void *)ResolvePixelClock;
295   b->GetPixelClock = (void *)GetPixelClock;
296   b->SetClock = (void *)SetClock;
297
298   b->SetMemoryMode = (void *)SetMemoryMode;
299   b->SetWriteMask = (void *)SetWriteMask;
300   b->SetClearMask = (void *)SetClearMask;
301   b->SetReadPlane = (void *)SetReadPlane;
302
303   b->WaitVerticalSync = (void *)WaitVerticalSync;
304   //b->SetInterrupt = (void *)NULL;
305
306   //b->WaitBlitter = (void *)NULL;
307
308   //b->ScrollPlanar = (void *)NULL;
309   //b->UpdatePlanar = (void *)NULL;
310
311   //b->BlitPlanar2Chunky = (void *)BlitPlanar2Chunky;
312   //b->BlitPlanar2Direct = (void *)NULL;
313
314   b->FillRect = (void *)FillRect;
315   b->InvertRect = (void *)InvertRect;
316   b->BlitRect = (void *)BlitRect;
317   b->BlitTemplate = (void *)BlitTemplate;
318   b->BlitPattern = (void *)BlitPattern;
319   b->DrawLine = (void *)DrawLine;
320   b->BlitRectNoMaskComplete = (void *)BlitRectNoMaskComplete;
321   //b->EnableSoftSprite = (void *)NULL;
322
323   //b->AllocCardMemAbs = (void *)NULL;
324   //b->SetSplitPosition = (void *)NULL;
325   //b->ReInitMemory = (void *)NULL;
326   //b->WriteYUVRect = (void *)NULL;
327   //b->GetVSyncState = (void *)NULL;
328   //b->GetVBeamPos = (void *)NULL;
329   //b->SetDPMSLevel = (void *)NULL;
330   //b->ResetChip = (void *)NULL;
331   //b->GetFeatureAttrs = (void *)NULL;
332   //b->AllocBitMap = (void *)NULL;
333   //b->FreeBitMap = (void *)NULL;
334   //b->GetBitMapAttr = (void *)NULL;
335
336   //b->SetSprite = (void *)NULL;
337   //b->SetSpritePosition = (void *)NULL;
338   //b->SetSpriteImage = (void *)NULL;
339   //b->SetSpriteColor = (void *)NULL;
340
341   //b->CreateFeature = (void *)NULL;
342   //b->SetFeatureAttrs = (void *)NULL;
343   //b->DeleteFeature = (void *)NULL;
344
345   return 1;
346 }
347
348 void SetDAC (__REGA0(struct BoardInfo *b), __REGD7(RGBFTYPE format)) {
349   // Used to set the color format of the video card's RAMDAC.
350   // This needs no handling, since the PiStorm doesn't really have a RAMDAC or a video card chipset.
351 }
352
353 void SetGC (__REGA0(struct BoardInfo *b), __REGA1(struct ModeInfo *mode_info), __REGD0(BOOL border)) {
354   b->ModeInfo = mode_info;
355   // Send width, height and format to the RaspberryPi Targetable Graphics.
356   WRITESHORT(RTG_X1, mode_info->Width);
357   WRITESHORT(RTG_Y1, mode_info->Height);
358   WRITESHORT(RTG_FORMAT, rgbf_to_rtg[b->RGBFormat]);
359   WRITESHORT(RTG_COMMAND, RTGCMD_SETGC);
360 }
361
362 int setswitch = -1;
363 UWORD SetSwitch (__REGA0(struct BoardInfo *b), __REGD0(UWORD enabled)) {
364   if (setswitch != enabled) {
365     setswitch = enabled;
366   }
367   
368   WRITEBYTE(RTG_U81, setswitch);
369   WRITESHORT(RTG_X1, setswitch);
370   WRITESHORT(RTG_COMMAND, RTGCMD_SETSWITCH);
371
372   return 1 - enabled;
373 }
374
375 void SetPanning (__REGA0(struct BoardInfo *b), __REGA1(UBYTE *addr), __REGD0(UWORD width), __REGD1(WORD x_offset), __REGD2(WORD y_offset), __REGD7(RGBFTYPE format)) {
376   // Set the panning offset, or the offset used for the current display area on the Pi.
377   // The address needs to have CARD_BASE subtracted from it to be used as an offset on the Pi side.
378   if (!b)
379     return;
380
381   b->XOffset = x_offset;
382   b->YOffset = y_offset;
383
384   WRITELONG(RTG_ADDR1, (unsigned long)addr);
385   WRITESHORT(RTG_X1, width);
386   WRITESHORT(RTG_X2, b->XOffset);
387   WRITESHORT(RTG_Y2, b->YOffset);
388   WRITESHORT(RTG_COMMAND, RTGCMD_SETPAN);
389 }
390
391 void SetColorArray (__REGA0(struct BoardInfo *b), __REGD0(UWORD start), __REGD1(UWORD num)) {
392   // Sets the color components of X color components for 8-bit paletted display modes.
393   if (!b->CLUT)
394     return;
395   
396   int j = start + num;
397   
398   for(int i = start; i < j; i++) {
399     //WRITEBYTE(RTG_U82, (unsigned char)b->CLUT[i].Red);
400     //WRITEBYTE(RTG_U83, (unsigned char)b->CLUT[i].Green);
401     //WRITEBYTE(RTG_U84, (unsigned char)b->CLUT[i].Blue);
402     unsigned long xrgb = 0 | (b->CLUT[i].Red << 16) | (b->CLUT[i].Green << 8) | (b->CLUT[i].Blue);
403     WRITEBYTE(RTG_U81, (unsigned char)i);
404     WRITELONG(RTG_RGB1, xrgb);
405     WRITESHORT(RTG_COMMAND, RTGCMD_SETCLUT);
406   }
407 }
408
409 UWORD CalculateBytesPerRow (__REGA0(struct BoardInfo *b), __REGD0(UWORD width), __REGD7(RGBFTYPE format)) {
410   if (!b)
411     return 0;
412
413   UWORD pitch = width;
414
415   switch(format) {
416     default:
417       return pitch;
418     case 0x05: case 0x0A: case 0x0B: case 0x0D:
419       return (width * 2);
420     case 0x08: case 0x09:
421       return (width * 4);
422   }
423 }
424
425 APTR CalculateMemory (__REGA0(struct BoardInfo *b), __REGA1(unsigned long addr), __REGD7(RGBFTYPE format)) {
426   /*if (!b)
427     return (APTR)addr;
428
429   if (addr > (unsigned int)b->MemoryBase && addr < (((unsigned int)b->MemoryBase) + b->MemorySize)) {
430     addr = ((addr + 0x1000) & 0xFFFFF000);
431   }*/
432
433   return (APTR)addr;
434 }
435
436 ULONG GetCompatibleFormats (__REGA0(struct BoardInfo *b), __REGD7(RGBFTYPE format)) {
437   // It is of course compatible with all the formats ever.
438   return 0xFFFFFFFF;
439 }
440
441 static int display_enabled = 0;
442 UWORD SetDisplay (__REGA0(struct BoardInfo *b), __REGD0(UWORD enabled)) {
443   // Enables or disables the display.
444   WRITEBYTE(RTG_U82, (unsigned char)enabled);
445   WRITESHORT(RTG_COMMAND, RTGCMD_SETDISPLAY);
446
447   return 1;
448 }
449
450 LONG ResolvePixelClock (__REGA0(struct BoardInfo *b), __REGA1(struct ModeInfo *mode_info), __REGD0(ULONG pixel_clock), __REGD7(RGBFTYPE format)) {
451   mode_info->PixelClock = CLOCK_HZ;
452   mode_info->pll1.Clock = 0;
453   mode_info->pll2.ClockDivide = 1;
454
455   return 0;
456 }
457
458 ULONG GetPixelClock (__REGA0(struct BoardInfo *b), __REGA1(struct ModeInfo *mode_info), __REGD0(ULONG index), __REGD7(RGBFTYPE format)) {
459   // Just return 100MHz.
460   return CLOCK_HZ;
461 }
462
463 // None of these five really have to do anything.
464 void SetClock (__REGA0(struct BoardInfo *b)) {
465 }
466
467 void SetMemoryMode (__REGA0(struct BoardInfo *b), __REGD7(RGBFTYPE format)) {
468 }
469
470 void SetWriteMask (__REGA0(struct BoardInfo *b), __REGD0(UBYTE mask)) {
471 }
472
473 void SetClearMask (__REGA0(struct BoardInfo *b), __REGD0(UBYTE mask)) {
474 }
475
476 void SetReadPlane (__REGA0(struct BoardInfo *b), __REGD0(UBYTE plane)) {
477 }
478
479 void WaitVerticalSync (__REGA0(struct BoardInfo *b), __REGD0(BOOL toggle)) {
480   // I don't know why this one has a bool in D0, but it isn't used for anything.
481 }
482
483 void FillRect (__REGA0(struct BoardInfo *b), __REGA1(struct RenderInfo *r), __REGD0(WORD x), __REGD1(WORD y), __REGD2(WORD w), __REGD3(WORD h), __REGD4(ULONG color), __REGD5(UBYTE mask), __REGD7(RGBFTYPE format)) {
484   if (!r)
485     return;
486
487   WRITELONG(RTG_ADDR1, (unsigned long)r->Memory);
488   
489   WRITESHORT(RTG_FORMAT, rgbf_to_rtg[format]);
490   WRITESHORT(RTG_X1, x);
491   WRITESHORT(RTG_X2, w);
492   WRITESHORT(RTG_Y1, y);
493   WRITESHORT(RTG_Y2, h);
494   WRITELONG(RTG_RGB1, color);
495   WRITESHORT(RTG_X3, r->BytesPerRow);
496   WRITEBYTE(RTG_U81, mask);
497   WRITESHORT(RTG_COMMAND, RTGCMD_FILLRECT);
498 }
499
500 void InvertRect (__REGA0(struct BoardInfo *b), __REGA1(struct RenderInfo *r), __REGD0(WORD x), __REGD1(WORD y), __REGD2(WORD w), __REGD3(WORD h), __REGD4(UBYTE mask), __REGD7(RGBFTYPE format)) {
501   if (!r)
502     return;
503   WRITELONG(RTG_ADDR1, (unsigned long)r->Memory);
504   
505   WRITESHORT(RTG_FORMAT, rgbf_to_rtg[format]);
506   WRITESHORT(RTG_X1, x);
507   WRITESHORT(RTG_X2, w);
508   WRITESHORT(RTG_Y1, y);
509   WRITESHORT(RTG_Y2, h);
510   WRITESHORT(RTG_X3, r->BytesPerRow);
511   WRITEBYTE(RTG_U81, mask);
512   WRITESHORT(RTG_COMMAND, RTGCMD_INVERTRECT);
513 }
514
515 void BlitRect (__REGA0(struct BoardInfo *b), __REGA1(struct RenderInfo *r), __REGD0(WORD x), __REGD1(WORD y), __REGD2(WORD dx), __REGD3(WORD dy), __REGD4(WORD w), __REGD5(WORD h), __REGD6(UBYTE mask), __REGD7(RGBFTYPE format)) {
516   if (!r)
517     return;
518
519   WRITELONG(RTG_ADDR1, (unsigned long)r->Memory);
520
521   WRITESHORT(RTG_FORMAT, rgbf_to_rtg[format]);
522   WRITESHORT(RTG_X1, x);
523   WRITESHORT(RTG_X2, dx);
524   WRITESHORT(RTG_X3, w);
525   WRITESHORT(RTG_Y1, y);
526   WRITESHORT(RTG_Y2, dy);
527   WRITESHORT(RTG_Y3, h);
528   WRITESHORT(RTG_X4, r->BytesPerRow);
529   WRITEBYTE(RTG_U81, mask);
530   WRITESHORT(RTG_COMMAND, RTGCMD_BLITRECT);
531 }
532
533 void BlitRectNoMaskComplete (__REGA0(struct BoardInfo *b), __REGA1(struct RenderInfo *rs), __REGA2(struct RenderInfo *rt), __REGD0(WORD x), __REGD1(WORD y), __REGD2(WORD dx), __REGD3(WORD dy), __REGD4(WORD w), __REGD5(WORD h), __REGD6(UBYTE minterm), __REGD7(RGBFTYPE format)) {
534   if (!rs || !rt)
535     return;
536
537   WRITESHORT(RTG_FORMAT, rgbf_to_rtg[format]);
538   WRITELONG(RTG_ADDR1, (unsigned long)rs->Memory);
539   WRITELONG(RTG_ADDR2, (unsigned long)rt->Memory);
540   WRITESHORT(RTG_X1, x);
541   WRITESHORT(RTG_X2, dx);
542   WRITESHORT(RTG_X3, w);
543   WRITESHORT(RTG_Y1, y);
544   WRITESHORT(RTG_Y2, dy);
545   WRITESHORT(RTG_Y3, h);
546   WRITESHORT(RTG_X4, rs->BytesPerRow);
547   WRITESHORT(RTG_X5, rt->BytesPerRow);
548   WRITEBYTE(RTG_U81, minterm);
549   WRITESHORT(RTG_COMMAND, RTGCMD_BLITRECT_NOMASK_COMPLETE);
550 }
551
552 void BlitTemplate (__REGA0(struct BoardInfo *b), __REGA1(struct RenderInfo *r), __REGA2(struct Template *t), __REGD0(WORD x), __REGD1(WORD y), __REGD2(WORD w), __REGD3(WORD h), __REGD4(UBYTE mask), __REGD7(RGBFTYPE format)) {
553   if (!r || !t) return;
554   if (w < 1 || h < 1) return;
555
556   WRITELONG(RTG_ADDR2, (unsigned long)r->Memory);
557
558   WRITESHORT(RTG_FORMAT, rgbf_to_rtg[format]);
559   WRITESHORT(RTG_X1, x);
560   WRITESHORT(RTG_X2, w);
561   WRITESHORT(RTG_X3, t->XOffset);
562   WRITESHORT(RTG_Y1, y);
563   WRITESHORT(RTG_Y2, h);
564   WRITESHORT(RTG_Y3, 0);
565
566   if ((unsigned long)t->Memory > CHIP_RAM_SIZE) {
567     WRITELONG(RTG_ADDR1, (unsigned long)t->Memory);
568   }
569   else {
570     unsigned long dest = CARD_SCRATCH;
571     memcpy((unsigned char *)dest, t->Memory, (t->BytesPerRow * h));
572     WRITELONG(RTG_ADDR1, (unsigned long)dest);
573     WRITELONG(RTG_ADDR3, (unsigned long)t->Memory);
574   }
575
576   WRITELONG(RTG_RGB1, t->FgPen);
577   WRITELONG(RTG_RGB2, t->BgPen);
578
579   WRITESHORT(RTG_X4, r->BytesPerRow);
580   WRITESHORT(RTG_X5, t->BytesPerRow);
581
582   WRITEBYTE(RTG_U81, mask);
583   WRITEBYTE(RTG_U82, t->DrawMode);
584   WRITESHORT(RTG_COMMAND, RTGCMD_BLITTEMPLATE);
585 }
586
587 void BlitPattern (__REGA0(struct BoardInfo *b), __REGA1(struct RenderInfo *r), __REGA2(struct Pattern *p), __REGD0(WORD x), __REGD1(WORD y), __REGD2(WORD w), __REGD3(WORD h), __REGD4(UBYTE mask), __REGD7(RGBFTYPE format)) {
588   if (!r || !p) return;
589   if (w < 1 || h < 1) return;
590
591   WRITELONG(RTG_ADDR2, (unsigned long)r->Memory);
592
593   WRITESHORT(RTG_FORMAT, rgbf_to_rtg[format]);
594   WRITESHORT(RTG_X1, x);
595   WRITESHORT(RTG_X2, w);
596   WRITESHORT(RTG_X3, p->XOffset);
597   WRITESHORT(RTG_Y1, y);
598   WRITESHORT(RTG_Y2, h);
599   WRITESHORT(RTG_Y3, p->YOffset);
600
601   if ((unsigned long)p->Memory > CHIP_RAM_SIZE) {
602     WRITELONG(RTG_ADDR1, (unsigned long)p->Memory);
603   }
604   else {
605     unsigned long dest = CARD_SCRATCH;
606     memcpy((unsigned char *)dest, p->Memory, (2 * (1 << p->Size)));
607     WRITELONG(RTG_ADDR1, (unsigned long)dest);
608   }
609
610   WRITELONG(RTG_RGB1, p->FgPen);
611   WRITELONG(RTG_RGB2, p->BgPen);
612
613   WRITESHORT(RTG_X4, r->BytesPerRow);
614   WRITESHORT(RTG_X5, (1 << p->Size));
615
616   WRITEBYTE(RTG_U81, mask);
617   WRITEBYTE(RTG_U82, p->DrawMode);
618   WRITEBYTE(RTG_U83, (1 << p->Size));
619   WRITESHORT(RTG_COMMAND, RTGCMD_BLITPATTERN);
620 }
621
622 void DrawLine (__REGA0(struct BoardInfo *b), __REGA1(struct RenderInfo *r), __REGA2(struct Line *l), __REGD0(UBYTE mask), __REGD7(RGBFTYPE format)) {
623   if (!r || !b) return;
624
625   WRITELONG(RTG_ADDR1, (unsigned long)r->Memory);
626
627   WRITELONG(RTG_RGB1, l->FgPen);
628   WRITELONG(RTG_RGB2, l->BgPen);
629
630   WRITESHORT(RTG_FORMAT, rgbf_to_rtg[format]);
631
632   WRITESHORT(RTG_X1, l->X);
633   WRITESHORT(RTG_X2, l->dX);
634   WRITESHORT(RTG_Y1, l->Y);
635   WRITESHORT(RTG_Y2, l->dY);
636
637   WRITESHORT(RTG_X3, l->Length);
638   WRITESHORT(RTG_Y3, l->LinePtrn);
639
640   WRITESHORT(RTG_X4, r->BytesPerRow);
641   WRITESHORT(RTG_X5, l->PatternShift);
642
643   WRITEBYTE(RTG_U81, mask);
644   WRITEBYTE(RTG_U82, l->DrawMode);
645   WRITEBYTE(RTG_U83, l->pad);
646
647   WRITESHORT(RTG_COMMAND, RTGCMD_DRAWLINE);
648 }
649
650 void BlitPlanar2Chunky_Broken (__REGA0(struct BoardInfo *b), __REGA1(struct BitMap *bm), __REGA2(struct RenderInfo *r), __REGD0(SHORT x), __REGD1(SHORT y), __REGD2(SHORT dx), __REGD3(SHORT dy), __REGD4(SHORT w), __REGD5(SHORT h), __REGD6(UBYTE minterm), __REGD7(UBYTE mask)) {
651   if (!r || !b || !bm) return;
652
653   //unsigned long bmp_size = bm->BytesPerRow * bm->Rows;
654   unsigned char planemask_0 = 0, planemask = 0;
655   //unsigned short line_size = (w >> 3) + 2;
656   //unsigned long output_plane_size = line_size * h;
657   unsigned long plane_size = bm->BytesPerRow * bm->Rows;
658   short x_offset = (x >> 3);
659
660   unsigned long dest = CARD_SCRATCH;
661
662   WRITELONG(RTG_ADDR1, (unsigned long)r->Memory);
663   WRITELONG(RTG_ADDR2, (unsigned long)dest);
664   WRITELONG(RTG_ADDR3, (unsigned long)bm->Planes[0]);
665
666   for (unsigned short i = 0; i < bm->Depth; i++) {
667     if ((unsigned long)bm->Planes[i] == 0xFFFFFFFF) {
668       planemask |= (1 << i);
669     }
670     else if (bm->Planes[i] == NULL) {
671       planemask_0 |= (1 << i);
672     }
673     else {
674       unsigned long bmp_mem = (unsigned long)(bm->Planes[i]) + x_offset + (y * bm->BytesPerRow);
675       unsigned long plane_dest = dest;
676       for (unsigned short y_line = 0; y_line < h; y_line++) {
677         memcpy((unsigned char *)plane_dest, (unsigned char *)bmp_mem, bm->BytesPerRow);
678         plane_dest += bm->BytesPerRow;
679         bmp_mem += bm->BytesPerRow;
680       }
681     }
682     dest += plane_size;
683   }
684
685   WRITESHORT(RTG_X1, x % 0x07);
686   WRITESHORT(RTG_X2, dx);
687   WRITESHORT(RTG_X3, w);
688   WRITESHORT(RTG_Y1, 0);
689   WRITESHORT(RTG_Y2, dy);
690   WRITESHORT(RTG_Y3, h);
691
692   WRITESHORT(RTG_Y4, bm->Rows);
693   WRITESHORT(RTG_X4, r->BytesPerRow);
694   WRITESHORT(RTG_U1, planemask_0 << 8 | planemask);
695   WRITESHORT(RTG_U2, bm->BytesPerRow);
696
697   WRITEBYTE(RTG_U81, mask);
698   WRITEBYTE(RTG_U82, minterm);
699   WRITEBYTE(RTG_U83, bm->Depth);
700
701   WRITESHORT(RTG_COMMAND, RTGCMD_P2C);
702 }
703
704 void BlitPlanar2Chunky (__REGA0(struct BoardInfo *b), __REGA1(struct BitMap *bm), __REGA2(struct RenderInfo *r), __REGD0(SHORT x), __REGD1(SHORT y), __REGD2(SHORT dx), __REGD3(SHORT dy), __REGD4(SHORT w), __REGD5(SHORT h), __REGD6(UBYTE minterm), __REGD7(UBYTE mask)) {
705   if (!b || !r)
706     return;
707
708   uint32_t plane_size = bm->BytesPerRow * bm->Rows;
709
710   uint32_t template_addr = CARD_SCRATCH;
711
712   uint16_t plane_mask = mask;
713   uint8_t ff_mask = 0x00;
714   uint8_t cur_plane = 0x01;
715
716   uint16_t line_size = (w >> 3) + 2;
717   uint32_t output_plane_size = line_size * h;
718   uint16_t x_offset = (x >> 3);
719
720   WRITELONG(RTG_ADDR1, (unsigned long)r->Memory);
721   WRITELONG(RTG_ADDR2, template_addr);
722   WRITESHORT(RTG_X4, r->BytesPerRow);
723   WRITESHORT(RTG_X5, line_size);
724   WRITESHORT(RTG_FORMAT, rgbf_to_rtg[r->RGBFormat]);
725
726   WRITEBYTE(RTG_U81, mask);
727   WRITEBYTE(RTG_U82, minterm);
728
729   for (int16_t i = 0; i < bm->Depth; i++) {
730     uint16_t x_offset = (x >> 3);
731     if ((uint32_t)bm->Planes[i] == 0xFFFFFFFF) {
732       //memset((uint8_t*)(((uint32_t)b->memory)+template_addr), 0xFF, output_plane_size);
733       ff_mask |= cur_plane;
734     }
735     else if (bm->Planes[i] != NULL) {
736       uint8_t* bmp_mem = (uint8_t*)bm->Planes[i] + (y * bm->BytesPerRow) + x_offset;
737       uint8_t* dest = (uint8_t*)((uint32_t)template_addr);
738       for (int16_t y_line = 0; y_line < h; y_line++) {
739         memcpy(dest, bmp_mem, line_size);
740         dest += line_size;
741         bmp_mem += bm->BytesPerRow;
742       }
743     }
744     else {
745       plane_mask &= (cur_plane ^ 0xFF);
746     }
747     cur_plane <<= 1;
748     template_addr += output_plane_size;
749   }
750
751   WRITESHORT(RTG_X1, (x & 0x07));
752   WRITESHORT(RTG_X2, dx);
753   WRITESHORT(RTG_X3, w);
754   WRITESHORT(RTG_Y1, 0);
755   WRITESHORT(RTG_Y2, dy);
756   WRITESHORT(RTG_Y3, h);
757
758   WRITESHORT(RTG_U1, (plane_mask << 8 | ff_mask));
759   WRITEBYTE(RTG_U83, bm->Depth);
760
761   WRITESHORT(RTG_COMMAND, RTGCMD_P2C);
762 }
763
764 void BlitPlanar2Direct (__REGA0(struct BoardInfo *b), __REGA1(struct BitMap *bmp), __REGA2(struct RenderInfo *r), __REGA3(struct ColorIndexMapping *clut), __REGD0(SHORT x), __REGD1(SHORT y), __REGD2(SHORT dx), __REGD3(SHORT dy), __REGD4(SHORT w), __REGD5(SHORT h), __REGD6(UBYTE minterm), __REGD7(UBYTE mask)) {
765
766 }