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 Uint64 Tegra2Vid_Read(tVFS_Node *node, Uint64 off, Uint64 len, void *buffer);
\r
27 Uint64 Tegra2Vid_Write(tVFS_Node *node, Uint64 off, Uint64 len, 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, Video_Tegra2, Tegra2Vid_Install, NULL, NULL);
\r
34 tDevFS_Driver gTegra2Vid_DriverStruct = {
\r
37 .Read = Tegra2Vid_Read,
\r
38 .Write = Tegra2Vid_Write,
\r
39 .IOCtl = Tegra2Vid_IOCtl
\r
43 tPAddr gTegra2Vid_PhysBase = TEGRA2VID_BASE;
\r
44 int gbTegra2Vid_IsVersatile = 1;
\r
45 // -- KeyVal parse rules
\r
46 const tKeyVal_ParseRules gTegra2Vid_KeyValueParser = {
\r
49 {"Base", "P", &gTegra2Vid_PhysBase},
\r
50 {"IsVersatile", "i", &gbTegra2Vid_IsVersatile},
\r
55 int giTegra2Vid_CurrentMode = 0;
\r
56 int giTegra2Vid_BufferMode;
\r
57 int giTegra2Vid_Width = 640;
\r
58 int giTegra2Vid_Height = 480;
\r
59 size_t giTegra2Vid_FramebufferSize;
\r
60 Uint8 *gpTegra2Vid_IOMem;
\r
61 tPAddr gTegra2Vid_FramebufferPhys;
\r
62 void *gpTegra2Vid_Framebuffer;
\r
64 tDrvUtil_Video_BufInfo gTegra2Vid_DrvUtil_BufInfo;
\r
65 tVideo_IOCtl_Pos gTegra2Vid_CursorPos;
\r
70 int Tegra2Vid_Install(char **Arguments)
\r
72 // KeyVal_Parse(&gTegra2Vid_KeyValueParser, Arguments);
\r
74 gpTegra2Vid_IOMem = (void*)MM_MapHWPages(gTegra2Vid_PhysBase, 1);
\r
76 Tegra2Vid_int_SetMode(4);
\r
78 DevFS_AddDevice( &gTegra2Vid_DriverStruct );
\r
84 * \brief Clean up resources for driver unloading
\r
86 void Tegra2Vid_Uninstall()
\r
91 * \brief Read from the framebuffer
\r
93 Uint64 Tegra2Vid_Read(tVFS_Node *node, Uint64 off, Uint64 len, void *buffer)
\r
99 * \brief Write to the framebuffer
\r
101 Uint64 Tegra2Vid_Write(tVFS_Node *Node, Uint64 Offset, Uint64 Length, void *Buffer)
\r
103 gTegra2Vid_DrvUtil_BufInfo.BufferFormat = giTegra2Vid_BufferMode;
\r
104 return DrvUtil_Video_WriteLFB(&gTegra2Vid_DrvUtil_BufInfo, Offset, Length, Buffer);
\r
107 const char *csaTegra2Vid_IOCtls[] = {DRV_IOCTLNAMES, DRV_VIDEO_IOCTLNAMES, NULL};
\r
110 * \brief Handle messages to the device
\r
112 int Tegra2Vid_IOCtl(tVFS_Node *Node, int ID, void *Data)
\r
115 ENTER("pNode iID pData", Node, ID, Data);
\r
119 BASE_IOCTLS(DRV_TYPE_VIDEO, "PL110", VERSION, csaTegra2Vid_IOCtls);
\r
121 case VIDEO_IOCTL_SETBUFFORMAT:
\r
122 DrvUtil_Video_RemoveCursor( &gTegra2Vid_DrvUtil_BufInfo );
\r
123 ret = giTegra2Vid_BufferMode;
\r
124 if(Data) giTegra2Vid_BufferMode = *(int*)Data;
\r
125 if(gTegra2Vid_DrvUtil_BufInfo.BufferFormat == VIDEO_BUFFMT_TEXT)
\r
126 DrvUtil_Video_SetCursor( &gTegra2Vid_DrvUtil_BufInfo, &gDrvUtil_TextModeCursor );
\r
129 case VIDEO_IOCTL_GETSETMODE:
\r
134 if( !CheckMem(Data, sizeof(int)) )
\r
135 LEAVE_RET('i', -1);
\r
137 newMode = *(int*)Data;
\r
139 if(newMode < 0 || newMode >= ciTegra2Vid_ModeCount)
\r
140 LEAVE_RET('i', -1);
\r
142 if(newMode != giTegra2Vid_CurrentMode)
\r
144 giTegra2Vid_CurrentMode = newMode;
\r
145 Tegra2Vid_int_SetMode( newMode );
\r
148 ret = giTegra2Vid_CurrentMode;
\r
151 case VIDEO_IOCTL_FINDMODE:
\r
153 tVideo_IOCtl_Mode *mode = Data;
\r
154 int closest, closestArea, reqArea = 0;
\r
155 if(!Data || !CheckMem(Data, sizeof(tVideo_IOCtl_Mode)))
\r
156 LEAVE_RET('i', -1);
\r
157 if( mode->bpp != 32 )
\r
159 if( mode->flags != 0 )
\r
164 for( int i = 0; i < ciTegra2Vid_ModeCount; i ++ )
\r
167 if(mode->width == caTegra2Vid_Modes[i].W && mode->height == caTegra2Vid_Modes[i].H) {
\r
173 area = caTegra2Vid_Modes[i].W * caTegra2Vid_Modes[i].H;
\r
175 reqArea = mode->width * mode->height;
\r
177 closestArea = area;
\r
179 else if( ABS(area - reqArea) < ABS(closestArea - reqArea) ) {
\r
181 closestArea = area;
\r
187 mode->id = closest;
\r
190 mode->width = caTegra2Vid_Modes[mode->id].W;
\r
191 mode->height = caTegra2Vid_Modes[mode->id].H;
\r
195 case VIDEO_IOCTL_MODEINFO:
\r
197 tVideo_IOCtl_Mode *mode = Data;
\r
198 if(!Data || !CheckMem(Data, sizeof(tVideo_IOCtl_Mode)))
\r
199 LEAVE_RET('i', -1);
\r
200 if(mode->id < 0 || mode->id >= ciTegra2Vid_ModeCount)
\r
206 mode->width = caTegra2Vid_Modes[mode->id].W;
\r
207 mode->height = caTegra2Vid_Modes[mode->id].H;
\r
213 case VIDEO_IOCTL_SETCURSOR:
\r
214 if( !Data || !CheckMem(Data, sizeof(tVideo_IOCtl_Pos)) )
\r
215 LEAVE_RET('i', -1);
\r
217 DrvUtil_Video_RemoveCursor( &gTegra2Vid_DrvUtil_BufInfo );
\r
219 gTegra2Vid_CursorPos = *(tVideo_IOCtl_Pos*)Data;
\r
220 if(gTegra2Vid_DrvUtil_BufInfo.BufferFormat == VIDEO_BUFFMT_TEXT)
\r
221 DrvUtil_Video_DrawCursor(
\r
222 &gTegra2Vid_DrvUtil_BufInfo,
\r
223 gTegra2Vid_CursorPos.x*giVT_CharWidth,
\r
224 gTegra2Vid_CursorPos.y*giVT_CharHeight
\r
227 DrvUtil_Video_DrawCursor(
\r
228 &gTegra2Vid_DrvUtil_BufInfo,
\r
229 gTegra2Vid_CursorPos.x,
\r
230 gTegra2Vid_CursorPos.y
\r
247 int Tegra2Vid_int_SetMode(int Mode)
\r
249 const struct sTegra2_Disp_Mode *mode = &caTegra2Vid_Modes[Mode];
\r
250 int w = mode->W, h = mode->H; // Horizontal/Vertical Active
\r
251 *(Uint32*)(gpTegra2Vid_IOMem + DC_DISP_FRONT_PORCH_0) = (mode->VFP << 16) | mode->HFP;
\r
252 *(Uint32*)(gpTegra2Vid_IOMem + DC_DISP_SYNC_WIDTH_0) = (mode->HS << 16) | mode->HS;
\r
253 *(Uint32*)(gpTegra2Vid_IOMem + DC_DISP_BACK_PORCH_0) = (mode->VBP << 16) | mode->HBP;
\r
254 *(Uint32*)(gpTegra2Vid_IOMem + DC_DISP_DISP_ACTIVE_0) = (mode->H << 16) | mode->W;
\r
256 *(Uint32*)(gpTegra2Vid_IOMem + DC_WIN_A_POSITION_0) = 0;
\r
257 *(Uint32*)(gpTegra2Vid_IOMem + DC_WIN_A_SIZE_0) = (mode->H << 16) | mode->W;
\r
258 *(Uint8*)(gpTegra2Vid_IOMem + DC_WIN_A_COLOR_DEPTH_0) = 12; // Could be 13 (BGR/RGB)
\r
259 *(Uint32*)(gpTegra2Vid_IOMem + DC_WIN_A_PRESCALED_SIZE_0) = (mode->H << 16) | mode->W;
\r
261 if( !gpTegra2Vid_Framebuffer || w*h*4 != giTegra2Vid_FramebufferSize )
\r
263 if( gpTegra2Vid_Framebuffer )
\r
265 // TODO: Free framebuffer for reallocation
\r
268 giTegra2Vid_FramebufferSize = w*h*4;
\r
270 gpTegra2Vid_Framebuffer = (void*)MM_AllocDMA(
\r
271 (giTegra2Vid_FramebufferSize + PAGE_SIZE-1) / PAGE_SIZE,
\r
273 &gTegra2Vid_FramebufferPhys
\r
275 // TODO: Catch allocation failures
\r
278 *(Uint32*)(gpTegra2Vid_IOMem + DC_WINBUF_A_START_ADDR_0) = gTegra2Vid_FramebufferPhys;
\r
279 *(Uint32*)(gpTegra2Vid_IOMem + DC_WINBUF_A_ADDR_V_OFFSET_0) = 0; // Y offset
\r
280 *(Uint32*)(gpTegra2Vid_IOMem + DC_WINBUF_A_ADDR_H_OFFSET_0) = 0; // X offset
\r