Modules/USB - Slight commenting updates in HID
[tpg/acess2.git] / KernelLand / Modules / Display / BochsGA / bochsvbe.c
1 /**\r
2  * Acess2 Bochs graphics adapter Driver\r
3  * - By John Hodge (thePowersGang)\r
4  *\r
5  * bochsvbe.c\r
6  * - Driver core\r
7  */\r
8 #define DEBUG   0\r
9 #define VERSION VER2(0,10)\r
10 \r
11 #include <acess.h>\r
12 #include <errno.h>\r
13 #include <modules.h>\r
14 #include <vfs.h>\r
15 #include <fs_devfs.h>\r
16 #include <drv_pci.h>\r
17 #include <api_drv_video.h>\r
18 \r
19 // === TYPES ===\r
20 typedef struct sBGA_Mode {\r
21         Uint16  width;\r
22         Uint16  height;\r
23         Uint16  bpp;\r
24         Uint32  fbSize;\r
25 }       tBGA_Mode;\r
26 \r
27 // === CONSTANTS ===\r
28 #define BGA_LFB_MAXSIZE (1024*768*4)\r
29 #define VBE_DISPI_BANK_ADDRESS  0xA0000\r
30 #define VBE_DISPI_LFB_PHYSICAL_ADDRESS  0xE0000000\r
31 #define VBE_DISPI_IOPORT_INDEX  0x01CE\r
32 #define VBE_DISPI_IOPORT_DATA   0x01CF\r
33 #define VBE_DISPI_DISABLED      0x00\r
34 #define VBE_DISPI_ENABLED       0x01\r
35 #define VBE_DISPI_LFB_ENABLED   0x40\r
36 #define VBE_DISPI_NOCLEARMEM    0x80\r
37 enum {\r
38         VBE_DISPI_INDEX_ID,\r
39         VBE_DISPI_INDEX_XRES,\r
40         VBE_DISPI_INDEX_YRES,\r
41         VBE_DISPI_INDEX_BPP,\r
42         VBE_DISPI_INDEX_ENABLE,\r
43         VBE_DISPI_INDEX_BANK,\r
44         VBE_DISPI_INDEX_VIRT_WIDTH,\r
45         VBE_DISPI_INDEX_VIRT_HEIGHT,\r
46         VBE_DISPI_INDEX_X_OFFSET,\r
47         VBE_DISPI_INDEX_Y_OFFSET\r
48 };\r
49 \r
50 extern void MM_DumpTables(tVAddr Start, tVAddr End);\r
51 \r
52 // === PROTOTYPES ===\r
53 // Driver\r
54  int    BGA_Install(char **Arguments);\r
55 void    BGA_Uninstall();\r
56 // Internal\r
57 void    BGA_int_WriteRegister(Uint16 reg, Uint16 value);\r
58 Uint16  BGA_int_ReadRegister(Uint16 reg);\r
59 void    BGA_int_SetBank(Uint16 bank);\r
60 void    BGA_int_SetMode(Uint16 width, Uint16 height);\r
61  int    BGA_int_UpdateMode(int id);\r
62  int    BGA_int_FindMode(tVideo_IOCtl_Mode *info);\r
63  int    BGA_int_ModeInfo(tVideo_IOCtl_Mode *info);\r
64  int    BGA_int_MapFB(void *Dest);\r
65 // Filesystem\r
66 Uint64  BGA_Read(tVFS_Node *Node, Uint64 off, Uint64 len, void *buffer);\r
67 Uint64  BGA_Write(tVFS_Node *Node, Uint64 off, Uint64 len, const void *buffer);\r
68  int    BGA_IOCtl(tVFS_Node *Node, int ID, void *Data);\r
69 \r
70 // === GLOBALS ===\r
71 MODULE_DEFINE(0, VERSION, BochsGA, BGA_Install, NULL, "PCI", NULL);\r
72 tVFS_NodeType   gBGA_NodeType = {\r
73         .Read = BGA_Read,\r
74         .Write = BGA_Write,\r
75         .IOCtl = BGA_IOCtl\r
76         };\r
77 tDevFS_Driver   gBGA_DriverStruct = {\r
78         NULL, "BochsGA",\r
79         {.Type = &gBGA_NodeType}\r
80         };\r
81  int    giBGA_CurrentMode = -1;\r
82 tVideo_IOCtl_Pos        gBGA_CursorPos = {-1,-1};\r
83 Uint    *gBGA_Framebuffer;\r
84 const tBGA_Mode *gpBGA_CurrentMode;\r
85 const tBGA_Mode gBGA_Modes[] = {\r
86         {640,480,32, 640*480*4},\r
87         {800,600,32, 800*600*4},\r
88         {1024,768,32, 1024*768*4}\r
89 };\r
90 #define BGA_MODE_COUNT  (sizeof(gBGA_Modes)/sizeof(gBGA_Modes[0]))\r
91 tDrvUtil_Video_BufInfo  gBGA_DrvUtil_BufInfo;\r
92 \r
93 // === CODE ===\r
94 /**\r
95  * \fn int BGA_Install(char **Arguments)\r
96  */\r
97 int BGA_Install(char **Arguments)\r
98 {\r
99          int    version = 0;\r
100         tPAddr  base;\r
101         tPCIDev dev;\r
102         \r
103         // Check BGA Version\r
104         version = BGA_int_ReadRegister(VBE_DISPI_INDEX_ID);\r
105         LOG("version = 0x%x", version);\r
106         \r
107         // NOTE: This driver was written for BGA versions >= 0xBOC2\r
108         // NOTE: However, Qemu is braindead and doesn't return the actual version\r
109         if( version != 0xB0C0 && ((version & 0xFFF0) != 0xB0C0 || version < 0xB0C2) ) {\r
110                 Log_Warning("BGA", "Bochs Adapter Version is not compatible (need >= 0xB0C2), instead 0x%x", version);\r
111                 return MODULE_ERR_NOTNEEDED;\r
112         }\r
113 \r
114         // Get framebuffer base \r
115         dev = PCI_GetDevice(0x1234, 0x1111, 0);\r
116         if(dev == -1)\r
117                 base = VBE_DISPI_LFB_PHYSICAL_ADDRESS;\r
118         else\r
119                 base = PCI_GetBAR(dev, 0);\r
120 \r
121         // Map Framebuffer to hardware address\r
122         gBGA_Framebuffer = (void *) MM_MapHWPages(base, 768);   // 768 pages (3Mb)\r
123 \r
124         // Install Device\r
125         if( DevFS_AddDevice( &gBGA_DriverStruct ) == -1 )\r
126         {\r
127                 Log_Warning("BGA", "Unable to register with DevFS, maybe already loaded?");\r
128                 return MODULE_ERR_MISC;\r
129         }\r
130                 \r
131         return MODULE_ERR_OK;\r
132 }\r
133 \r
134 /**\r
135  * \brief Clean up driver resources before destruction\r
136  */\r
137 void BGA_Uninstall(void)\r
138 {\r
139         DevFS_DelDevice( &gBGA_DriverStruct );\r
140         MM_UnmapHWPages( (tVAddr)gBGA_Framebuffer, 768 );\r
141 }\r
142 \r
143 /**\r
144  * \fn Uint64 BGA_Read(tVFS_Node *node, Uint64 off, Uint64 len, void *buffer)\r
145  * \brief Read from the framebuffer\r
146  */\r
147 Uint64 BGA_Read(tVFS_Node *node, Uint64 off, Uint64 len, void *buffer)\r
148 {\r
149         // Check Mode\r
150         if(giBGA_CurrentMode == -1)     return -1;\r
151         \r
152         // Check Offset and Length against Framebuffer Size\r
153         if(off+len > gpBGA_CurrentMode->fbSize)\r
154                 return -1;\r
155         \r
156         // Copy from Framebuffer\r
157         memcpy(buffer, (void*)((Uint)gBGA_Framebuffer + (Uint)off), len);\r
158         return len;\r
159 }\r
160 \r
161 /**\r
162  * \brief Write to the framebuffer\r
163  */\r
164 Uint64 BGA_Write(tVFS_Node *Node, Uint64 Offset, Uint64 Length, const void *Buffer)\r
165 {\r
166         if( giBGA_CurrentMode == -1 )   BGA_int_UpdateMode(0);\r
167         return DrvUtil_Video_WriteLFB(&gBGA_DrvUtil_BufInfo, Offset, Length, Buffer);\r
168 }\r
169 \r
170 const char *csaBGA_IOCtls[] = {DRV_IOCTLNAMES, DRV_VIDEO_IOCTLNAMES, NULL};\r
171 /**\r
172  * \brief Handle messages to the device\r
173  */\r
174 int BGA_IOCtl(tVFS_Node *Node, int ID, void *Data)\r
175 {\r
176          int    ret = -2;\r
177         ENTER("pNode iId pData", Node, ID, Data);\r
178         \r
179         switch(ID)\r
180         {\r
181         BASE_IOCTLS(DRV_TYPE_VIDEO, "BochsGA", VERSION, csaBGA_IOCtls);\r
182 \r
183         case VIDEO_IOCTL_GETSETMODE:\r
184                 if( Data )      BGA_int_UpdateMode(*(int*)(Data));\r
185                 ret = giBGA_CurrentMode;\r
186                 break;\r
187         \r
188         case VIDEO_IOCTL_FINDMODE:\r
189                 ret = BGA_int_FindMode((tVideo_IOCtl_Mode*)Data);\r
190                 break;\r
191         \r
192         case VIDEO_IOCTL_MODEINFO:\r
193                 ret = BGA_int_ModeInfo((tVideo_IOCtl_Mode*)Data);\r
194                 break;\r
195         \r
196         case VIDEO_IOCTL_SETBUFFORMAT:\r
197                 DrvUtil_Video_RemoveCursor( &gBGA_DrvUtil_BufInfo );\r
198                 ret = gBGA_DrvUtil_BufInfo.BufferFormat;\r
199                 if(Data)\r
200                         gBGA_DrvUtil_BufInfo.BufferFormat = *(int*)Data;\r
201                 if(gBGA_DrvUtil_BufInfo.BufferFormat == VIDEO_BUFFMT_TEXT)\r
202                         DrvUtil_Video_SetCursor( &gBGA_DrvUtil_BufInfo, &gDrvUtil_TextModeCursor );\r
203                 break;\r
204         \r
205         case VIDEO_IOCTL_SETCURSOR:\r
206                 DrvUtil_Video_RemoveCursor( &gBGA_DrvUtil_BufInfo );\r
207                 gBGA_CursorPos.x = ((tVideo_IOCtl_Pos*)Data)->x;\r
208                 gBGA_CursorPos.y = ((tVideo_IOCtl_Pos*)Data)->y;\r
209                 if(gBGA_DrvUtil_BufInfo.BufferFormat == VIDEO_BUFFMT_TEXT)\r
210                         DrvUtil_Video_DrawCursor(\r
211                                 &gBGA_DrvUtil_BufInfo,\r
212                                 gBGA_CursorPos.x*giVT_CharWidth,\r
213                                 gBGA_CursorPos.y*giVT_CharHeight\r
214                                 );\r
215                 else\r
216                         DrvUtil_Video_DrawCursor(\r
217                                 &gBGA_DrvUtil_BufInfo,\r
218                                 gBGA_CursorPos.x, gBGA_CursorPos.y\r
219                                 );\r
220                 break;\r
221         \r
222         default:\r
223                 LEAVE('i', -2);\r
224                 return -2;\r
225         }\r
226         \r
227         LEAVE('i', ret);\r
228         return ret;\r
229 }\r
230 \r
231 //== Internal Functions ==\r
232 /**\r
233  * \brief Writes to a BGA register\r
234  */\r
235 void BGA_int_WriteRegister(Uint16 reg, Uint16 value)\r
236 {\r
237         outw(VBE_DISPI_IOPORT_INDEX, reg);\r
238         outw(VBE_DISPI_IOPORT_DATA, value);\r
239 }\r
240 \r
241 Uint16 BGA_int_ReadRegister(Uint16 reg)\r
242 {\r
243         outw(VBE_DISPI_IOPORT_INDEX, reg);\r
244         return inw(VBE_DISPI_IOPORT_DATA);\r
245 }\r
246 \r
247 /**\r
248  * \brief Sets the video mode (32bpp only)\r
249  */\r
250 void BGA_int_SetMode(Uint16 Width, Uint16 Height)\r
251 {\r
252         ENTER("iWidth iHeight", Width, Height);\r
253         BGA_int_WriteRegister(VBE_DISPI_INDEX_ENABLE, VBE_DISPI_DISABLED);\r
254         BGA_int_WriteRegister(VBE_DISPI_INDEX_XRES, Width);\r
255         BGA_int_WriteRegister(VBE_DISPI_INDEX_YRES, Height);\r
256         BGA_int_WriteRegister(VBE_DISPI_INDEX_BPP, 32);\r
257         BGA_int_WriteRegister(VBE_DISPI_INDEX_ENABLE, VBE_DISPI_ENABLED | VBE_DISPI_NOCLEARMEM | VBE_DISPI_LFB_ENABLED);\r
258         LEAVE('-');\r
259 }\r
260 \r
261 /**\r
262  * \fn int BGA_int_UpdateMode(int id)\r
263  * \brief Set current vide mode given a mode id\r
264  */\r
265 int BGA_int_UpdateMode(int id)\r
266 {\r
267         // Sanity Check\r
268         if(id < 0 || id >= BGA_MODE_COUNT)      return -1;\r
269         \r
270         BGA_int_SetMode(\r
271                 gBGA_Modes[id].width,\r
272                 gBGA_Modes[id].height);\r
273         \r
274         gBGA_DrvUtil_BufInfo.Framebuffer = gBGA_Framebuffer;\r
275         gBGA_DrvUtil_BufInfo.Pitch = gBGA_Modes[id].width * 4;\r
276         gBGA_DrvUtil_BufInfo.Width = gBGA_Modes[id].width;\r
277         gBGA_DrvUtil_BufInfo.Height = gBGA_Modes[id].height;\r
278         gBGA_DrvUtil_BufInfo.Depth = gBGA_Modes[id].bpp;\r
279 \r
280         giBGA_CurrentMode = id;\r
281         gpBGA_CurrentMode = &gBGA_Modes[id];\r
282         return id;\r
283 }\r
284 \r
285 /**\r
286  * \fn int BGA_int_FindMode(tVideo_IOCtl_Mode *info)\r
287  * \brief Find a mode matching the given options\r
288  */\r
289 int BGA_int_FindMode(tVideo_IOCtl_Mode *info)\r
290 {\r
291          int    i;\r
292          int    best = 0, bestFactor = 1000;\r
293          int    tmp;\r
294          int    rqdProduct = info->width * info->height;\r
295         \r
296         ENTER("pinfo", info);\r
297         LOG("info = {width:%i,height:%i,bpp:%i})\n", info->width, info->height, info->bpp);\r
298         \r
299         for(i = 0; i < BGA_MODE_COUNT; i++)\r
300         {\r
301                 #if DEBUG >= 2\r
302                 LOG("Mode %i (%ix%i,%ibpp), ", i, gBGA_Modes[i].width, gBGA_Modes[i].height, gBGA_Modes[i].bpp);\r
303                 #endif\r
304 \r
305                 if( gBGA_Modes[i].bpp != info->bpp )\r
306                         continue ;              \r
307                 \r
308                 // Ooh! A perfect match\r
309                 if(gBGA_Modes[i].width == info->width && gBGA_Modes[i].height == info->height)\r
310                 {\r
311                         #if DEBUG >= 2\r
312                         LOG("Perfect");\r
313                         #endif\r
314                         best = i;\r
315                         break;\r
316                 }\r
317 \r
318 \r
319                 // If not, how close are we?\r
320                 tmp = gBGA_Modes[i].width * gBGA_Modes[i].height - rqdProduct;\r
321                 tmp = tmp < 0 ? -tmp : tmp;     // tmp = ABS(tmp)\r
322                 \r
323                 #if DEBUG >= 2\r
324                 LOG("tmp = %i", tmp);\r
325                 #endif\r
326                 \r
327                 if(tmp < bestFactor)\r
328                 {\r
329                         bestFactor = tmp;\r
330                         best = i;\r
331                 }\r
332         }\r
333         \r
334         info->id = best;\r
335         info->width = gBGA_Modes[best].width;\r
336         info->height = gBGA_Modes[best].height;\r
337         info->bpp = gBGA_Modes[best].bpp;\r
338 \r
339         LEAVE('i', best);       \r
340         return best;\r
341 }\r
342 \r
343 /**\r
344  * \fn int BGA_int_ModeInfo(tVideo_IOCtl_Mode *info)\r
345  * \brief Get mode information\r
346  */\r
347 int BGA_int_ModeInfo(tVideo_IOCtl_Mode *info)\r
348 {\r
349         // Sanity Check\r
350         //if( !MM_IsUser( (Uint)info, sizeof(tVideo_IOCtl_Mode) ) ) {\r
351         //      return -EINVAL;\r
352         //}\r
353         \r
354         if(info->id < 0 || info->id >= BGA_MODE_COUNT)  return -1;\r
355         \r
356         info->width = gBGA_Modes[info->id].width;\r
357         info->height = gBGA_Modes[info->id].height;\r
358         info->bpp = gBGA_Modes[info->id].bpp;\r
359         \r
360         return 1;\r
361 }\r
362 \r

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