KernelLand/Modules/Display/Tegra2Vid/main.c

   1 /**\r
   2  * main.c\r
   3  * - Driver core\r
   4  */\r
   5 #define DEBUG   0\r
   6 #define VERSION ((0<<8)|10)\r
   7 #include <acess.h>\r
   8 #include <errno.h>\r
   9 #include <modules.h>\r
  10 #include <vfs.h>\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
  16 #include "tegra2.h"\r
  17 \r
  18 #define ABS(a)  ((a)>0?(a):-(a))\r
  19 \r
  20 // === PROTOTYPES ===\r
  21 // Driver\r
  22  int    Tegra2Vid_Install(char **Arguments);\r
  23 void    Tegra2Vid_Uninstall();\r
  24 // Internal\r
  25 // Filesystem\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
  29 // -- Internals\r
  30  int    Tegra2Vid_int_SetMode(int Mode);\r
  31 \r
  32 // === GLOBALS ===\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
  38         };\r
  39 tDevFS_Driver   gTegra2Vid_DriverStruct = {\r
  40         NULL, "Tegra2Vid",\r
  41         {.Type = &gTegra2Vid_NodeType}\r
  42 };\r
  43 // -- Options\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
  48         NULL,\r
  49         {\r
  50                 {"Base", "P", &gTegra2Vid_PhysBase},\r
  51                 {NULL, NULL, NULL}\r
  52         }\r
  53 };\r
  54 // -- Driver state\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
  61 // -- Misc\r
  62 tDrvUtil_Video_BufInfo  gTegra2Vid_DrvUtil_BufInfo;\r
  63 tVideo_IOCtl_Pos        gTegra2Vid_CursorPos;\r
  64 \r
  65 // === CODE ===\r
  66 /**\r
  67  */\r
  68 int Tegra2Vid_Install(char **Arguments)\r
  69 {\r
  70 //      return MODULE_ERR_NOTNEEDED;\r
  71 //      KeyVal_Parse(&gTegra2Vid_KeyValueParser, Arguments);\r
  72 \r
  73         gpTegra2Vid_IOMem = (void*)MM_MapHWPages(gTegra2Vid_PhysBase, 256/4);\r
  74         #if 0\r
  75         {\r
  76                 Log_Debug("Tegra2Vid", "Display CMD Registers");\r
  77                 for( int i = 0x000; i <= 0x01A; i ++ )\r
  78                         Log_Debug("Tegra2Vid", "[0x%03x] = 0x%08x", i, gpTegra2Vid_IOMem[i]);\r
  79                 for( int i = 0x028; i <= 0x043; i ++ )\r
  80                         Log_Debug("Tegra2Vid", "[0x%03x] = 0x%08x", i, gpTegra2Vid_IOMem[i]);\r
  81                 Log_Debug("Tegra2Vid", "Display COM Registers");\r
  82                 for( int i = 0x300; i <= 0x329; i ++ )\r
  83                         Log_Debug("Tegra2Vid", "[0x%03x] = 0x%08x", i, gpTegra2Vid_IOMem[i]);\r
  84                 Log_Debug("Tegra2Vid", "Display DISP Registers");\r
  85                 for( int i = 0x400; i <= 0x446; i ++ )\r
  86                         Log_Debug("Tegra2Vid", "[0x%03x] = 0x%08x", i, gpTegra2Vid_IOMem[i]);\r
  87                 for( int i = 0x480; i <= 0x484; i ++ )\r
  88                         Log_Debug("Tegra2Vid", "[0x%03x] = 0x%08x", i, gpTegra2Vid_IOMem[i]);\r
  89                 for( int i = 0x4C0; i <= 0x4C1; i ++ )\r
  90                         Log_Debug("Tegra2Vid", "[0x%03x] = 0x%08x", i, gpTegra2Vid_IOMem[i]);\r
  91 \r
  92                 Log_Debug("Tegra2Vid", "WINC_A Registers");\r
  93                 for( int i = 0x700; i <= 0x714; i ++ )\r
  94                         Log_Debug("Tegra2Vid", "[0x%03x] = 0x%08x", i, gpTegra2Vid_IOMem[i]);\r
  95                 Log_Debug("Tegra2Vid", "WINBUF_A");\r
  96                 for( int i = 0x800; i <= 0x80A; i ++ )\r
  97                         Log_Debug("Tegra2Vid", "[0x%03x] = 0x%08x", i, gpTegra2Vid_IOMem[i]);\r
  98         }\r
  99         #endif\r
 100 //      return 1;\r
 101 \r
 102         // HACK!!!\r
 103 //      {\r
 104 //              int     w = 1680, h = 1050;\r
 105 //              gpTegra2Vid_IOMem[DC_DISP_DISP_ACTIVE_0] = (h << 16) | w;\r
 106 //              gpTegra2Vid_IOMem[DC_WIN_A_SIZE_0] = (h << 16) | w;\r
 107 //              gpTegra2Vid_IOMem[DC_WIN_A_PRESCALED_SIZE_0] = (h << 16) | w;\r
 108 //      }\r
 109 \r
 110         giTegra2Vid_FramebufferSize =\r
 111                 (gpTegra2Vid_IOMem[DC_WIN_A_SIZE_0]&0xFFFF)\r
 112                 *(gpTegra2Vid_IOMem[DC_WIN_A_SIZE_0]>>16)*4;\r
 113 \r
 114         Log_Debug("Tegra2Vid", "giTegra2Vid_FramebufferSize = 0x%x", giTegra2Vid_FramebufferSize);\r
 115         gpTegra2Vid_Framebuffer = (void*)MM_MapHWPages(\r
 116                 gpTegra2Vid_IOMem[DC_WINBUF_A_START_ADDR_0],\r
 117                 (giTegra2Vid_FramebufferSize+PAGE_SIZE-1)/PAGE_SIZE\r
 118                 );\r
 119         memset(gpTegra2Vid_Framebuffer, 0xFF, 0x1000);\r
 120 \r
 121 //      gpTegra2Vid_IOMem[DC_WIN_A_WIN_OPTIONS_0] &= ~0x40;\r
 122         gpTegra2Vid_IOMem[DC_WIN_A_COLOR_DEPTH_0] = 12; // Could be 13 (BGR/RGB)\r
 123         gTegra2Vid_DrvUtil_BufInfo.Width = 1024;\r
 124         gTegra2Vid_DrvUtil_BufInfo.Height = 768;\r
 125         gTegra2Vid_DrvUtil_BufInfo.Pitch = 1024*4;\r
 126         gTegra2Vid_DrvUtil_BufInfo.Depth = 32;\r
 127         gTegra2Vid_DrvUtil_BufInfo.Framebuffer = gpTegra2Vid_Framebuffer;\r
 128 \r
 129 \r
 130 //      Tegra2Vid_int_SetMode(4);\r
 131 \r
 132         DevFS_AddDevice( &gTegra2Vid_DriverStruct );\r
 133 \r
 134         return 0;\r
 135 }\r
 136 \r
 137 /**\r
 138  * \brief Clean up resources for driver unloading\r
 139  */\r
 140 void Tegra2Vid_Uninstall()\r
 141 {\r
 142 }\r
 143 \r
 144 /**\r
 145  * \brief Read from the framebuffer\r
 146  */\r
 147 size_t Tegra2Vid_Read(tVFS_Node *node, off_t off, size_t len, void *buffer)\r
 148 {\r
 149         return 0;\r
 150 }\r
 151 \r
 152 /**\r
 153  * \brief Write to the framebuffer\r
 154  */\r
 155 size_t Tegra2Vid_Write(tVFS_Node *Node, off_t Offset, size_t Length, const void *Buffer)\r
 156 {\r
 157         gTegra2Vid_DrvUtil_BufInfo.BufferFormat = giTegra2Vid_BufferMode;\r
 158         return DrvUtil_Video_WriteLFB(&gTegra2Vid_DrvUtil_BufInfo, Offset, Length, Buffer);\r
 159 }\r
 160 \r
 161 const char *csaTegra2Vid_IOCtls[] = {DRV_IOCTLNAMES, DRV_VIDEO_IOCTLNAMES, NULL};\r
 162 \r
 163 /**\r
 164  * \brief Handle messages to the device\r
 165  */\r
 166 int Tegra2Vid_IOCtl(tVFS_Node *Node, int ID, void *Data)\r
 167 {\r
 168          int    ret = -2;\r
 169         ENTER("pNode iID pData", Node, ID, Data);\r
 170         \r
 171         switch(ID)\r
 172         {\r
 173         BASE_IOCTLS(DRV_TYPE_VIDEO, "PL110", VERSION, csaTegra2Vid_IOCtls);\r
 174 \r
 175         case VIDEO_IOCTL_SETBUFFORMAT:\r
 176                 DrvUtil_Video_RemoveCursor( &gTegra2Vid_DrvUtil_BufInfo );\r
 177                 ret = giTegra2Vid_BufferMode;\r
 178                 if(Data)        giTegra2Vid_BufferMode = *(int*)Data;\r
 179                 if(gTegra2Vid_DrvUtil_BufInfo.BufferFormat == VIDEO_BUFFMT_TEXT)\r
 180                         DrvUtil_Video_SetCursor( &gTegra2Vid_DrvUtil_BufInfo, &gDrvUtil_TextModeCursor );\r
 181                 break;\r
 182         \r
 183         case VIDEO_IOCTL_GETSETMODE:\r
 184                 if(Data)\r
 185                 {\r
 186                          int    newMode;\r
 187                         \r
 188                         if( !CheckMem(Data, sizeof(int)) )\r
 189                                 LEAVE_RET('i', -1);\r
 190                         \r
 191                         newMode = *(int*)Data;\r
 192                         \r
 193                         if(newMode < 0 || newMode >= ciTegra2Vid_ModeCount)\r
 194                                 LEAVE_RET('i', -1);\r
 195 \r
 196                         if(newMode != giTegra2Vid_CurrentMode)\r
 197                         {\r
 198                                 giTegra2Vid_CurrentMode = newMode;\r
 199                                 Tegra2Vid_int_SetMode( newMode );\r
 200                         }\r
 201                 }\r
 202                 ret = giTegra2Vid_CurrentMode;\r
 203                 break;\r
 204         \r
 205         case VIDEO_IOCTL_FINDMODE:\r
 206                 {\r
 207                 tVideo_IOCtl_Mode *mode = Data;\r
 208                  int    closest=0, closestArea, reqArea = 0;\r
 209                 if(!Data || !CheckMem(Data, sizeof(tVideo_IOCtl_Mode)))\r
 210                         LEAVE_RET('i', -1);\r
 211                 if( mode->bpp != 32 )\r
 212                         LEAVE_RET('i', 0);\r
 213                 if( mode->flags != 0 )\r
 214                         LEAVE_RET('i', 0);\r
 215 \r
 216                 // DEBUG!!!\r
 217                 mode->width = 1024;\r
 218                 mode->height = 768;\r
 219                 break;\r
 220 \r
 221                 ret = 0;\r
 222 \r
 223                 for( int i = 0; i < ciTegra2Vid_ModeCount; i ++ )\r
 224                 {\r
 225                          int    area;\r
 226                         if(mode->width == caTegra2Vid_Modes[i].W && mode->height == caTegra2Vid_Modes[i].H) {\r
 227                                 mode->id = i;\r
 228                                 ret = 1;\r
 229                                 break;\r
 230                         }\r
 231                         \r
 232                         area = caTegra2Vid_Modes[i].W * caTegra2Vid_Modes[i].H;\r
 233                         if(!reqArea) {\r
 234                                 reqArea = mode->width * mode->height;\r
 235                                 closest = i;\r
 236                                 closestArea = area;\r
 237                         }\r
 238                         else if( ABS(area - reqArea) < ABS(closestArea - reqArea) ) {\r
 239                                 closest = i;\r
 240                                 closestArea = area;\r
 241                         }\r
 242                 }\r
 243                 \r
 244                 if( ret == 0 )\r
 245                 {\r
 246                         mode->id = closest;\r
 247                         ret = 1;\r
 248                 }\r
 249                 mode->width = caTegra2Vid_Modes[mode->id].W;\r
 250                 mode->height = caTegra2Vid_Modes[mode->id].H;\r
 251                 break;\r
 252                 }\r
 253         \r
 254         case VIDEO_IOCTL_MODEINFO:\r
 255                 {\r
 256                 tVideo_IOCtl_Mode *mode = Data;\r
 257                 if(!Data || !CheckMem(Data, sizeof(tVideo_IOCtl_Mode)))\r
 258                         LEAVE_RET('i', -1);\r
 259                 if(mode->id < 0 || mode->id >= ciTegra2Vid_ModeCount)\r
 260                         LEAVE_RET('i', 0);\r
 261                 \r
 262 \r
 263                 mode->bpp = 32;\r
 264                 mode->flags = 0;\r
 265                 mode->width = caTegra2Vid_Modes[mode->id].W;\r
 266                 mode->height = caTegra2Vid_Modes[mode->id].H;\r
 267 \r
 268                 ret = 1;\r
 269                 break;\r
 270                 }\r
 271         \r
 272         case VIDEO_IOCTL_SETCURSOR:\r
 273                 if( !Data || !CheckMem(Data, sizeof(tVideo_IOCtl_Pos)) )\r
 274                         LEAVE_RET('i', -1);\r
 275 \r
 276                 DrvUtil_Video_RemoveCursor( &gTegra2Vid_DrvUtil_BufInfo );\r
 277                 \r
 278                 gTegra2Vid_CursorPos = *(tVideo_IOCtl_Pos*)Data;\r
 279                 if(gTegra2Vid_DrvUtil_BufInfo.BufferFormat == VIDEO_BUFFMT_TEXT)\r
 280                         DrvUtil_Video_DrawCursor(\r
 281                                 &gTegra2Vid_DrvUtil_BufInfo,\r
 282                                 gTegra2Vid_CursorPos.x*giVT_CharWidth,\r
 283                                 gTegra2Vid_CursorPos.y*giVT_CharHeight\r
 284                                 );\r
 285                 else\r
 286                         DrvUtil_Video_DrawCursor(\r
 287                                 &gTegra2Vid_DrvUtil_BufInfo,\r
 288                                 gTegra2Vid_CursorPos.x,\r
 289                                 gTegra2Vid_CursorPos.y\r
 290                                 );\r
 291                 break;\r
 292         \r
 293         default:\r
 294                 LEAVE('i', -2);\r
 295                 return -2;\r
 296         }\r
 297         \r
 298         LEAVE('i', ret);\r
 299         return ret;\r
 300 }\r
 301 \r
 302 //\r
 303 //\r
 304 //\r
 305 \r
 306 int Tegra2Vid_int_SetMode(int Mode)\r
 307 {\r
 308         const struct sTegra2_Disp_Mode  *mode = &caTegra2Vid_Modes[Mode];\r
 309          int    w = mode->W, h = mode->H;       // Horizontal/Vertical Active\r
 310         *(Uint32*)(gpTegra2Vid_IOMem + DC_DISP_FRONT_PORCH_0) = (mode->VFP << 16) | mode->HFP; \r
 311         *(Uint32*)(gpTegra2Vid_IOMem + DC_DISP_SYNC_WIDTH_0)  = (mode->HS << 16)  | mode->HS;\r
 312         *(Uint32*)(gpTegra2Vid_IOMem + DC_DISP_BACK_PORCH_0)  = (mode->VBP << 16) | mode->HBP;\r
 313         *(Uint32*)(gpTegra2Vid_IOMem + DC_DISP_DISP_ACTIVE_0) = (mode->H << 16)   | mode->W;\r
 314 \r
 315         *(Uint32*)(gpTegra2Vid_IOMem + DC_WIN_A_POSITION_0) = 0;\r
 316         *(Uint32*)(gpTegra2Vid_IOMem + DC_WIN_A_SIZE_0) = (h << 16) | w;\r
 317         *(Uint32*)(gpTegra2Vid_IOMem + DC_DISP_DISP_COLOR_CONTROL_0) = 0x8;     // BASE888\r
 318         *(Uint32*)(gpTegra2Vid_IOMem + DC_WIN_A_COLOR_DEPTH_0) = 12;    // Could be 13 (BGR/RGB)\r
 319         *(Uint32*)(gpTegra2Vid_IOMem + DC_WIN_A_PRESCALED_SIZE_0) = (h << 16) | w;\r
 320 \r
 321         Log_Debug("Tegra2Vid", "Mode %i (%ix%i) selected", Mode, w, h);\r
 322 \r
 323         if( !gpTegra2Vid_Framebuffer || w*h*4 != giTegra2Vid_FramebufferSize )\r
 324         {\r
 325                 if( gpTegra2Vid_Framebuffer )\r
 326                 {\r
 327                         // TODO: Free framebuffer for reallocation\r
 328                 }\r
 329 \r
 330                 giTegra2Vid_FramebufferSize = w*h*4;            \r
 331 \r
 332                 gpTegra2Vid_Framebuffer = (void*)MM_AllocDMA(\r
 333                         (giTegra2Vid_FramebufferSize + PAGE_SIZE-1) / PAGE_SIZE,\r
 334                         32,\r
 335                         &gTegra2Vid_FramebufferPhys\r
 336                         );\r
 337                 // TODO: Catch allocation failures\r
 338                 Log_Debug("Tegra2Vid", "0x%x byte framebuffer at %p (%P phys)",\r
 339                                 giTegra2Vid_FramebufferSize,\r
 340                                 gpTegra2Vid_Framebuffer,\r
 341                                 gTegra2Vid_FramebufferPhys\r
 342                                 );\r
 343                 \r
 344                 // Tell hardware\r
 345                 *(Uint32*)(gpTegra2Vid_IOMem + DC_WINBUF_A_START_ADDR_0) = gTegra2Vid_FramebufferPhys;\r
 346                 *(Uint32*)(gpTegra2Vid_IOMem + DC_WINBUF_A_ADDR_V_OFFSET_0) = 0;        // Y offset\r
 347                 *(Uint32*)(gpTegra2Vid_IOMem + DC_WINBUF_A_ADDR_H_OFFSET_0) = 0;        // X offset\r
 348         }\r
 349 \r
 350         return 0;\r
 351 }\r