1 // PiStorm RTG driver, VBCC edition.
2 // Based in part on the ZZ9000 RTG driver.
4 #include <proto/exec.h>
5 #include <proto/expansion.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>
17 #include "boardinfo.h"
19 #define WRITESHORT(cmd, val) *(unsigned short *)((unsigned long)(b->RegisterBase)+cmd) = val;
20 #define WRITELONG(cmd, val) *(unsigned long *)((unsigned long)(b->RegisterBase)+cmd) = val;
21 #define WRITEBYTE(cmd, val) *(unsigned char *)((unsigned long)(b->RegisterBase)+cmd) = val;
23 #define CARD_OFFSET 0x70000000
24 #define CARD_REGSIZE 0x00010000
26 #define CARD_MEMSIZE 0x02000000
28 // "Register" offsets for sending data to the RTG.
72 const unsigned short rgbf_to_rtg[16] = {
78 RTGFMT_RGB555, // 0x05
83 RTGFMT_RBG565, // 0x0A
84 RTGFMT_RGB555, // 0x0B
86 RTGFMT_RGB555, // 0x0D
92 struct Library libNode;
94 struct ExecBase* sysBase;
95 struct ExpansionBase* expansionBase;
98 int FindCard(__REGA0(struct BoardInfo* b));
99 int InitCard(__REGA0(struct BoardInfo* b));
101 void SetDAC (__REGA0(struct BoardInfo *b), __REGD7(RGBFTYPE format));
102 void SetGC (__REGA0(struct BoardInfo *b), __REGA1(struct ModeInfo *mode_info), __REGD0(BOOL border));
103 void SetColorArray (__REGA0(struct BoardInfo *b), __REGD0(UWORD start), __REGD1(UWORD num));
104 void SetPanning (__REGA0(struct BoardInfo *b), __REGA1(UBYTE *addr), __REGD0(UWORD width), __REGD1(WORD x_offset), __REGD2(WORD y_offset), __REGD7(RGBFTYPE format));
105 UWORD SetSwitch (__REGA0(struct BoardInfo *b), __REGD0(UWORD enabled));
106 UWORD SetDisplay (__REGA0(struct BoardInfo *b), __REGD0(UWORD enabled));
108 UWORD CalculateBytesPerRow (__REGA0(struct BoardInfo *b), __REGD0(UWORD width), __REGD7(RGBFTYPE format));
109 APTR CalculateMemory (__REGA0(struct BoardInfo *b), __REGA1(unsigned long addr), __REGD7(RGBFTYPE format));
110 ULONG GetCompatibleFormats (__REGA0(struct BoardInfo *b), __REGD7(RGBFTYPE format));
112 LONG ResolvePixelClock (__REGA0(struct BoardInfo *b), __REGA1(struct ModeInfo *mode_info), __REGD0(ULONG pixel_clock), __REGD7(RGBFTYPE format));
113 ULONG GetPixelClock (__REGA0(struct BoardInfo *b), __REGA1(struct ModeInfo *mode_info), __REGD0(ULONG index), __REGD7(RGBFTYPE format));
114 void SetClock (__REGA0(struct BoardInfo *b));
116 void SetMemoryMode (__REGA0(struct BoardInfo *b), __REGD7(RGBFTYPE format));
117 void SetWriteMask (__REGA0(struct BoardInfo *b), __REGD0(UBYTE mask));
118 void SetClearMask (__REGA0(struct BoardInfo *b), __REGD0(UBYTE mask));
119 void SetReadPlane (__REGA0(struct BoardInfo *b), __REGD0(UBYTE plane));
121 void WaitVerticalSync (__REGA0(struct BoardInfo *b), __REGD0(BOOL toggle));
123 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));
124 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));
126 static ULONG LibStart(void) {
130 static const char LibraryName[] = "PiRTG.card";
131 static const char LibraryID[] = "$VER: PiRTG.card 0.01\r\n";
133 __saveds struct GFXBase* OpenLib(__REGA6(struct GFXBase *gfxbase));
134 BPTR __saveds CloseLib(__REGA6(struct GFXBase *gfxbase));
135 BPTR __saveds ExpungeLib(__REGA6(struct GFXBase *exb));
136 ULONG ExtFuncLib(void);
137 __saveds struct GFXBase* InitLib(__REGA6(struct ExecBase *sysbase),
138 __REGA0(BPTR seglist),
139 __REGD0(struct GFXBase *exb));
141 static const APTR FuncTab[] = {
160 static struct InitTable InitTab = {
161 (ULONG) sizeof(struct GFXBase),
167 static const struct Resident ROMTag = {
180 #define CLOCK_HZ 100000000
182 static struct GFXBase *_gfxbase;
183 const char *gfxname = "PiStorm RTG";
186 __saveds struct GFXBase* InitLib(__REGA6(struct ExecBase *sysbase),
187 __REGA0(BPTR seglist),
188 __REGD0(struct GFXBase *exb))
194 __saveds struct GFXBase* OpenLib(__REGA6(struct GFXBase *gfxbase))
196 gfxbase->libNode.lib_OpenCnt++;
197 gfxbase->libNode.lib_Flags &= ~LIBF_DELEXP;
202 BPTR __saveds CloseLib(__REGA6(struct GFXBase *gfxbase))
204 gfxbase->libNode.lib_OpenCnt--;
206 if (!gfxbase->libNode.lib_OpenCnt) {
207 if (gfxbase->libNode.lib_Flags & LIBF_DELEXP) {
208 return (ExpungeLib(gfxbase));
214 BPTR __saveds ExpungeLib(__REGA6(struct GFXBase *exb))
217 struct ExecBase *SysBase = *(struct ExecBase **)4L;
219 if(!exb->libNode.lib_OpenCnt) {
220 ULONG negsize, possize, fullsize;
221 UBYTE *negptr = (UBYTE *)exb;
223 seglist = exb->segList;
225 Remove((struct Node *)exb);
227 negsize = exb->libNode.lib_NegSize;
228 possize = exb->libNode.lib_PosSize;
229 fullsize = negsize + possize;
232 FreeMem(negptr, fullsize);
236 exb->libNode.lib_Flags |= LIBF_DELEXP;
240 ULONG ExtFuncLib(void)
245 static LONG zorro_version = 0;
247 static struct GFXData *gfxdata;
248 //MNTZZ9KRegs* registers;
250 #define LOADLIB(a, b) if ((a = (struct a*)OpenLibrary(b,0L))==NULL) { \
251 KPrintF("Failed to load %s.\n", b); \
255 static BYTE card_already_found;
256 static BYTE card_initialized;
258 int FindCard(__REGA0(struct BoardInfo* b)) {
259 //if (card_already_found)
261 struct ConfigDev* cd = NULL;
262 struct ExpansionBase *ExpansionBase = NULL;
263 struct DOSBase *DOSBase = NULL;
264 struct IntuitionBase *IntuitionBase = NULL;
265 struct ExecBase *SysBase = *(struct ExecBase **)4L;
267 LOADLIB(ExpansionBase, "expansion.library");
268 LOADLIB(DOSBase, "dos.library");
269 LOADLIB(IntuitionBase, "intuition.library");
271 b->MemorySize = CARD_MEMSIZE;
272 b->RegisterBase = (void *)CARD_OFFSET;
273 b->MemoryBase = (void *)(CARD_OFFSET + CARD_REGSIZE);
279 #define VGASPLIT (1 << 6)
280 #define FLICKERFIXER (1 << 12)
281 #define INDISPLAYCHAIN (1 << 20)
282 #define DIRECTACCESS (1 << 26)
284 int InitCard(__REGA0(struct BoardInfo* b)) {
285 //if (!card_initialized)
286 // card_initialized = 1;
291 struct ExecBase *SysBase = *(struct ExecBase **)4L;
293 b->CardBase = (struct CardBase *)_gfxbase;
294 b->ExecBase = SysBase;
295 b->BoardName = "PiStorm RTG";
296 b->BoardType = BT_MNT_ZZ9000;
297 b->PaletteChipType = PCT_MNT_ZZ9000;
298 b->GraphicsControllerType = GCT_MNT_ZZ9000;
300 b->Flags = BIF_INDISPLAYCHAIN | BIF_GRANTDIRECTACCESS;
301 b->RGBFormats = 1 | 2 | 512 | 1024 | 2048;
302 b->SoftSpriteFlags = 0;
303 b->BitsPerCannon = 8;
305 for(i = 0; i < MAXMODES; i++) {
306 b->MaxHorValue[i] = 1920;
307 b->MaxVerValue[i] = 1080;
308 b->MaxHorResolution[i] = 1920;
309 b->MaxVerResolution[i] = 1080;
310 b->PixelClockCount[i] = 1;
313 b->MemoryClock = CLOCK_HZ;
315 //b->AllocCardMem = (void *)NULL;
316 //b->FreeCardMem = (void *)NULL;
317 b->SetSwitch = (void *)SetSwitch;
318 b->SetColorArray = (void *)SetColorArray;
319 b->SetDAC = (void *)SetDAC;
320 b->SetGC = (void *)SetGC;
321 b->SetPanning = (void *)SetPanning;
322 b->CalculateBytesPerRow = (void *)CalculateBytesPerRow;
323 b->CalculateMemory = (void *)CalculateMemory;
324 b->GetCompatibleFormats = (void *)GetCompatibleFormats;
325 b->SetDisplay = (void *)SetDisplay;
327 b->ResolvePixelClock = (void *)ResolvePixelClock;
328 b->GetPixelClock = (void *)GetPixelClock;
329 b->SetClock = (void *)SetClock;
331 b->SetMemoryMode = (void *)SetMemoryMode;
332 b->SetWriteMask = (void *)SetWriteMask;
333 b->SetClearMask = (void *)SetClearMask;
334 b->SetReadPlane = (void *)SetReadPlane;
336 b->WaitVerticalSync = (void *)WaitVerticalSync;
337 //b->SetInterrupt = (void *)NULL;
339 //b->WaitBlitter = (void *)NULL;
341 //b->ScrollPlanar = (void *)NULL;
342 //b->UpdatePlanar = (void *)NULL;
344 //b->BlitPlanar2Chunky = (void *)NULL;
345 //b->BlitPlanar2Direct = (void *)NULL;
347 b->FillRect = (void *)FillRect;
348 //b->InvertRect = (void *)NULL;
349 b->BlitRect = (void *)BlitRect;
350 //b->BlitTemplate = (void *)NULL;
351 //b->BlitPattern = (void *)NULL;
352 //b->DrawLine = (void *)NULL;
353 //b->BlitRectNoMaskComplete = (void *)NULL;
354 //b->EnableSoftSprite = (void *)NULL;
356 //b->AllocCardMemAbs = (void *)NULL;
357 //b->SetSplitPosition = (void *)NULL;
358 //b->ReInitMemory = (void *)NULL;
359 //b->WriteYUVRect = (void *)NULL;
360 //b->GetVSyncState = (void *)NULL;
361 //b->GetVBeamPos = (void *)NULL;
362 //b->SetDPMSLevel = (void *)NULL;
363 //b->ResetChip = (void *)NULL;
364 //b->GetFeatureAttrs = (void *)NULL;
365 //b->AllocBitMap = (void *)NULL;
366 //b->FreeBitMap = (void *)NULL;
367 //b->GetBitMapAttr = (void *)NULL;
369 //b->SetSprite = (void *)NULL;
370 //b->SetSpritePosition = (void *)NULL;
371 //b->SetSpriteImage = (void *)NULL;
372 //b->SetSpriteColor = (void *)NULL;
374 //b->CreateFeature = (void *)NULL;
375 //b->SetFeatureAttrs = (void *)NULL;
376 //b->DeleteFeature = (void *)NULL;
381 void SetDAC (__REGA0(struct BoardInfo *b), __REGD7(RGBFTYPE format)) {
382 // Used to set the color format of the video card's RAMDAC.
383 // This needs no handling, since the PiStorm doesn't really have a RAMDAC or a video card chipset.
386 void SetGC (__REGA0(struct BoardInfo *b), __REGA1(struct ModeInfo *mode_info), __REGD0(BOOL border)) {
387 b->ModeInfo = mode_info;
388 // Send width, height and format to the RaspberryPi Targetable Graphics.
389 WRITESHORT(RTG_X1, mode_info->Width);
390 WRITESHORT(RTG_Y1, mode_info->Height);
391 WRITESHORT(RTG_FORMAT, rgbf_to_rtg[b->RGBFormat]);
392 WRITESHORT(RTG_COMMAND, RTGCMD_SETGC);
396 UWORD SetSwitch (__REGA0(struct BoardInfo *b), __REGD0(UWORD enabled)) {
397 if (setswitch != enabled) {
401 WRITEBYTE(RTG_U81, setswitch);
402 WRITESHORT(RTG_X1, setswitch);
403 WRITESHORT(RTG_COMMAND, RTGCMD_SETSWITCH);
408 void SetPanning (__REGA0(struct BoardInfo *b), __REGA1(UBYTE *addr), __REGD0(UWORD width), __REGD1(WORD x_offset), __REGD2(WORD y_offset), __REGD7(RGBFTYPE format)) {
409 // Set the panning offset, or the offset used for the current display area on the Pi.
410 // The address needs to have CARD_BASE subtracted from it to be used as an offset on the Pi side.
414 b->XOffset = x_offset;
415 b->YOffset = y_offset;
417 WRITELONG(RTG_ADDR1, (unsigned long)addr);
418 WRITESHORT(RTG_X1, width);
419 WRITESHORT(RTG_X2, b->XOffset);
420 WRITESHORT(RTG_Y2, b->YOffset);
421 WRITESHORT(RTG_COMMAND, RTGCMD_SETPAN);
424 void SetColorArray (__REGA0(struct BoardInfo *b), __REGD0(UWORD start), __REGD1(UWORD num)) {
425 // Sets the color components of X color components for 8-bit paletted display modes.
431 for(int i = start; i < j; i++) {
432 //WRITEBYTE(RTG_U82, (unsigned char)b->CLUT[i].Red);
433 //WRITEBYTE(RTG_U83, (unsigned char)b->CLUT[i].Green);
434 //WRITEBYTE(RTG_U84, (unsigned char)b->CLUT[i].Blue);
435 unsigned long xrgb = 0 | (b->CLUT[i].Red << 16) | (b->CLUT[i].Green << 8) | (b->CLUT[i].Blue);
436 WRITEBYTE(RTG_U81, (unsigned char)i);
437 WRITELONG(RTG_RGB1, xrgb);
438 WRITESHORT(RTG_COMMAND, RTGCMD_SETCLUT);
442 UWORD CalculateBytesPerRow (__REGA0(struct BoardInfo *b), __REGD0(UWORD width), __REGD7(RGBFTYPE format)) {
451 case 0x05: case 0x0A: case 0x0B: case 0x0D:
453 case 0x08: case 0x09:
458 APTR CalculateMemory (__REGA0(struct BoardInfo *b), __REGA1(unsigned long addr), __REGD7(RGBFTYPE format)) {
462 if (addr > (unsigned int)b->MemoryBase && addr < (((unsigned int)b->MemoryBase) + b->MemorySize)) {
463 addr = ((addr + 0x1000) & 0xFFFFF000);
469 ULONG GetCompatibleFormats (__REGA0(struct BoardInfo *b), __REGD7(RGBFTYPE format)) {
470 // It is of course compatible with all the formats ever.
474 static int display_enabled = 0;
475 UWORD SetDisplay (__REGA0(struct BoardInfo *b), __REGD0(UWORD enabled)) {
476 // Enables or disables the display.
477 WRITEBYTE(RTG_U82, (unsigned char)enabled);
478 WRITESHORT(RTG_COMMAND, RTGCMD_SETDISPLAY);
483 LONG ResolvePixelClock (__REGA0(struct BoardInfo *b), __REGA1(struct ModeInfo *mode_info), __REGD0(ULONG pixel_clock), __REGD7(RGBFTYPE format)) {
484 mode_info->PixelClock = CLOCK_HZ;
485 mode_info->pll1.Clock = 0;
486 mode_info->pll2.ClockDivide = 1;
491 ULONG GetPixelClock (__REGA0(struct BoardInfo *b), __REGA1(struct ModeInfo *mode_info), __REGD0(ULONG index), __REGD7(RGBFTYPE format)) {
492 // Just return 100MHz.
496 // None of these five really have to do anything.
497 void SetClock (__REGA0(struct BoardInfo *b)) {
500 void SetMemoryMode (__REGA0(struct BoardInfo *b), __REGD7(RGBFTYPE format)) {
503 void SetWriteMask (__REGA0(struct BoardInfo *b), __REGD0(UBYTE mask)) {
506 void SetClearMask (__REGA0(struct BoardInfo *b), __REGD0(UBYTE mask)) {
509 void SetReadPlane (__REGA0(struct BoardInfo *b), __REGD0(UBYTE plane)) {
512 void WaitVerticalSync (__REGA0(struct BoardInfo *b), __REGD0(BOOL toggle)) {
513 // I don't know why this one has a bool in D0, but it isn't used for anything.
516 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)) {
520 b->FillRectDefault(b, r, x, y, w, h, color, mask, format);
522 WRITESHORT(RTG_FORMAT, rgbf_to_rtg[format]);
523 WRITESHORT(RTG_X1, x);
524 WRITESHORT(RTG_X2, w);
525 WRITESHORT(RTG_Y1, y);
526 WRITESHORT(RTG_Y2, h);
527 WRITELONG(RTG_RGB1, color);
528 WRITESHORT(RTG_X3, r->BytesPerRow);
529 WRITESHORT(RTG_COMMAND, RTGCMD_FILLRECT);
532 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)) {
536 b->BlitRectDefault(b, r, x, y, dx, dy, w, h, mask, format);
538 WRITESHORT(RTG_FORMAT, rgbf_to_rtg[format]);
539 WRITESHORT(RTG_X1, x);
540 WRITESHORT(RTG_X2, dx);
541 WRITESHORT(RTG_X3, w);
542 WRITESHORT(RTG_Y1, y);
543 WRITESHORT(RTG_Y2, dy);
544 WRITESHORT(RTG_Y3, h);
545 WRITESHORT(RTG_X4, r->BytesPerRow);
546 WRITESHORT(RTG_COMMAND, RTGCMD_BLITRECT);