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 \r
  23 #define ABS(a)  ((a)>0?(a):-(a))\r
  24 \r
  25 // === TYPEDEFS ===\r
  26 typedef struct sPL110   tPL110;\r
  27 \r
  28 struct sPL110\r
  29 {\r
  30         Uint32  LCDTiming0;\r
  31         Uint32  LCDTiming1;\r
  32         Uint32  LCDTiming2;\r
  33         Uint32  LCDTiming3;\r
  34         \r
  35         Uint32  LCDUPBase;\r
  36         Uint32  LCDLPBase;\r
  37         Uint32  LCDIMSC;\r
  38         Uint32  LCDControl;\r
  39         Uint32  LCDRIS;\r
  40         Uint32  LCDMIS;\r
  41         Uint32  LCDICR;\r
  42         Uint32  LCDUPCurr;\r
  43         Uint32  LCDLPCurr;\r
  44 };\r
  45 \r
  46 // === CONSTANTS ===\r
  47 #define PL110_BASE      0x10020000      // Integrator\r
  48 \r
  49 const struct {\r
  50         short W, H;\r
  51 }       caPL110_Modes[] = {\r
  52         {640,480},\r
  53         {800,600},\r
  54         {1024,768}      // MAX\r
  55 };\r
  56 const int       ciPL110_ModeCount = sizeof(caPL110_Modes)/sizeof(caPL110_Modes[0]);\r
  57 \r
  58 // === PROTOTYPES ===\r
  59 // Driver\r
  60  int    PL110_Install(char **Arguments);\r
  61 void    PL110_Uninstall();\r
  62 // Internal\r
  63 // Filesystem\r
  64 Uint64  PL110_Read(tVFS_Node *node, Uint64 off, Uint64 len, void *buffer);\r
  65 Uint64  PL110_Write(tVFS_Node *node, Uint64 off, Uint64 len, void *buffer);\r
  66  int    PL110_IOCtl(tVFS_Node *node, int id, void *data);\r
  67 // -- Internals\r
  68  int    PL110_int_SetResolution(int W, int H);\r
  69 \r
  70 // === GLOBALS ===\r
  71 MODULE_DEFINE(0, VERSION, PL110, PL110_Install, NULL, NULL);\r
  72 tDevFS_Driver   gPL110_DriverStruct = {\r
  73         NULL, "PL110",\r
  74         {\r
  75         .Read = PL110_Read,\r
  76         .Write = PL110_Write,\r
  77         .IOCtl = PL110_IOCtl\r
  78         }\r
  79 };\r
  80 // -- Options\r
  81 tPAddr  gPL110_PhysBase = PL110_BASE;\r
  82 // -- KeyVal parse rules\r
  83 const tKeyVal_ParseRules        gPL110_KeyValueParser = {\r
  84         NULL,\r
  85         {\r
  86                 {"Base", "P", &gPL110_PhysBase},\r
  87                 {NULL, NULL, NULL}\r
  88         }\r
  89 };\r
  90 // -- Driver state\r
  91  int    giPL110_CurrentMode = 0;\r
  92  int    giPL110_BufferMode;\r
  93  int    giPL110_Width = 640;\r
  94  int    giPL110_Height = 480;\r
  95 size_t  giPL110_FramebufferSize;\r
  96 tPL110  *gpPL110_IOMem;\r
  97 tPAddr  gPL110_FramebufferPhys;\r
  98 void    *gpPL110_Framebuffer;\r
  99 // -- Misc\r
 100 tDrvUtil_Video_BufInfo  gPL110_DrvUtil_BufInfo;\r
 101 \r
 102 // === CODE ===\r
 103 /**\r
 104  */\r
 105 int PL110_Install(char **Arguments)\r
 106 {\r
 107 //      KeyVal_Parse(&gPL110_KeyValueParser, Arguments);\r
 108         \r
 109         gpPL110_IOMem = (void*)MM_MapHWPages(gPL110_PhysBase, 1);\r
 110 \r
 111         PL110_int_SetResolution(caPL110_Modes[0].W, caPL110_Modes[0].H);\r
 112 \r
 113         DevFS_AddDevice( &gPL110_DriverStruct );\r
 114 \r
 115         return 0;\r
 116 }\r
 117 \r
 118 /**\r
 119  * \brief Clean up resources for driver unloading\r
 120  */\r
 121 void PL110_Uninstall()\r
 122 {\r
 123 }\r
 124 \r
 125 /**\r
 126  * \brief Read from the framebuffer\r
 127  */\r
 128 Uint64 PL110_Read(tVFS_Node *node, Uint64 off, Uint64 len, void *buffer)\r
 129 {\r
 130         return 0;\r
 131 }\r
 132 \r
 133 /**\r
 134  * \brief Write to the framebuffer\r
 135  */\r
 136 Uint64 PL110_Write(tVFS_Node *Node, Uint64 Offset, Uint64 Length, void *Buffer)\r
 137 {\r
 138         gPL110_DrvUtil_BufInfo.BufferFormat = giPL110_BufferMode;\r
 139         return DrvUtil_Video_WriteLFB(&gPL110_DrvUtil_BufInfo, Offset, Length, Buffer);\r
 140 }\r
 141 \r
 142 const char *csaPL110_IOCtls[] = {DRV_IOCTLNAMES, DRV_VIDEO_IOCTLNAMES, NULL};\r
 143 \r
 144 /**\r
 145  * \brief Handle messages to the device\r
 146  */\r
 147 int PL110_IOCtl(tVFS_Node *Node, int ID, void *Data)\r
 148 {\r
 149          int    ret = -2;\r
 150         ENTER("pNode iID pData", Node, ID, Data);\r
 151         \r
 152         switch(ID)\r
 153         {\r
 154         BASE_IOCTLS(DRV_TYPE_VIDEO, "PL110", VERSION, csaPL110_IOCtls);\r
 155 \r
 156         case VIDEO_IOCTL_SETBUFFORMAT:\r
 157                 ret = giPL110_BufferMode;\r
 158                 if(Data)        giPL110_BufferMode = *(int*)Data;\r
 159                 break;\r
 160         \r
 161         case VIDEO_IOCTL_GETSETMODE:\r
 162                 if(Data)\r
 163                 {\r
 164                          int    newMode;\r
 165                         \r
 166                         if( !CheckMem(Data, sizeof(int)) )\r
 167                                 LEAVE_RET('i', -1);\r
 168                         \r
 169                         newMode = *(int*)Data;\r
 170                         \r
 171                         if(newMode < 0 || newMode >= ciPL110_ModeCount)\r
 172                                 LEAVE_RET('i', -1);\r
 173 \r
 174                         if(newMode != giPL110_CurrentMode)\r
 175                         {\r
 176                                 giPL110_CurrentMode = newMode;\r
 177                                 PL110_int_SetResolution( caPL110_Modes[newMode].W, caPL110_Modes[newMode].H );\r
 178                         }\r
 179                 }\r
 180                 ret = giPL110_CurrentMode;\r
 181                 break;\r
 182         \r
 183         case VIDEO_IOCTL_FINDMODE:\r
 184                 {\r
 185                 tVideo_IOCtl_Mode *mode = Data;\r
 186                  int    closest, closestArea, reqArea = 0;\r
 187                 if(!Data || !CheckMem(Data, sizeof(tVideo_IOCtl_Mode)))\r
 188                         LEAVE_RET('i', -1);\r
 189                 if( mode->bpp != 32 )\r
 190                         LEAVE_RET('i', 0);\r
 191                 if( mode->flags != 0 )\r
 192                         LEAVE_RET('i', 0);\r
 193 \r
 194                 ret = 0;\r
 195 \r
 196                 for( int i = 0; i < ciPL110_ModeCount; i ++ )\r
 197                 {\r
 198                          int    area;\r
 199                         if(mode->width == caPL110_Modes[i].W && mode->height == caPL110_Modes[i].H) {\r
 200                                 mode->id = i;\r
 201                                 ret = 1;\r
 202                                 break;\r
 203                         }\r
 204                         \r
 205                         area = caPL110_Modes[i].W * caPL110_Modes[i].H;\r
 206                         if(!reqArea) {\r
 207                                 reqArea = mode->width * mode->height;\r
 208                                 closest = i;\r
 209                                 closestArea = area;\r
 210                         }\r
 211                         else if( ABS(area - reqArea) < ABS(closestArea - reqArea) ) {\r
 212                                 closest = i;\r
 213                                 closestArea = area;\r
 214                         }\r
 215                 }\r
 216                 \r
 217                 if( ret == 0 )\r
 218                 {\r
 219                         mode->id = closest;\r
 220                         ret = 1;\r
 221                 }\r
 222                 mode->width = caPL110_Modes[mode->id].W;\r
 223                 mode->height = caPL110_Modes[mode->id].H;\r
 224                 break;\r
 225                 }\r
 226         \r
 227         case VIDEO_IOCTL_MODEINFO:\r
 228                 {\r
 229                 tVideo_IOCtl_Mode *mode = Data;\r
 230                 if(!Data || !CheckMem(Data, sizeof(tVideo_IOCtl_Mode)))\r
 231                         LEAVE_RET('i', -1);\r
 232                 if(mode->id < 0 || mode->id >= ciPL110_ModeCount)\r
 233                         LEAVE_RET('i', 0);\r
 234                 \r
 235 \r
 236                 mode->bpp = 32;\r
 237                 mode->flags = 0;\r
 238                 mode->width = caPL110_Modes[mode->id].W;\r
 239                 mode->height = caPL110_Modes[mode->id].H;\r
 240 \r
 241                 ret = 1;\r
 242                 break;\r
 243                 }\r
 244         \r
 245         case VIDEO_IOCTL_SETCURSOR:     break;\r
 246         \r
 247         default:\r
 248                 LEAVE('i', -2);\r
 249                 return -2;\r
 250         }\r
 251         \r
 252         LEAVE('i', ret);\r
 253         return ret;\r
 254 }\r
 255 \r
 256 //\r
 257 //\r
 258 //\r
 259 \r
 260 /**\r
 261  */\r
 262 int PL110_int_SetResolution(int W, int H)\r
 263 {\r
 264         W = (W + 15)/16;\r
 265         if(W > 1024)    W = 1024;\r
 266         if(H > 768)     H = 768;\r
 267 \r
 268         gpPL110_IOMem->LCDTiming0 = ((W/16)-1) << 2;\r
 269         gpPL110_IOMem->LCDTiming1 = H-1;\r
 270         gpPL110_IOMem->LCDTiming2 = (14 << 27);\r
 271         gpPL110_IOMem->LCDTiming3 = 0;\r
 272 \r
 273         if( gpPL110_Framebuffer ) {\r
 274                 MM_UnmapHWPages((tVAddr)gpPL110_Framebuffer, (giPL110_FramebufferSize+0xFFF)>>12);\r
 275         }\r
 276         giPL110_FramebufferSize = W*H*4;\r
 277 \r
 278         gpPL110_Framebuffer = (void*)MM_AllocDMA( (giPL110_FramebufferSize+0xFFF)>>12, 32, &gPL110_FramebufferPhys );\r
 279         gpPL110_IOMem->LCDUPBase = gPL110_FramebufferPhys;\r
 280         gpPL110_IOMem->LCDLPBase = 0;\r
 281 \r
 282         gpPL110_IOMem->LCDIMSC = 0;\r
 283         gpPL110_IOMem->LCDControl = (1 << 11)|(1 << 5)|(5<<1)|1;\r
 284 \r
 285         giPL110_Width = W;\r
 286         giPL110_Height = H;\r
 287 \r
 288         // Update the DrvUtil buffer info\r
 289         gPL110_DrvUtil_BufInfo.Framebuffer = gpPL110_Framebuffer;\r
 290         gPL110_DrvUtil_BufInfo.Pitch = W * 4;\r
 291         gPL110_DrvUtil_BufInfo.Width = W;\r
 292         gPL110_DrvUtil_BufInfo.Height = H;\r
 293         gPL110_DrvUtil_BufInfo.Depth = 32;\r
 294         \r
 295         return 0;\r
 296 }\r