2 * \file drv_bochsvbe.c
\r
3 * \brief BGA (Bochs Graphic Adapter) Driver
\r
4 * \note for AcessOS Version 1
\r
5 * \warning This driver does NOT support the Bochs PCI VGA driver
\r
10 #include <fs_devfs.h>
\r
11 #include <drv_pci.h>
\r
12 #include <tpl_drv_video.h>
\r
16 # define DEBUGS(v...) SysDebug(v)
\r
18 # define DEBUGS(v...)
\r
21 //#define INT static
\r
34 // === PROTOTYPES ===
\r
36 int BGA_Install(char **Arguments);
\r
37 void BGA_Uninstall();
\r
39 void BGA_int_WriteRegister(Uint16 reg, Uint16 value);
\r
40 Uint16 BGA_int_ReadRegister(Uint16 reg);
\r
41 void BGA_int_SetBank(Uint16 bank);
\r
42 void BGA_int_SetMode(Uint16 width, Uint16 height, Uint16 bpp);
\r
43 int BGA_int_UpdateMode(int id);
\r
44 int BGA_int_FindMode(tVideo_IOCtl_Mode *info);
\r
45 int BGA_int_ModeInfo(tVideo_IOCtl_Mode *info);
\r
46 int BGA_int_MapFB(void *Dest);
\r
48 Uint64 BGA_Read(tVFS_Node *node, Uint64 off, Uint64 len, void *buffer);
\r
49 Uint64 BGA_Write(tVFS_Node *node, Uint64 off, Uint64 len, void *buffer);
\r
50 int BGA_Ioctl(tVFS_Node *node, int id, void *data);
\r
52 // === CONSTANTS ===
\r
53 const t_bga_mode BGA_MODES[] = {
\r
55 {640,480,8, 0, 640*480},
\r
56 {640,480,32, 0, 640*480*4},
\r
57 {800,600,8, 0, 800*600},
\r
58 {800,600,32, 0, 800*600*4},
\r
60 #define BGA_MODE_COUNT (sizeof(BGA_MODES)/sizeof(BGA_MODES[0]))
\r
61 #define BGA_LFB_MAXSIZE (1024*768*4)
\r
62 #define VBE_DISPI_BANK_ADDRESS 0xA0000
\r
63 #define VBE_DISPI_LFB_PHYSICAL_ADDRESS 0xE0000000
\r
64 #define VBE_DISPI_IOPORT_INDEX 0x01CE
\r
65 #define VBE_DISPI_IOPORT_DATA 0x01CF
\r
66 #define VBE_DISPI_DISABLED 0x00
\r
67 #define VBE_DISPI_ENABLED 0x01
\r
68 #define VBE_DISPI_LFB_ENABLED 0x40
\r
69 #define VBE_DISPI_NOCLEARMEM 0x80
\r
72 VBE_DISPI_INDEX_XRES,
\r
73 VBE_DISPI_INDEX_YRES,
\r
74 VBE_DISPI_INDEX_BPP,
\r
75 VBE_DISPI_INDEX_ENABLE,
\r
76 VBE_DISPI_INDEX_BANK,
\r
77 VBE_DISPI_INDEX_VIRT_WIDTH,
\r
78 VBE_DISPI_INDEX_VIRT_HEIGHT,
\r
79 VBE_DISPI_INDEX_X_OFFSET,
\r
80 VBE_DISPI_INDEX_Y_OFFSET
\r
84 MODULE_DEFINE(0, 0x0032, BochsVBE, BGA_Install, NULL, NULL);
\r
85 tDevFS_Driver gBGA_DriverStruct = {
\r
93 int giBGA_CurrentMode = -1;
\r
94 int giBGA_DriverId = -1;
\r
95 Uint *gBGA_Framebuffer;
\r
99 * \fn int BGA_Install(char **Arguments)
\r
101 int BGA_Install(char **Arguments)
\r
103 int bga_version = 0;
\r
105 // Check BGA Version
\r
106 bga_version = BGA_int_ReadRegister(VBE_DISPI_INDEX_ID);
\r
107 // NOTE: This driver was written for 0xB0C4, but they seem to be backwards compatable
\r
108 if(bga_version < 0xB0C4 || bga_version > 0xB0C5) {
\r
109 Warning("[BGA ] Bochs Adapter Version is not 0xB0C4 or 0xB0C5, instead 0x%x", bga_version);
\r
114 giBGA_DriverId = DevFS_AddDevice( &gBGA_DriverStruct );
\r
115 if(giBGA_DriverId == -1) {
\r
116 Warning("[BGA ] Unable to register with DevFS, maybe already loaded?");
\r
120 // Map Framebuffer to hardware address
\r
121 gBGA_Framebuffer = (void *) MM_MapHWPage(VBE_DISPI_LFB_PHYSICAL_ADDRESS, 768); // 768 pages (3Mb)
\r
127 * \fn void BGA_Uninstall()
\r
129 void BGA_Uninstall()
\r
131 //DevFS_DelDevice( giBGA_DriverId );
\r
132 MM_UnmapHWPage( VBE_DISPI_LFB_PHYSICAL_ADDRESS, 768 );
\r
136 * \fn Uint64 BGA_Read(tVFS_Node *node, Uint64 off, Uint64 len, void *buffer)
\r
137 * \brief Read from the framebuffer
\r
139 Uint64 BGA_Read(tVFS_Node *node, Uint64 off, Uint64 len, void *buffer)
\r
142 if(giBGA_CurrentMode == -1) return -1;
\r
144 // Check Offset and Length against Framebuffer Size
\r
145 if(off+len > BGA_MODES[giBGA_CurrentMode].fbSize)
\r
148 // Copy from Framebuffer
\r
149 memcpy(buffer, (void*)((Uint)gBGA_Framebuffer + (Uint)off), len);
\r
154 * \fn Uint64 BGA_Write(tVFS_Node *node, Uint64 off, Uint64 len, void *buffer)
\r
155 * \brief Write to the framebuffer
\r
157 Uint64 BGA_Write(tVFS_Node *node, Uint64 off, Uint64 len, void *buffer)
\r
161 DEBUGS("BGA_Write: (off=%i, len=0x%x)\n", off, len);
\r
164 if(giBGA_CurrentMode == -1)
\r
166 // Check Input against Frambuffer Size
\r
167 if(off+len > BGA_MODES[giBGA_CurrentMode].fbSize)
\r
170 destBuf = (Uint8*) ((Uint)gBGA_Framebuffer + (Uint)off);
\r
172 DEBUGS(" BGA_Write: *buffer = 0x%x\n", *(Uint*)buffer);
\r
173 DEBUGS(" BGA_Write: Updating Framebuffer (0x%x - 0x%x bytes)\n",
\r
174 destBuf, destBuf + (Uint)len);
\r
177 // Copy to Frambuffer
\r
178 memcpy(destBuf, buffer, len);
\r
180 DEBUGS("BGA_Write: BGA Framebuffer updated\n");
\r
186 * \fn INT int BGA_Ioctl(tVFS_Node *node, int id, void *data)
\r
187 * \brief Handle messages to the device
\r
189 INT int BGA_Ioctl(tVFS_Node *node, int id, void *data)
\r
192 ENTER("pNode iId pData", node, id, data);
\r
196 case DRV_IOCTL_TYPE:
\r
197 ret = DRV_TYPE_VIDEO;
\r
199 case DRV_IOCTL_IDENT:
\r
200 memcpy(data, "BGA1", 4);
\r
203 case DRV_IOCTL_VERSION:
\r
206 case DRV_IOCTL_LOOKUP: // TODO: Implement
\r
210 case VIDEO_IOCTL_SETMODE:
\r
211 ret = BGA_int_UpdateMode(*(int*)(data));
\r
214 case VIDEO_IOCTL_GETMODE:
\r
215 ret = giBGA_CurrentMode;
\r
218 case VIDEO_IOCTL_FINDMODE:
\r
219 ret = BGA_int_FindMode((tVideo_IOCtl_Mode*)data);
\r
222 case VIDEO_IOCTL_MODEINFO:
\r
223 ret = BGA_int_ModeInfo((tVideo_IOCtl_Mode*)data);
\r
226 // Request Access to LFB
\r
227 case VIDEO_IOCTL_REQLFB:
\r
228 ret = BGA_int_MapFB( *(void**)data );
\r
240 //== Internal Functions ==
\r
242 * \fn void BGA_int_WriteRegister(Uint16 reg, Uint16 value)
\r
243 * \brief Writes to a BGA register
\r
245 void BGA_int_WriteRegister(Uint16 reg, Uint16 value)
\r
247 outw(VBE_DISPI_IOPORT_INDEX, reg);
\r
248 outw(VBE_DISPI_IOPORT_DATA, value);
\r
251 INT Uint16 BGA_int_ReadRegister(Uint16 reg)
\r
253 outw(VBE_DISPI_IOPORT_INDEX, reg);
\r
254 return inw(VBE_DISPI_IOPORT_DATA);
\r
258 INT void BGA_int_SetBank(Uint16 bank)
\r
260 BGA_int_WriteRegister(VBE_DISPI_INDEX_BANK, bank);
\r
265 * \fn void BGA_int_SetMode(Uint16 width, Uint16 height, Uint16 bpp)
\r
266 * \brief Sets the video mode from the dimensions and bpp given
\r
268 void BGA_int_SetMode(Uint16 width, Uint16 height, Uint16 bpp)
\r
270 DEBUGS("BGA_int_SetMode: (width=%i, height=%i, bpp=%i)\n", width, height, bpp);
\r
271 BGA_int_WriteRegister(VBE_DISPI_INDEX_ENABLE, VBE_DISPI_DISABLED);
\r
272 BGA_int_WriteRegister(VBE_DISPI_INDEX_XRES, width);
\r
273 BGA_int_WriteRegister(VBE_DISPI_INDEX_YRES, height);
\r
274 BGA_int_WriteRegister(VBE_DISPI_INDEX_BPP, bpp);
\r
275 BGA_int_WriteRegister(VBE_DISPI_INDEX_ENABLE, VBE_DISPI_ENABLED | VBE_DISPI_NOCLEARMEM | VBE_DISPI_LFB_ENABLED);
\r
276 //BGA_int_WriteRegister(VBE_DISPI_INDEX_ENABLE, VBE_DISPI_ENABLED | VBE_DISPI_NOCLEARMEM);
\r
280 * \fn int BGA_int_UpdateMode(int id)
\r
281 * \brief Set current vide mode given a mode id
\r
283 int BGA_int_UpdateMode(int id)
\r
285 if(id < 0 || id >= BGA_MODE_COUNT) return -1;
\r
286 BGA_int_SetMode(BGA_MODES[id].width, BGA_MODES[id].height, BGA_MODES[id].bpp);
\r
287 giBGA_CurrentMode = id;
\r
292 * \fn int BGA_int_FindMode(tVideo_IOCtl_Mode *info)
\r
293 * \brief Find a mode matching the given options
\r
295 int BGA_int_FindMode(tVideo_IOCtl_Mode *info)
\r
298 int best = -1, bestFactor = 1000;
\r
300 int rqdProduct = info->width * info->height * info->bpp;
\r
302 DEBUGS("BGA_int_FindMode: (info={width:%i,height:%i,bpp:%i})\n", info->width, info->height, info->bpp);
\r
304 for(i = 0; i < BGA_MODE_COUNT; i++)
\r
307 LogF("Mode %i (%ix%ix%i), ", i, BGA_MODES[i].width, BGA_MODES[i].height, BGA_MODES[i].bpp);
\r
310 if(BGA_MODES[i].width == info->width
\r
311 && BGA_MODES[i].height == info->height
\r
312 && BGA_MODES[i].bpp == info->bpp)
\r
315 LogF("Perfect!\n");
\r
321 tmp = BGA_MODES[i].width * BGA_MODES[i].height * BGA_MODES[i].bpp;
\r
323 tmp = tmp < 0 ? -tmp : tmp;
\r
324 factor = tmp * 100 / rqdProduct;
\r
327 LogF("factor = %i\n", factor);
\r
330 if(factor < bestFactor)
\r
332 bestFactor = factor;
\r
337 info->width = BGA_MODES[best].width;
\r
338 info->height = BGA_MODES[best].height;
\r
339 info->bpp = BGA_MODES[best].bpp;
\r
344 * \fn int BGA_int_ModeInfo(tVideo_IOCtl_Mode *info)
\r
345 * \brief Get mode information
\r
347 int BGA_int_ModeInfo(tVideo_IOCtl_Mode *info)
\r
349 if(!info) return -1;
\r
350 if(MM_GetPhysAddr((Uint)info) == 0)
\r
353 if(info->id < 0 || info->id >= BGA_MODE_COUNT) return -1;
\r
355 info->width = BGA_MODES[info->id].width;
\r
356 info->height = BGA_MODES[info->id].height;
\r
357 info->bpp = BGA_MODES[info->id].bpp;
\r
363 * \fn int BGA_int_MapFB(void *Dest)
\r
364 * \brief Map the framebuffer into a process's space
\r
365 * \param Dest User address to load to
\r
367 int BGA_int_MapFB(void *Dest)
\r
373 if((Uint)Dest > 0xC0000000) return 0;
\r
374 if(BGA_MODES[giBGA_CurrentMode].bpp < 15) return 0; // Only non-pallete modes are supported
\r
376 // Count required pages
\r
377 pages = (BGA_MODES[giBGA_CurrentMode].fbSize + 0xFFF) >> 12;
\r
379 // Check if there is space
\r
380 for( i = 0; i < pages; i++ )
\r
382 if(MM_GetPhysAddr( (Uint)Dest + (i << 12) ))
\r
387 for( i = 0; i < pages; i++ )
\r
388 MM_Map( (Uint)Dest + (i<<12), VBE_DISPI_LFB_PHYSICAL_ADDRESS + (i<<12) );
\r