Modules/Display/PL110/main.c

   1 /**\r
   2  * Acess2 ARM PrimeCell Colour LCD Controller (PL110) Driver\r
   3  * - By John Hodge (thePowersGang)\r
   4  *\r
   5  * main.c\r
   6  * - Driver core\r
   7  *\r
   8  *\r
   9  * NOTE: The PL110 is set to 24bpp, but these are stored as 32-bit words.\r
  10  *       This corresponds to the Acess 32bpp mode, as the Acess 24bpp is packed\r
  11  */\r
  12 #define DEBUG   0\r
  13 #define VERSION ((0<<8)|10)\r
  14 #include <acess.h>\r
  15 #include <errno.h>\r
  16 #include <modules.h>\r
  17 #include <vfs.h>\r
  18 #include <fs_devfs.h>\r
  19 #include <drv_pci.h>\r
  20 #include <api_drv_video.h>\r
  21 #include <lib/keyvalue.h>\r
  22 #include <options.h>    // ARM Arch\r
  23 \r
  24 #define ABS(a)  ((a)>0?(a):-(a))\r
  25 \r
  26 // === TYPEDEFS ===\r
  27 typedef struct sPL110   tPL110;\r
  28 \r
  29 struct sPL110\r
  30 {\r
  31         Uint32  LCDTiming0;\r
  32         Uint32  LCDTiming1;\r
  33         Uint32  LCDTiming2;\r
  34         Uint32  LCDTiming3;\r
  35         \r
  36         Uint32  LCDUPBase;\r
  37         Uint32  LCDLPBase;\r
  38         Uint32  LCDIMSC;\r
  39         Uint32  LCDControl;\r
  40         Uint32  LCDRIS;\r
  41         Uint32  LCDMIS;\r
  42         Uint32  LCDICR;\r
  43         Uint32  LCDUPCurr;\r
  44         Uint32  LCDLPCurr;\r
  45 };\r
  46 \r
  47 #ifndef PL110_BASE\r
  48 #define PL110_BASE      0x10020000      // Integrator\r
  49 #endif\r
  50 \r
  51 // === CONSTANTS ===\r
  52 const struct {\r
  53         short W, H;\r
  54 }       caPL110_Modes[] = {\r
  55         {640,480},\r
  56         {800,600},\r
  57         {1024,768}      // MAX\r
  58 };\r
  59 const int       ciPL110_ModeCount = sizeof(caPL110_Modes)/sizeof(caPL110_Modes[0]);\r
  60 \r
  61 // === PROTOTYPES ===\r
  62 // Driver\r
  63  int    PL110_Install(char **Arguments);\r
  64 void    PL110_Uninstall();\r
  65 // Internal\r
  66 // Filesystem\r
  67 Uint64  PL110_Read(tVFS_Node *node, Uint64 off, Uint64 len, void *buffer);\r
  68 Uint64  PL110_Write(tVFS_Node *node, Uint64 off, Uint64 len, void *buffer);\r
  69  int    PL110_IOCtl(tVFS_Node *node, int id, void *data);\r
  70 // -- Internals\r
  71  int    PL110_int_SetResolution(int W, int H);\r
  72 \r
  73 // === GLOBALS ===\r
  74 MODULE_DEFINE(0, VERSION, PL110, PL110_Install, NULL, NULL);\r
  75 tDevFS_Driver   gPL110_DriverStruct = {\r
  76         NULL, "PL110",\r
  77         {\r
  78         .Read = PL110_Read,\r
  79         .Write = PL110_Write,\r
  80         .IOCtl = PL110_IOCtl\r
  81         }\r
  82 };\r
  83 // -- Options\r
  84 tPAddr  gPL110_PhysBase = PL110_BASE;\r
  85  int    gbPL110_IsVersatile = 1;\r
  86 // -- KeyVal parse rules\r
  87 const tKeyVal_ParseRules        gPL110_KeyValueParser = {\r
  88         NULL,\r
  89         {\r
  90                 {"Base", "P", &gPL110_PhysBase},\r
  91                 {"IsVersatile", "i", &gbPL110_IsVersatile},\r
  92                 {NULL, NULL, NULL}\r
  93         }\r
  94 };\r
  95 // -- Driver state\r
  96  int    giPL110_CurrentMode = 0;\r
  97  int    giPL110_BufferMode;\r
  98  int    giPL110_Width = 640;\r
  99  int    giPL110_Height = 480;\r
 100 size_t  giPL110_FramebufferSize;\r
 101 tPL110  *gpPL110_IOMem;\r
 102 tPAddr  gPL110_FramebufferPhys;\r
 103 void    *gpPL110_Framebuffer;\r
 104 // -- Misc\r
 105 tDrvUtil_Video_BufInfo  gPL110_DrvUtil_BufInfo;\r
 106 tVideo_IOCtl_Pos        gPL110_CursorPos;\r
 107 \r
 108 // === CODE ===\r
 109 /**\r
 110  */\r
 111 int PL110_Install(char **Arguments)\r
 112 {\r
 113 //      KeyVal_Parse(&gPL110_KeyValueParser, Arguments);\r
 114         \r
 115         gpPL110_IOMem = (void*)MM_MapHWPages(gPL110_PhysBase, 1);\r
 116 \r
 117         PL110_int_SetResolution(caPL110_Modes[0].W, caPL110_Modes[0].H);\r
 118 \r
 119         DevFS_AddDevice( &gPL110_DriverStruct );\r
 120 \r
 121         return 0;\r
 122 }\r
 123 \r
 124 /**\r
 125  * \brief Clean up resources for driver unloading\r
 126  */\r
 127 void PL110_Uninstall()\r
 128 {\r
 129 }\r
 130 \r
 131 /**\r
 132  * \brief Read from the framebuffer\r
 133  */\r
 134 Uint64 PL110_Read(tVFS_Node *node, Uint64 off, Uint64 len, void *buffer)\r
 135 {\r
 136         return 0;\r
 137 }\r
 138 \r
 139 /**\r
 140  * \brief Write to the framebuffer\r
 141  */\r
 142 Uint64 PL110_Write(tVFS_Node *Node, Uint64 Offset, Uint64 Length, void *Buffer)\r
 143 {\r
 144         gPL110_DrvUtil_BufInfo.BufferFormat = giPL110_BufferMode;\r
 145         return DrvUtil_Video_WriteLFB(&gPL110_DrvUtil_BufInfo, Offset, Length, Buffer);\r
 146 }\r
 147 \r
 148 const char *csaPL110_IOCtls[] = {DRV_IOCTLNAMES, DRV_VIDEO_IOCTLNAMES, NULL};\r
 149 \r
 150 /**\r
 151  * \brief Handle messages to the device\r
 152  */\r
 153 int PL110_IOCtl(tVFS_Node *Node, int ID, void *Data)\r
 154 {\r
 155          int    ret = -2;\r
 156         ENTER("pNode iID pData", Node, ID, Data);\r
 157         \r
 158         switch(ID)\r
 159         {\r
 160         BASE_IOCTLS(DRV_TYPE_VIDEO, "PL110", VERSION, csaPL110_IOCtls);\r
 161 \r
 162         case VIDEO_IOCTL_SETBUFFORMAT:\r
 163                 DrvUtil_Video_RemoveCursor( &gPL110_DrvUtil_BufInfo );\r
 164                 ret = giPL110_BufferMode;\r
 165                 if(Data)        giPL110_BufferMode = *(int*)Data;\r
 166                 if(gPL110_DrvUtil_BufInfo.BufferFormat == VIDEO_BUFFMT_TEXT)\r
 167                         DrvUtil_Video_SetCursor( &gPL110_DrvUtil_BufInfo, &gDrvUtil_TextModeCursor );\r
 168                 break;\r
 169         \r
 170         case VIDEO_IOCTL_GETSETMODE:\r
 171                 if(Data)\r
 172                 {\r
 173                          int    newMode;\r
 174                         \r
 175                         if( !CheckMem(Data, sizeof(int)) )\r
 176                                 LEAVE_RET('i', -1);\r
 177                         \r
 178                         newMode = *(int*)Data;\r
 179                         \r
 180                         if(newMode < 0 || newMode >= ciPL110_ModeCount)\r
 181                                 LEAVE_RET('i', -1);\r
 182 \r
 183                         if(newMode != giPL110_CurrentMode)\r
 184                         {\r
 185                                 giPL110_CurrentMode = newMode;\r
 186                                 PL110_int_SetResolution( caPL110_Modes[newMode].W, caPL110_Modes[newMode].H );\r
 187                         }\r
 188                 }\r
 189                 ret = giPL110_CurrentMode;\r
 190                 break;\r
 191         \r
 192         case VIDEO_IOCTL_FINDMODE:\r
 193                 {\r
 194                 tVideo_IOCtl_Mode *mode = Data;\r
 195                  int    closest, closestArea, reqArea = 0;\r
 196                 if(!Data || !CheckMem(Data, sizeof(tVideo_IOCtl_Mode)))\r
 197                         LEAVE_RET('i', -1);\r
 198                 if( mode->bpp != 32 )\r
 199                         LEAVE_RET('i', 0);\r
 200                 if( mode->flags != 0 )\r
 201                         LEAVE_RET('i', 0);\r
 202 \r
 203                 ret = 0;\r
 204 \r
 205                 for( int i = 0; i < ciPL110_ModeCount; i ++ )\r
 206                 {\r
 207                          int    area;\r
 208                         if(mode->width == caPL110_Modes[i].W && mode->height == caPL110_Modes[i].H) {\r
 209                                 mode->id = i;\r
 210                                 ret = 1;\r
 211                                 break;\r
 212                         }\r
 213                         \r
 214                         area = caPL110_Modes[i].W * caPL110_Modes[i].H;\r
 215                         if(!reqArea) {\r
 216                                 reqArea = mode->width * mode->height;\r
 217                                 closest = i;\r
 218                                 closestArea = area;\r
 219                         }\r
 220                         else if( ABS(area - reqArea) < ABS(closestArea - reqArea) ) {\r
 221                                 closest = i;\r
 222                                 closestArea = area;\r
 223                         }\r
 224                 }\r
 225                 \r
 226                 if( ret == 0 )\r
 227                 {\r
 228                         mode->id = closest;\r
 229                         ret = 1;\r
 230                 }\r
 231                 mode->width = caPL110_Modes[mode->id].W;\r
 232                 mode->height = caPL110_Modes[mode->id].H;\r
 233                 break;\r
 234                 }\r
 235         \r
 236         case VIDEO_IOCTL_MODEINFO:\r
 237                 {\r
 238                 tVideo_IOCtl_Mode *mode = Data;\r
 239                 if(!Data || !CheckMem(Data, sizeof(tVideo_IOCtl_Mode)))\r
 240                         LEAVE_RET('i', -1);\r
 241                 if(mode->id < 0 || mode->id >= ciPL110_ModeCount)\r
 242                         LEAVE_RET('i', 0);\r
 243                 \r
 244 \r
 245                 mode->bpp = 32;\r
 246                 mode->flags = 0;\r
 247                 mode->width = caPL110_Modes[mode->id].W;\r
 248                 mode->height = caPL110_Modes[mode->id].H;\r
 249 \r
 250                 ret = 1;\r
 251                 break;\r
 252                 }\r
 253         \r
 254         case VIDEO_IOCTL_SETCURSOR:\r
 255                 if( !Data || !CheckMem(Data, sizeof(tVideo_IOCtl_Pos)) )\r
 256                         LEAVE_RET('i', -1);\r
 257 \r
 258                 DrvUtil_Video_RemoveCursor( &gPL110_DrvUtil_BufInfo );\r
 259                 \r
 260                 gPL110_CursorPos = *(tVideo_IOCtl_Pos*)Data;\r
 261                 if(gPL110_DrvUtil_BufInfo.BufferFormat == VIDEO_BUFFMT_TEXT)\r
 262                         DrvUtil_Video_DrawCursor(\r
 263                                 &gPL110_DrvUtil_BufInfo,\r
 264                                 gPL110_CursorPos.x*giVT_CharWidth,\r
 265                                 gPL110_CursorPos.y*giVT_CharHeight\r
 266                                 );\r
 267                 else\r
 268                         DrvUtil_Video_DrawCursor(\r
 269                                 &gPL110_DrvUtil_BufInfo,\r
 270                                 gPL110_CursorPos.x,\r
 271                                 gPL110_CursorPos.y\r
 272                                 );\r
 273                 break;\r
 274         \r
 275         default:\r
 276                 LEAVE('i', -2);\r
 277                 return -2;\r
 278         }\r
 279         \r
 280         LEAVE('i', ret);\r
 281         return ret;\r
 282 }\r
 283 \r
 284 //\r
 285 //\r
 286 //\r
 287 \r
 288 /**\r
 289  * \brief Set the LCD controller resolution\r
 290  * \param W     Width (aligned to 16 pixels, cipped to 1024)\r
 291  * \param H     Height (clipped to 768)\r
 292  * \return Boolean failure\r
 293  */\r
 294 int PL110_int_SetResolution(int W, int H)\r
 295 {\r
 296         W = (W + 15) & ~0xF;\r
 297         if(W <= 0 || H <= 0) {\r
 298                 Log_Warning("PL110", "Attempted to set invalid resolution (%ix%i)", W, H);\r
 299                 return 1;\r
 300         }\r
 301         if(W > 1024)    W = 1024;\r
 302         if(H > 768)     H = 768;\r
 303 \r
 304         gpPL110_IOMem->LCDTiming0 = ((W/16)-1) << 2;\r
 305         gpPL110_IOMem->LCDTiming1 = H-1;\r
 306         gpPL110_IOMem->LCDTiming2 = (14 << 27);\r
 307         gpPL110_IOMem->LCDTiming3 = 0;\r
 308 \r
 309         if( gpPL110_Framebuffer ) {\r
 310                 MM_UnmapHWPages((tVAddr)gpPL110_Framebuffer, (giPL110_FramebufferSize+0xFFF)>>12);\r
 311         }\r
 312         giPL110_FramebufferSize = W*H*4;\r
 313 \r
 314         gpPL110_Framebuffer = (void*)MM_AllocDMA( (giPL110_FramebufferSize+0xFFF)>>12, 32, &gPL110_FramebufferPhys );\r
 315         gpPL110_IOMem->LCDUPBase = gPL110_FramebufferPhys;\r
 316         gpPL110_IOMem->LCDLPBase = 0;\r
 317 \r
 318         // Power on, BGR mode, ???, ???, enabled\r
 319         Uint32  controlWord = (1 << 11)|(1 << 8)|(1 << 5)|(5 << 1)|1;\r
 320         // According to qemu, the Versatile version has these two the wrong\r
 321         // way around\r
 322         if( gbPL110_IsVersatile )\r
 323         {\r
 324                 gpPL110_IOMem->LCDIMSC = controlWord;   // Actually LCDControl\r
 325                 gpPL110_IOMem->LCDControl = 0;  // Actually LCDIMSC\r
 326         }\r
 327         else\r
 328         {\r
 329                 gpPL110_IOMem->LCDIMSC = 0;\r
 330                 gpPL110_IOMem->LCDControl = controlWord;\r
 331         }\r
 332 \r
 333         giPL110_Width = W;\r
 334         giPL110_Height = H;\r
 335 \r
 336         // Update the DrvUtil buffer info\r
 337         gPL110_DrvUtil_BufInfo.Framebuffer = gpPL110_Framebuffer;\r
 338         gPL110_DrvUtil_BufInfo.Pitch = W * 4;\r
 339         gPL110_DrvUtil_BufInfo.Width = W;\r
 340         gPL110_DrvUtil_BufInfo.Height = H;\r
 341         gPL110_DrvUtil_BufInfo.Depth = 32;\r
 342         \r
 343         return 0;\r
 344 }\r