6 #define VERSION ((0<<8)|10)
\r
11 #include <fs_devfs.h>
\r
12 #include <drv_pci.h>
\r
13 #include <api_drv_video.h>
\r
14 #include <lib/keyvalue.h>
\r
15 #include <options.h> // ARM Arch
\r
18 #define ABS(a) ((a)>0?(a):-(a))
\r
20 // === PROTOTYPES ===
\r
22 int Tegra2Vid_Install(char **Arguments);
\r
23 void Tegra2Vid_Uninstall();
\r
26 size_t Tegra2Vid_Read(tVFS_Node *node, off_t off, size_t len, void *buffer);
\r
27 size_t Tegra2Vid_Write(tVFS_Node *node, off_t off, size_t len, const void *buffer);
\r
28 int Tegra2Vid_IOCtl(tVFS_Node *node, int id, void *data);
\r
30 int Tegra2Vid_int_SetMode(int Mode);
\r
33 MODULE_DEFINE(0, VERSION, Tegra2Vid, Tegra2Vid_Install, NULL, NULL);
\r
34 tVFS_NodeType gTegra2Vid_NodeType = {
\r
35 .Read = Tegra2Vid_Read,
\r
36 .Write = Tegra2Vid_Write,
\r
37 .IOCtl = Tegra2Vid_IOCtl
\r
39 tDevFS_Driver gTegra2Vid_DriverStruct = {
\r
41 {.Type = &gTegra2Vid_NodeType}
\r
44 tPAddr gTegra2Vid_PhysBase = TEGRA2VID_BASE;
\r
45 int gbTegra2Vid_IsVersatile = 1;
\r
46 // -- KeyVal parse rules
\r
47 const tKeyVal_ParseRules gTegra2Vid_KeyValueParser = {
\r
50 {"Base", "P", &gTegra2Vid_PhysBase},
\r
55 int giTegra2Vid_CurrentMode = 0;
\r
56 int giTegra2Vid_BufferMode;
\r
57 size_t giTegra2Vid_FramebufferSize;
\r
58 Uint32 *gpTegra2Vid_IOMem;
\r
59 tPAddr gTegra2Vid_FramebufferPhys;
\r
60 void *gpTegra2Vid_Framebuffer;
\r
62 tDrvUtil_Video_BufInfo gTegra2Vid_DrvUtil_BufInfo;
\r
63 tVideo_IOCtl_Pos gTegra2Vid_CursorPos;
\r
68 int Tegra2Vid_Install(char **Arguments)
\r
70 return MODULE_ERR_NOTNEEDED;
\r
71 // KeyVal_Parse(&gTegra2Vid_KeyValueParser, Arguments);
\r
73 gpTegra2Vid_IOMem = (void*)MM_MapHWPages(gTegra2Vid_PhysBase, 256/4);
\r
75 Log_Debug("Tegra2Vid", "Display CMD Registers");
\r
76 for( int i = 0x000; i <= 0x01A; i ++ )
\r
77 Log_Debug("Tegra2Vid", "[0x%03x] = 0x%08x", i, gpTegra2Vid_IOMem[i]);
\r
78 for( int i = 0x028; i <= 0x043; i ++ )
\r
79 Log_Debug("Tegra2Vid", "[0x%03x] = 0x%08x", i, gpTegra2Vid_IOMem[i]);
\r
80 Log_Debug("Tegra2Vid", "Display COM Registers");
\r
81 for( int i = 0x300; i <= 0x329; i ++ )
\r
82 Log_Debug("Tegra2Vid", "[0x%03x] = 0x%08x", i, gpTegra2Vid_IOMem[i]);
\r
83 Log_Debug("Tegra2Vid", "Display DISP Registers");
\r
84 for( int i = 0x400; i <= 0x446; i ++ )
\r
85 Log_Debug("Tegra2Vid", "[0x%03x] = 0x%08x", i, gpTegra2Vid_IOMem[i]);
\r
86 for( int i = 0x480; i <= 0x484; i ++ )
\r
87 Log_Debug("Tegra2Vid", "[0x%03x] = 0x%08x", i, gpTegra2Vid_IOMem[i]);
\r
88 for( int i = 0x4C0; i <= 0x4C1; i ++ )
\r
89 Log_Debug("Tegra2Vid", "[0x%03x] = 0x%08x", i, gpTegra2Vid_IOMem[i]);
\r
91 Log_Debug("Tegra2Vid", "WINC_A Registers");
\r
92 for( int i = 0x700; i <= 0x714; i ++ )
\r
93 Log_Debug("Tegra2Vid", "[0x%03x] = 0x%08x", i, gpTegra2Vid_IOMem[i]);
\r
94 Log_Debug("Tegra2Vid", "WINBUF_A");
\r
95 for( int i = 0x800; i <= 0x80A; i ++ )
\r
96 Log_Debug("Tegra2Vid", "[0x%03x] = 0x%08x", i, gpTegra2Vid_IOMem[i]);
\r
102 // int w = 1980, h = 1080;
\r
103 // gpTegra2Vid_IOMem[DC_DISP_DISP_ACTIVE_0] = (h << 16) | w;
\r
104 // gpTegra2Vid_IOMem[DC_WIN_A_SIZE_0] = (h << 16) | w;
\r
105 // gpTegra2Vid_IOMem[DC_WIN_A_PRESCALED_SIZE_0] = (h << 16) | w;
\r
108 giTegra2Vid_FramebufferSize =
\r
109 (gpTegra2Vid_IOMem[DC_WIN_A_SIZE_0]&0xFFFF)
\r
110 *(gpTegra2Vid_IOMem[DC_WIN_A_SIZE_0]>>16)*4;
\r
112 Log_Debug("Tegra2Vid", "giTegra2Vid_FramebufferSize = 0x%x", giTegra2Vid_FramebufferSize);
\r
113 gpTegra2Vid_Framebuffer = (void*)MM_MapHWPages(
\r
114 gpTegra2Vid_IOMem[DC_WINBUF_A_START_ADDR_0],
\r
115 (giTegra2Vid_FramebufferSize+PAGE_SIZE-1)/PAGE_SIZE
\r
117 memset(gpTegra2Vid_Framebuffer, 0xFF, 0x1000);
\r
119 gpTegra2Vid_IOMem[DC_WIN_A_WIN_OPTIONS_0] &= ~0x40;
\r
120 gpTegra2Vid_IOMem[DC_WIN_A_COLOR_DEPTH_0] = 12; // Could be 13 (BGR/RGB)
\r
121 gTegra2Vid_DrvUtil_BufInfo.Width = 1024;
\r
122 gTegra2Vid_DrvUtil_BufInfo.Height = 768;
\r
123 gTegra2Vid_DrvUtil_BufInfo.Pitch = 1024*4;
\r
124 gTegra2Vid_DrvUtil_BufInfo.Depth = 32;
\r
125 gTegra2Vid_DrvUtil_BufInfo.Framebuffer = gpTegra2Vid_Framebuffer;
\r
128 // Tegra2Vid_int_SetMode(4);
\r
130 DevFS_AddDevice( &gTegra2Vid_DriverStruct );
\r
136 * \brief Clean up resources for driver unloading
\r
138 void Tegra2Vid_Uninstall()
\r
143 * \brief Read from the framebuffer
\r
145 size_t Tegra2Vid_Read(tVFS_Node *node, off_t off, size_t len, void *buffer)
\r
151 * \brief Write to the framebuffer
\r
153 size_t Tegra2Vid_Write(tVFS_Node *Node, off_t Offset, size_t Length, const void *Buffer)
\r
155 gTegra2Vid_DrvUtil_BufInfo.BufferFormat = giTegra2Vid_BufferMode;
\r
156 return DrvUtil_Video_WriteLFB(&gTegra2Vid_DrvUtil_BufInfo, Offset, Length, Buffer);
\r
159 const char *csaTegra2Vid_IOCtls[] = {DRV_IOCTLNAMES, DRV_VIDEO_IOCTLNAMES, NULL};
\r
162 * \brief Handle messages to the device
\r
164 int Tegra2Vid_IOCtl(tVFS_Node *Node, int ID, void *Data)
\r
167 ENTER("pNode iID pData", Node, ID, Data);
\r
171 BASE_IOCTLS(DRV_TYPE_VIDEO, "PL110", VERSION, csaTegra2Vid_IOCtls);
\r
173 case VIDEO_IOCTL_SETBUFFORMAT:
\r
174 DrvUtil_Video_RemoveCursor( &gTegra2Vid_DrvUtil_BufInfo );
\r
175 ret = giTegra2Vid_BufferMode;
\r
176 if(Data) giTegra2Vid_BufferMode = *(int*)Data;
\r
177 if(gTegra2Vid_DrvUtil_BufInfo.BufferFormat == VIDEO_BUFFMT_TEXT)
\r
178 DrvUtil_Video_SetCursor( &gTegra2Vid_DrvUtil_BufInfo, &gDrvUtil_TextModeCursor );
\r
181 case VIDEO_IOCTL_GETSETMODE:
\r
186 if( !CheckMem(Data, sizeof(int)) )
\r
187 LEAVE_RET('i', -1);
\r
189 newMode = *(int*)Data;
\r
191 if(newMode < 0 || newMode >= ciTegra2Vid_ModeCount)
\r
192 LEAVE_RET('i', -1);
\r
194 if(newMode != giTegra2Vid_CurrentMode)
\r
196 giTegra2Vid_CurrentMode = newMode;
\r
197 Tegra2Vid_int_SetMode( newMode );
\r
200 ret = giTegra2Vid_CurrentMode;
\r
203 case VIDEO_IOCTL_FINDMODE:
\r
205 tVideo_IOCtl_Mode *mode = Data;
\r
206 int closest=0, closestArea, reqArea = 0;
\r
207 if(!Data || !CheckMem(Data, sizeof(tVideo_IOCtl_Mode)))
\r
208 LEAVE_RET('i', -1);
\r
209 if( mode->bpp != 32 )
\r
211 if( mode->flags != 0 )
\r
216 for( int i = 0; i < ciTegra2Vid_ModeCount; i ++ )
\r
219 if(mode->width == caTegra2Vid_Modes[i].W && mode->height == caTegra2Vid_Modes[i].H) {
\r
225 area = caTegra2Vid_Modes[i].W * caTegra2Vid_Modes[i].H;
\r
227 reqArea = mode->width * mode->height;
\r
229 closestArea = area;
\r
231 else if( ABS(area - reqArea) < ABS(closestArea - reqArea) ) {
\r
233 closestArea = area;
\r
239 mode->id = closest;
\r
242 mode->width = caTegra2Vid_Modes[mode->id].W;
\r
243 mode->height = caTegra2Vid_Modes[mode->id].H;
\r
247 case VIDEO_IOCTL_MODEINFO:
\r
249 tVideo_IOCtl_Mode *mode = Data;
\r
250 if(!Data || !CheckMem(Data, sizeof(tVideo_IOCtl_Mode)))
\r
251 LEAVE_RET('i', -1);
\r
252 if(mode->id < 0 || mode->id >= ciTegra2Vid_ModeCount)
\r
258 mode->width = caTegra2Vid_Modes[mode->id].W;
\r
259 mode->height = caTegra2Vid_Modes[mode->id].H;
\r
265 case VIDEO_IOCTL_SETCURSOR:
\r
266 if( !Data || !CheckMem(Data, sizeof(tVideo_IOCtl_Pos)) )
\r
267 LEAVE_RET('i', -1);
\r
269 DrvUtil_Video_RemoveCursor( &gTegra2Vid_DrvUtil_BufInfo );
\r
271 gTegra2Vid_CursorPos = *(tVideo_IOCtl_Pos*)Data;
\r
272 if(gTegra2Vid_DrvUtil_BufInfo.BufferFormat == VIDEO_BUFFMT_TEXT)
\r
273 DrvUtil_Video_DrawCursor(
\r
274 &gTegra2Vid_DrvUtil_BufInfo,
\r
275 gTegra2Vid_CursorPos.x*giVT_CharWidth,
\r
276 gTegra2Vid_CursorPos.y*giVT_CharHeight
\r
279 DrvUtil_Video_DrawCursor(
\r
280 &gTegra2Vid_DrvUtil_BufInfo,
\r
281 gTegra2Vid_CursorPos.x,
\r
282 gTegra2Vid_CursorPos.y
\r
299 int Tegra2Vid_int_SetMode(int Mode)
\r
301 const struct sTegra2_Disp_Mode *mode = &caTegra2Vid_Modes[Mode];
\r
302 int w = mode->W, h = mode->H; // Horizontal/Vertical Active
\r
303 *(Uint32*)(gpTegra2Vid_IOMem + DC_DISP_FRONT_PORCH_0) = (mode->VFP << 16) | mode->HFP;
\r
304 *(Uint32*)(gpTegra2Vid_IOMem + DC_DISP_SYNC_WIDTH_0) = (mode->HS << 16) | mode->HS;
\r
305 *(Uint32*)(gpTegra2Vid_IOMem + DC_DISP_BACK_PORCH_0) = (mode->VBP << 16) | mode->HBP;
\r
306 *(Uint32*)(gpTegra2Vid_IOMem + DC_DISP_DISP_ACTIVE_0) = (mode->H << 16) | mode->W;
\r
308 *(Uint32*)(gpTegra2Vid_IOMem + DC_WIN_A_POSITION_0) = 0;
\r
309 *(Uint32*)(gpTegra2Vid_IOMem + DC_WIN_A_SIZE_0) = (h << 16) | w;
\r
310 *(Uint32*)(gpTegra2Vid_IOMem + DC_DISP_DISP_COLOR_CONTROL_0) = 0x8; // BASE888
\r
311 *(Uint32*)(gpTegra2Vid_IOMem + DC_WIN_A_COLOR_DEPTH_0) = 12; // Could be 13 (BGR/RGB)
\r
312 *(Uint32*)(gpTegra2Vid_IOMem + DC_WIN_A_PRESCALED_SIZE_0) = (h << 16) | w;
\r
314 Log_Debug("Tegra2Vid", "Mode %i (%ix%i) selected", Mode, w, h);
\r
316 if( !gpTegra2Vid_Framebuffer || w*h*4 != giTegra2Vid_FramebufferSize )
\r
318 if( gpTegra2Vid_Framebuffer )
\r
320 // TODO: Free framebuffer for reallocation
\r
323 giTegra2Vid_FramebufferSize = w*h*4;
\r
325 gpTegra2Vid_Framebuffer = (void*)MM_AllocDMA(
\r
326 (giTegra2Vid_FramebufferSize + PAGE_SIZE-1) / PAGE_SIZE,
\r
328 &gTegra2Vid_FramebufferPhys
\r
330 // TODO: Catch allocation failures
\r
331 Log_Debug("Tegra2Vid", "0x%x byte framebuffer at %p (%P phys)",
\r
332 giTegra2Vid_FramebufferSize,
\r
333 gpTegra2Vid_Framebuffer,
\r
334 gTegra2Vid_FramebufferPhys
\r
338 *(Uint32*)(gpTegra2Vid_IOMem + DC_WINBUF_A_START_ADDR_0) = gTegra2Vid_FramebufferPhys;
\r
339 *(Uint32*)(gpTegra2Vid_IOMem + DC_WINBUF_A_ADDR_V_OFFSET_0) = 0; // Y offset
\r
340 *(Uint32*)(gpTegra2Vid_IOMem + DC_WINBUF_A_ADDR_H_OFFSET_0) = 0; // X offset
\r