Merge branch 'master' of git://git.ucc.asn.au/tpg/acess2
[tpg/acess2.git] / Modules / Display / BochsGA / bochsvbe.c
index d1d78a5..806c1c1 100644 (file)
@@ -1,33 +1,30 @@
 /**\r
- * \file drv_bochsvbe.c\r
- * \brief BGA (Bochs Graphic Adapter) Driver\r
- * \note for Acess2\r
- * \warning This driver does NOT support the Bochs PCI VGA driver\r
-*/\r
+ * Acess2 Bochs graphics adapter Driver\r
+ * - By John Hodge (thePowersGang)\r
+ *\r
+ * bochsvbe.c\r
+ * - Driver core\r
+ */\r
 #define DEBUG  0\r
+#define VERSION        VER2(0,10)\r
+\r
 #include <acess.h>\r
 #include <errno.h>\r
 #include <modules.h>\r
 #include <vfs.h>\r
 #include <fs_devfs.h>\r
 #include <drv_pci.h>\r
-#include <tpl_drv_video.h>\r
-\r
-#define INT\r
+#include <api_drv_video.h>\r
 \r
 // === TYPES ===\r
-typedef struct {\r
+typedef struct sBGA_Mode {\r
        Uint16  width;\r
        Uint16  height;\r
        Uint16  bpp;\r
-       Uint16  flags;\r
        Uint32  fbSize;\r
-} t_bga_mode;\r
+}      tBGA_Mode;\r
 \r
 // === CONSTANTS ===\r
-enum eMode_Flags {\r
-       MODEFLAG_TEXT = 1\r
-};\r
 #define        BGA_LFB_MAXSIZE (1024*768*4)\r
 #define        VBE_DISPI_BANK_ADDRESS  0xA0000\r
 #define VBE_DISPI_LFB_PHYSICAL_ADDRESS 0xE0000000\r
@@ -50,6 +47,7 @@ enum {
        VBE_DISPI_INDEX_Y_OFFSET\r
 };\r
 \r
+extern void MM_DumpTables(tVAddr Start, tVAddr End);\r
 \r
 // === PROTOTYPES ===\r
 // Driver\r
@@ -65,34 +63,32 @@ void        BGA_int_SetMode(Uint16 width, Uint16 height);
  int   BGA_int_ModeInfo(tVideo_IOCtl_Mode *info);\r
  int   BGA_int_MapFB(void *Dest);\r
 // Filesystem\r
-Uint64 BGA_Read(tVFS_Node *node, Uint64 off, Uint64 len, void *buffer);\r
-Uint64 BGA_Write(tVFS_Node *node, Uint64 off, Uint64 len, void *buffer);\r
- int   BGA_Ioctl(tVFS_Node *node, int id, void *data);\r
+Uint64 BGA_Read(tVFS_Node *Node, Uint64 off, Uint64 len, void *buffer);\r
+Uint64 BGA_Write(tVFS_Node *Node, Uint64 off, Uint64 len, const void *buffer);\r
+ int   BGA_IOCtl(tVFS_Node *Node, int ID, void *Data);\r
 \r
 // === GLOBALS ===\r
-MODULE_DEFINE(0, 0x0032, BochsGA, BGA_Install, NULL, "PCI", NULL);\r
-tDevFS_Driver  gBGA_DriverStruct = {\r
-       NULL, "BochsGA",\r
-       {\r
+MODULE_DEFINE(0, VERSION, BochsGA, BGA_Install, NULL, "PCI", NULL);\r
+tVFS_NodeType  gBGA_NodeType = {\r
        .Read = BGA_Read,\r
        .Write = BGA_Write,\r
-       .IOCtl = BGA_Ioctl\r
-       }\r
-};\r
+       .IOCtl = BGA_IOCtl\r
+       };\r
+tDevFS_Driver  gBGA_DriverStruct = {\r
+       NULL, "BochsGA",\r
+       {.Type = &gBGA_NodeType}\r
+       };\r
  int   giBGA_CurrentMode = -1;\r
 tVideo_IOCtl_Pos       gBGA_CursorPos = {-1,-1};\r
- int   giBGA_DriverId = -1;\r
 Uint   *gBGA_Framebuffer;\r
-t_bga_mode     gBGA_Modes[] = {\r
-       {},\r
-       { 80,25, 12, MODEFLAG_TEXT, 80*25*8},   // 640 x 480\r
-       {100,37, 12, MODEFLAG_TEXT, 100*37*8},  // 800 x 600\r
-       {640,480,8, 0, 640*480},\r
-       {640,480,32, 0, 640*480*4},\r
-       {800,600,8, 0, 800*600},\r
-       {800,600,32, 0, 800*600*4},\r
+const tBGA_Mode        *gpBGA_CurrentMode;\r
+const tBGA_Mode        gBGA_Modes[] = {\r
+       {640,480,32, 640*480*4},\r
+       {800,600,32, 800*600*4},\r
+       {1024,768,32, 1024*768*4}\r
 };\r
 #define        BGA_MODE_COUNT  (sizeof(gBGA_Modes)/sizeof(gBGA_Modes[0]))\r
+tDrvUtil_Video_BufInfo gBGA_DrvUtil_BufInfo;\r
 \r
 // === CODE ===\r
 /**\r
@@ -100,36 +96,48 @@ t_bga_mode gBGA_Modes[] = {
  */\r
 int BGA_Install(char **Arguments)\r
 {\r
-        int    bga_version = 0;\r
+        int    version = 0;\r
+       tPAddr  base;\r
+       tPCIDev dev;\r
        \r
        // Check BGA Version\r
-       bga_version = BGA_int_ReadRegister(VBE_DISPI_INDEX_ID);\r
-       // NOTE: This driver was written for 0xB0C4, but they seem to be backwards compatable\r
-       if(bga_version < 0xB0C4 || bga_version > 0xB0C5) {\r
-               Warning("[BGA ] Bochs Adapter Version is not 0xB0C4 or 0xB0C5, instead 0x%x", bga_version);\r
+       version = BGA_int_ReadRegister(VBE_DISPI_INDEX_ID);\r
+       LOG("version = 0x%x", version);\r
+       \r
+       // NOTE: This driver was written for BGA versions >= 0xBOC2\r
+       // NOTE: However, Qemu is braindead and doesn't return the actual version\r
+       if( version != 0xB0C0 && ((version & 0xFFF0) != 0xB0C0 || version < 0xB0C2) ) {\r
+               Log_Warning("BGA", "Bochs Adapter Version is not compatible (need >= 0xB0C2), instead 0x%x", version);\r
                return MODULE_ERR_NOTNEEDED;\r
        }\r
-       \r
+\r
+       // Get framebuffer base \r
+       dev = PCI_GetDevice(0x1234, 0x1111, 0);\r
+       if(dev == -1)\r
+               base = VBE_DISPI_LFB_PHYSICAL_ADDRESS;\r
+       else\r
+               base = PCI_GetBAR(dev, 0);\r
+\r
+       // Map Framebuffer to hardware address\r
+       gBGA_Framebuffer = (void *) MM_MapHWPages(base, 768);   // 768 pages (3Mb)\r
+\r
        // Install Device\r
-       giBGA_DriverId = DevFS_AddDevice( &gBGA_DriverStruct );\r
-       if(giBGA_DriverId == -1) {\r
-               Warning("[BGA ] Unable to register with DevFS, maybe already loaded?");\r
+       if( DevFS_AddDevice( &gBGA_DriverStruct ) == -1 )\r
+       {\r
+               Log_Warning("BGA", "Unable to register with DevFS, maybe already loaded?");\r
                return MODULE_ERR_MISC;\r
        }\r
-       \r
-       // Map Framebuffer to hardware address\r
-       gBGA_Framebuffer = (void *) MM_MapHWPage(VBE_DISPI_LFB_PHYSICAL_ADDRESS, 768);  // 768 pages (3Mb)\r
-       \r
+               \r
        return MODULE_ERR_OK;\r
 }\r
 \r
 /**\r
- * \fn void BGA_Uninstall()\r
+ * \brief Clean up driver resources before destruction\r
  */\r
-void BGA_Uninstall()\r
+void BGA_Uninstall(void)\r
 {\r
-       //DevFS_DelDevice( giBGA_DriverId );\r
-       MM_UnmapHWPage( VBE_DISPI_LFB_PHYSICAL_ADDRESS, 768 );\r
+       DevFS_DelDevice( &gBGA_DriverStruct );\r
+       MM_UnmapHWPages( (tVAddr)gBGA_Framebuffer, 768 );\r
 }\r
 \r
 /**\r
@@ -142,7 +150,7 @@ Uint64 BGA_Read(tVFS_Node *node, Uint64 off, Uint64 len, void *buffer)
        if(giBGA_CurrentMode == -1)     return -1;\r
        \r
        // Check Offset and Length against Framebuffer Size\r
-       if(off+len > gBGA_Modes[giBGA_CurrentMode].fbSize)\r
+       if(off+len > gpBGA_CurrentMode->fbSize)\r
                return -1;\r
        \r
        // Copy from Framebuffer\r
@@ -151,109 +159,30 @@ Uint64 BGA_Read(tVFS_Node *node, Uint64 off, Uint64 len, void *buffer)
 }\r
 \r
 /**\r
- * \fn Uint64 BGA_Write(tVFS_Node *node, Uint64 off, Uint64 len, void *buffer)\r
  * \brief Write to the framebuffer\r
  */\r
-Uint64 BGA_Write(tVFS_Node *node, Uint64 off, Uint64 len, void *Buffer)\r
-{      \r
-       ENTER("xoff xlen", off, len);\r
-       \r
-       // Check Mode\r
-       if(giBGA_CurrentMode == -1) {\r
-               LEAVE('i', -1);\r
-               return -1;\r
-       }\r
-       \r
-       // Check Input against Frambuffer Size\r
-       if(off + len > gBGA_Modes[giBGA_CurrentMode].fbSize) {\r
-               LEAVE('i', -1);\r
-               return -1;\r
-       }\r
-       \r
-       // Text Mode\r
-       if( gBGA_Modes[giBGA_CurrentMode].flags & MODEFLAG_TEXT )\r
-       {\r
-               tVT_Char        *chars = Buffer;\r
-                int    pitch = gBGA_Modes[giBGA_CurrentMode].width * giVT_CharWidth;\r
-                int    x, y;\r
-               Uint32  *dest;\r
-               \r
-               off /= sizeof(tVT_Char);\r
-               dest = (void*)gBGA_Framebuffer;\r
-               x = (off % gBGA_Modes[giBGA_CurrentMode].width) * giVT_CharWidth;\r
-               y = (off / gBGA_Modes[giBGA_CurrentMode].width) * giVT_CharHeight;\r
-               dest += y * pitch;\r
-               dest += x * giVT_CharWidth;\r
-               len /= sizeof(tVT_Char);\r
-               while(len--)\r
-               {\r
-                       VT_Font_Render(\r
-                               chars->Ch,\r
-                               dest, pitch,\r
-                               VT_Colour12to24(chars->BGCol),\r
-                               VT_Colour12to24(chars->FGCol)\r
-                               );\r
-                       \r
-                       dest += giVT_CharWidth;\r
-                       \r
-                       chars ++;\r
-                       x += giVT_CharWidth;\r
-                       if( x >= pitch ) {\r
-                               x = 0;\r
-                               y += giVT_CharHeight;\r
-                               dest += pitch*(giVT_CharHeight-1);\r
-                       }\r
-               }\r
-       }\r
-       else\r
-       {\r
-               Uint8   *destBuf = (Uint8*) ((Uint)gBGA_Framebuffer + (Uint)off);\r
-               \r
-               Log("buffer = %p", Buffer);\r
-               Log("Updating Framebuffer (%p to %p)",\r
-                       destBuf, destBuf + (Uint)len);\r
-               \r
-               \r
-               // Copy to Frambuffer\r
-               memcpy(destBuf, Buffer, len);\r
-               \r
-               Log("BGA Framebuffer updated");\r
-       }\r
-       \r
-       LEAVE('i', len);\r
-       return len;\r
+Uint64 BGA_Write(tVFS_Node *Node, Uint64 Offset, Uint64 Length, const void *Buffer)\r
+{\r
+       if( giBGA_CurrentMode == -1 )   BGA_int_UpdateMode(0);\r
+       return DrvUtil_Video_WriteLFB(&gBGA_DrvUtil_BufInfo, Offset, Length, Buffer);\r
 }\r
 \r
+const char *csaBGA_IOCtls[] = {DRV_IOCTLNAMES, DRV_VIDEO_IOCTLNAMES, NULL};\r
 /**\r
- * \fn INT int BGA_Ioctl(tVFS_Node *node, int ID, void *Data)\r
  * \brief Handle messages to the device\r
  */\r
-INT int BGA_Ioctl(tVFS_Node *node, int ID, void *Data)\r
+int BGA_IOCtl(tVFS_Node *Node, int ID, void *Data)\r
 {\r
         int    ret = -2;\r
-       ENTER("pNode iId pData", node, ID, Data);\r
+       ENTER("pNode iId pData", Node, ID, Data);\r
        \r
        switch(ID)\r
        {\r
-       case DRV_IOCTL_TYPE:\r
-               ret = DRV_TYPE_VIDEO;\r
-               break;\r
-       case DRV_IOCTL_IDENT:\r
-               memcpy(Data, "BGA1", 4);\r
-               ret = 1;\r
-               break;\r
-       case DRV_IOCTL_VERSION:\r
-               ret = 0x100;\r
-               break;\r
-       case DRV_IOCTL_LOOKUP:  // TODO: Implement\r
-               ret = 0;\r
-               break;\r
-               \r
+       BASE_IOCTLS(DRV_TYPE_VIDEO, "BochsGA", VERSION, csaBGA_IOCtls);\r
+\r
        case VIDEO_IOCTL_GETSETMODE:\r
-               if( Data )\r
-                       ret = BGA_int_UpdateMode(*(int*)(Data));\r
-               else\r
-                       ret = giBGA_CurrentMode;\r
+               if( Data )      BGA_int_UpdateMode(*(int*)(Data));\r
+               ret = giBGA_CurrentMode;\r
                break;\r
        \r
        case VIDEO_IOCTL_FINDMODE:\r
@@ -264,14 +193,30 @@ INT int BGA_Ioctl(tVFS_Node *node, int ID, void *Data)
                ret = BGA_int_ModeInfo((tVideo_IOCtl_Mode*)Data);\r
                break;\r
        \r
-       // Request Access to LFB\r
-       case VIDEO_IOCTL_REQLFB:\r
-               ret = BGA_int_MapFB( *(void**)Data );\r
+       case VIDEO_IOCTL_SETBUFFORMAT:\r
+               DrvUtil_Video_RemoveCursor( &gBGA_DrvUtil_BufInfo );\r
+               ret = gBGA_DrvUtil_BufInfo.BufferFormat;\r
+               if(Data)\r
+                       gBGA_DrvUtil_BufInfo.BufferFormat = *(int*)Data;\r
+               if(gBGA_DrvUtil_BufInfo.BufferFormat == VIDEO_BUFFMT_TEXT)\r
+                       DrvUtil_Video_SetCursor( &gBGA_DrvUtil_BufInfo, &gDrvUtil_TextModeCursor );\r
                break;\r
        \r
        case VIDEO_IOCTL_SETCURSOR:\r
+               DrvUtil_Video_RemoveCursor( &gBGA_DrvUtil_BufInfo );\r
                gBGA_CursorPos.x = ((tVideo_IOCtl_Pos*)Data)->x;\r
                gBGA_CursorPos.y = ((tVideo_IOCtl_Pos*)Data)->y;\r
+               if(gBGA_DrvUtil_BufInfo.BufferFormat == VIDEO_BUFFMT_TEXT)\r
+                       DrvUtil_Video_DrawCursor(\r
+                               &gBGA_DrvUtil_BufInfo,\r
+                               gBGA_CursorPos.x*giVT_CharWidth,\r
+                               gBGA_CursorPos.y*giVT_CharHeight\r
+                               );\r
+               else\r
+                       DrvUtil_Video_DrawCursor(\r
+                               &gBGA_DrvUtil_BufInfo,\r
+                               gBGA_CursorPos.x, gBGA_CursorPos.y\r
+                               );\r
                break;\r
        \r
        default:\r
@@ -285,7 +230,6 @@ INT int BGA_Ioctl(tVFS_Node *node, int ID, void *Data)
 \r
 //== Internal Functions ==\r
 /**\r
- * \fn void BGA_int_WriteRegister(Uint16 reg, Uint16 value)\r
  * \brief Writes to a BGA register\r
  */\r
 void BGA_int_WriteRegister(Uint16 reg, Uint16 value)\r
@@ -294,32 +238,23 @@ void BGA_int_WriteRegister(Uint16 reg, Uint16 value)
        outw(VBE_DISPI_IOPORT_DATA, value);\r
 }\r
 \r
-INT Uint16 BGA_int_ReadRegister(Uint16 reg)\r
+Uint16 BGA_int_ReadRegister(Uint16 reg)\r
 {\r
        outw(VBE_DISPI_IOPORT_INDEX, reg);\r
        return inw(VBE_DISPI_IOPORT_DATA);\r
 }\r
 \r
-#if 0\r
-INT void BGA_int_SetBank(Uint16 bank)\r
-{\r
-       BGA_int_WriteRegister(VBE_DISPI_INDEX_BANK, bank);\r
-}\r
-#endif\r
-\r
 /**\r
- * \fn void BGA_int_SetMode(Uint16 width, Uint16 height, Uint16 bpp)\r
- * \brief Sets the video mode from the dimensions and bpp given\r
+ * \brief Sets the video mode (32bpp only)\r
  */\r
-void BGA_int_SetMode(Uint16 width, Uint16 height)\r
+void BGA_int_SetMode(Uint16 Width, Uint16 Height)\r
 {\r
-       ENTER("iwidth iheight ibpp", width, height, bpp);\r
+       ENTER("iWidth iHeight", Width, Height);\r
        BGA_int_WriteRegister(VBE_DISPI_INDEX_ENABLE, VBE_DISPI_DISABLED);\r
-    BGA_int_WriteRegister(VBE_DISPI_INDEX_XRES,        width);\r
-    BGA_int_WriteRegister(VBE_DISPI_INDEX_YRES,        height);\r
-    BGA_int_WriteRegister(VBE_DISPI_INDEX_BPP, 32);\r
-    BGA_int_WriteRegister(VBE_DISPI_INDEX_ENABLE, VBE_DISPI_ENABLED | VBE_DISPI_NOCLEARMEM | VBE_DISPI_LFB_ENABLED);\r
-    //BGA_int_WriteRegister(VBE_DISPI_INDEX_ENABLE, VBE_DISPI_ENABLED | VBE_DISPI_NOCLEARMEM);\r
+       BGA_int_WriteRegister(VBE_DISPI_INDEX_XRES, Width);\r
+       BGA_int_WriteRegister(VBE_DISPI_INDEX_YRES, Height);\r
+       BGA_int_WriteRegister(VBE_DISPI_INDEX_BPP, 32);\r
+       BGA_int_WriteRegister(VBE_DISPI_INDEX_ENABLE, VBE_DISPI_ENABLED | VBE_DISPI_NOCLEARMEM | VBE_DISPI_LFB_ENABLED);\r
        LEAVE('-');\r
 }\r
 \r
@@ -332,17 +267,18 @@ int BGA_int_UpdateMode(int id)
        // Sanity Check\r
        if(id < 0 || id >= BGA_MODE_COUNT)      return -1;\r
        \r
-       // Check if it is a text mode\r
-       if( gBGA_Modes[id].flags & MODEFLAG_TEXT )\r
-               BGA_int_SetMode(\r
-                       gBGA_Modes[id].width*giVT_CharWidth,\r
-                       gBGA_Modes[id].height*giVT_CharHeight);\r
-       else    // Graphics?\r
-               BGA_int_SetMode(\r
-                       gBGA_Modes[id].width,\r
-                       gBGA_Modes[id].height);\r
+       BGA_int_SetMode(\r
+               gBGA_Modes[id].width,\r
+               gBGA_Modes[id].height);\r
        \r
+       gBGA_DrvUtil_BufInfo.Framebuffer = gBGA_Framebuffer;\r
+       gBGA_DrvUtil_BufInfo.Pitch = gBGA_Modes[id].width * 4;\r
+       gBGA_DrvUtil_BufInfo.Width = gBGA_Modes[id].width;\r
+       gBGA_DrvUtil_BufInfo.Height = gBGA_Modes[id].height;\r
+       gBGA_DrvUtil_BufInfo.Depth = gBGA_Modes[id].bpp;\r
+\r
        giBGA_CurrentMode = id;\r
+       gpBGA_CurrentMode = &gBGA_Modes[id];\r
        return id;\r
 }\r
 \r
@@ -354,8 +290,8 @@ int BGA_int_FindMode(tVideo_IOCtl_Mode *info)
 {\r
         int    i;\r
         int    best = 0, bestFactor = 1000;\r
-        int    factor, tmp;\r
-        int    rqdProduct = info->width * info->height * info->bpp;\r
+        int    tmp;\r
+        int    rqdProduct = info->width * info->height;\r
        \r
        ENTER("pinfo", info);\r
        LOG("info = {width:%i,height:%i,bpp:%i})\n", info->width, info->height, info->bpp);\r
@@ -363,38 +299,34 @@ int BGA_int_FindMode(tVideo_IOCtl_Mode *info)
        for(i = 0; i < BGA_MODE_COUNT; i++)\r
        {\r
                #if DEBUG >= 2\r
-               LogF("Mode %i (%ix%ix%i), ", i, gBGA_Modes[i].width, gBGA_Modes[i].height, gBGA_Modes[i].bpp);\r
+               LOG("Mode %i (%ix%i,%ibpp), ", i, gBGA_Modes[i].width, gBGA_Modes[i].height, gBGA_Modes[i].bpp);\r
                #endif\r
-               \r
-               // Check if this mode is the same type as what we want\r
-               if( !(gBGA_Modes[i].flags & MODEFLAG_TEXT) != !(info->flags & VIDEO_FLAG_TEXT) )\r
-                       continue;\r
+\r
+               if( gBGA_Modes[i].bpp != info->bpp )\r
+                       continue ;              \r
                \r
                // Ooh! A perfect match\r
-               if(gBGA_Modes[i].width == info->width\r
-               && gBGA_Modes[i].height == info->height\r
-               && gBGA_Modes[i].bpp == info->bpp)\r
+               if(gBGA_Modes[i].width == info->width && gBGA_Modes[i].height == info->height)\r
                {\r
                        #if DEBUG >= 2\r
-                       LogF("Perfect!\n");\r
+                       LOG("Perfect");\r
                        #endif\r
                        best = i;\r
                        break;\r
                }\r
-               \r
+\r
+\r
                // If not, how close are we?\r
-               tmp = gBGA_Modes[i].width * gBGA_Modes[i].height * gBGA_Modes[i].bpp;\r
-               tmp -= rqdProduct;\r
+               tmp = gBGA_Modes[i].width * gBGA_Modes[i].height - rqdProduct;\r
                tmp = tmp < 0 ? -tmp : tmp;     // tmp = ABS(tmp)\r
-               factor = tmp * 100 / rqdProduct;\r
                \r
                #if DEBUG >= 2\r
-               LogF("factor = %i\n", factor);\r
+               LOG("tmp = %i", tmp);\r
                #endif\r
                \r
-               if(factor < bestFactor)\r
+               if(tmp < bestFactor)\r
                {\r
-                       bestFactor = factor;\r
+                       bestFactor = tmp;\r
                        best = i;\r
                }\r
        }\r
@@ -403,11 +335,8 @@ int BGA_int_FindMode(tVideo_IOCtl_Mode *info)
        info->width = gBGA_Modes[best].width;\r
        info->height = gBGA_Modes[best].height;\r
        info->bpp = gBGA_Modes[best].bpp;\r
-       \r
-       info->flags = 0;\r
-       if(gBGA_Modes[best].flags & MODEFLAG_TEXT)\r
-               info->flags |= VIDEO_FLAG_TEXT;\r
-       \r
+\r
+       LEAVE('i', best);       \r
        return best;\r
 }\r
 \r
@@ -428,40 +357,6 @@ int BGA_int_ModeInfo(tVideo_IOCtl_Mode *info)
        info->height = gBGA_Modes[info->id].height;\r
        info->bpp = gBGA_Modes[info->id].bpp;\r
        \r
-       info->flags = 0;\r
-       if(gBGA_Modes[info->id].flags & MODEFLAG_TEXT)\r
-               info->flags |= VIDEO_FLAG_TEXT;\r
-       \r
        return 1;\r
 }\r
 \r
-/**\r
- * \fn int BGA_int_MapFB(void *Dest)\r
- * \brief Map the framebuffer into a process's space\r
- * \param Dest User address to load to\r
- */\r
-int BGA_int_MapFB(void *Dest)\r
-{\r
-       Uint    i;\r
-       Uint    pages;\r
-       \r
-       // Sanity Check\r
-       if((Uint)Dest > 0xC0000000)     return 0;\r
-       if(gBGA_Modes[giBGA_CurrentMode].bpp < 15)      return 0;       // Only non-pallete modes are supported\r
-       \r
-       // Count required pages\r
-       pages = (gBGA_Modes[giBGA_CurrentMode].fbSize + 0xFFF) >> 12;\r
-       \r
-       // Check if there is space\r
-       for( i = 0; i < pages; i++ )\r
-       {\r
-               if(MM_GetPhysAddr( (Uint)Dest + (i << 12) ))\r
-                       return 0;\r
-       }\r
-       \r
-       // Map\r
-       for( i = 0; i < pages; i++ )\r
-               MM_Map( (Uint)Dest + (i<<12), VBE_DISPI_LFB_PHYSICAL_ADDRESS + (i<<12) );\r
-       \r
-       return 1;\r
-}\r

UCC git Repository :: git.ucc.asn.au