- \r
- // Text Mode\r
- switch( giVesaCurrentFormat )\r
- {\r
- case VIDEO_BUFFMT_TEXT:\r
- {\r
- tVT_Char *chars = Buffer;\r
- int pitch = gVesa_Modes[giVesaCurrentMode].pitch;\r
- int depth = gVesa_Modes[giVesaCurrentMode].bpp;\r
- int bytes_per_px = gVesa_Modes[giVesaCurrentMode].bpp / 8;\r
- int widthInChars = gVesa_Modes[giVesaCurrentMode].width/giVT_CharWidth;\r
- int heightInChars = gVesa_Modes[giVesaCurrentMode].height/giVT_CharHeight;\r
- int x, y;\r
- Uint8 *dest = (void*)gpVesa_Framebuffer;\r
- int i;\r
- \r
- Length /= sizeof(tVT_Char);\r
- Offset /= sizeof(tVT_Char);\r
- \r
- if( depth == 32 ) depth = 24; // Actually 24-colour bits\r
- \r
- LOG("gVesa_Modes[%i] = {height:%i, width:%i, pitch:%i}",\r
- giVesaCurrentMode,\r
- gVesa_Modes[giVesaCurrentMode].height,\r
- gVesa_Modes[giVesaCurrentMode].width,\r
- gVesa_Modes[giVesaCurrentMode].pitch\r
- );\r
- x = Offset % widthInChars;\r
- y = Offset / widthInChars;\r
- LOG("(x,y) = (%i,%i) = [%i,%i]",\r
- x,\r
- y,\r
- x * giVT_CharWidth * bytes_per_px,\r
- y * giVT_CharHeight * pitch\r
- );\r
- LOG("(w,h) = (%i,%i) = [%i,%i]",\r
- (int)(Length % widthInChars),\r
- (int)(Length / widthInChars),\r
- (int)((Length % widthInChars) * giVT_CharWidth * bytes_per_px),\r
- (int)((Length / widthInChars) * giVT_CharHeight * pitch)\r
- );\r
- \r
- // Sanity Check\r
- if( Offset > (Uint64)(heightInChars*widthInChars) ) {\r
- LEAVE('i', 0);\r
- return 0;\r
- }\r
- if(y >= heightInChars) {\r
- LEAVE('i', 0);\r
- return 0;\r
- }\r
- \r
- \r
- if( (int)Offset + (int)Length > heightInChars*widthInChars ) {\r
- Log_Debug("VESA", "%i + %i > %i*%i (%i)",\r
- (int)Offset, (int)Length, heightInChars, widthInChars, heightInChars*widthInChars);\r
- Length = heightInChars*widthInChars - Offset;\r
- Log_Notice("VESA", "Clipping write size to %i characters", (int)Length);\r
- }\r
- \r
- dest += y * giVT_CharHeight * pitch;\r
- \r
- LOG("dest = %p", dest);\r
- \r
- for( i = 0; i < (int)Length; i++ )\r
- {\r
- if(\r
- !MM_GetPhysAddr( (tVAddr)dest + x*giVT_CharWidth*bytes_per_px )\r
- // || !MM_GetPhysAddr( (tVAddr)dest + x*giVT_CharWidth*depth/8 + pitch*giVT_CharHeight-1)\r
- )\r
- {\r
- Log_Notice("VESA", "Stopped at %i, not mapped", i);\r
- break;\r
- }\r
- if( y >= heightInChars )\r
- {\r
- Log_Notice("VESA", "Stopped at %i", i);\r
- break;\r
- }\r
- \r
- VT_Font_Render(\r
- chars->Ch,\r
- dest + x*giVT_CharWidth*bytes_per_px, bytes_per_px*8, pitch,\r
- VT_Colour12toN(chars->BGCol, depth),\r
- VT_Colour12toN(chars->FGCol, depth)\r
- );\r
- \r
- chars ++;\r
- x ++;\r
- if( x >= widthInChars )\r
- {\r
- x = 0;\r
- y ++;\r
- dest += pitch*giVT_CharHeight;\r
- }\r
- }\r
- Length = i * sizeof(tVT_Char);\r
- }\r
- break;\r
- \r
- case VIDEO_BUFFMT_FRAMEBUFFER:\r
- {\r
- Uint8 *destBuf = (Uint8*) ((Uint)gpVesa_Framebuffer + (Uint)Offset);\r
- \r
- if(gVesa_Modes[giVesaCurrentMode].fbSize < Offset+Length)\r
- {\r
- Log_Warning("VESA", "Vesa_Write - Framebuffer Overflow");\r
- LEAVE('i', 0);\r
- return 0;\r
- }\r
- \r
- LOG("buffer = %p", Buffer);\r
- LOG("Updating Framebuffer (%p to %p)", destBuf, destBuf + (Uint)Length);\r
- \r
- //TODO: Handle non 32-bpp framebuffer modes\r
- \r
- // Copy to Frambuffer\r
- memcpy(destBuf, Buffer, Length);\r
- \r
- LOG("BGA Framebuffer updated");\r
- }\r
- break;\r
- \r
- case VIDEO_BUFFMT_2DSTREAM:\r
- Length = DrvUtil_Video_2DStream(\r
- NULL, // Single framebuffer, so Ent is unused\r
- Buffer, Length, &gVesa_2DFunctions, sizeof(gVesa_2DFunctions)\r
- );\r
- break;\r
- \r
- default:\r
- LEAVE('i', -1);\r
- return -1;\r
- }\r
- \r
- LEAVE('X', Length);\r
- return Length;\r