da8xx-fb.c 35 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427
  1. /*
  2. * Copyright (C) 2008-2009 MontaVista Software Inc.
  3. * Copyright (C) 2008-2009 Texas Instruments Inc
  4. *
  5. * Based on the LCD driver for TI Avalanche processors written by
  6. * Ajay Singh and Shalom Hai.
  7. *
  8. * This program is free software; you can redistribute it and/or modify
  9. * it under the terms of the GNU General Public License as published by
  10. * the Free Software Foundation; either version 2 of the License, or
  11. * (at your option)any later version.
  12. *
  13. * This program is distributed in the hope that it will be useful,
  14. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  16. * GNU General Public License for more details.
  17. *
  18. * You should have received a copy of the GNU General Public License
  19. * along with this program; if not, write to the Free Software
  20. * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
  21. */
  22. #include <linux/module.h>
  23. #include <linux/kernel.h>
  24. #include <linux/fb.h>
  25. #include <linux/dma-mapping.h>
  26. #include <linux/device.h>
  27. #include <linux/platform_device.h>
  28. #include <linux/uaccess.h>
  29. #include <linux/interrupt.h>
  30. #include <linux/clk.h>
  31. #include <linux/cpufreq.h>
  32. #include <linux/console.h>
  33. #include <linux/slab.h>
  34. #include <video/da8xx-fb.h>
  35. #include <asm/div64.h>
  36. #define DRIVER_NAME "da8xx_lcdc"
  37. #define LCD_VERSION_1 1
  38. #define LCD_VERSION_2 2
  39. /* LCD Status Register */
  40. #define LCD_END_OF_FRAME1 BIT(9)
  41. #define LCD_END_OF_FRAME0 BIT(8)
  42. #define LCD_PL_LOAD_DONE BIT(6)
  43. #define LCD_FIFO_UNDERFLOW BIT(5)
  44. #define LCD_SYNC_LOST BIT(2)
  45. /* LCD DMA Control Register */
  46. #define LCD_DMA_BURST_SIZE(x) ((x) << 4)
  47. #define LCD_DMA_BURST_1 0x0
  48. #define LCD_DMA_BURST_2 0x1
  49. #define LCD_DMA_BURST_4 0x2
  50. #define LCD_DMA_BURST_8 0x3
  51. #define LCD_DMA_BURST_16 0x4
  52. #define LCD_V1_END_OF_FRAME_INT_ENA BIT(2)
  53. #define LCD_V2_END_OF_FRAME0_INT_ENA BIT(8)
  54. #define LCD_V2_END_OF_FRAME1_INT_ENA BIT(9)
  55. #define LCD_DUAL_FRAME_BUFFER_ENABLE BIT(0)
  56. /* LCD Control Register */
  57. #define LCD_CLK_DIVISOR(x) ((x) << 8)
  58. #define LCD_RASTER_MODE 0x01
  59. /* LCD Raster Control Register */
  60. #define LCD_PALETTE_LOAD_MODE(x) ((x) << 20)
  61. #define PALETTE_AND_DATA 0x00
  62. #define PALETTE_ONLY 0x01
  63. #define DATA_ONLY 0x02
  64. #define LCD_MONO_8BIT_MODE BIT(9)
  65. #define LCD_RASTER_ORDER BIT(8)
  66. #define LCD_TFT_MODE BIT(7)
  67. #define LCD_V1_UNDERFLOW_INT_ENA BIT(6)
  68. #define LCD_V2_UNDERFLOW_INT_ENA BIT(5)
  69. #define LCD_V1_PL_INT_ENA BIT(4)
  70. #define LCD_V2_PL_INT_ENA BIT(6)
  71. #define LCD_MONOCHROME_MODE BIT(1)
  72. #define LCD_RASTER_ENABLE BIT(0)
  73. #define LCD_TFT_ALT_ENABLE BIT(23)
  74. #define LCD_STN_565_ENABLE BIT(24)
  75. #define LCD_V2_DMA_CLK_EN BIT(2)
  76. #define LCD_V2_LIDD_CLK_EN BIT(1)
  77. #define LCD_V2_CORE_CLK_EN BIT(0)
  78. #define LCD_V2_LPP_B10 26
  79. /* LCD Raster Timing 2 Register */
  80. #define LCD_AC_BIAS_TRANSITIONS_PER_INT(x) ((x) << 16)
  81. #define LCD_AC_BIAS_FREQUENCY(x) ((x) << 8)
  82. #define LCD_SYNC_CTRL BIT(25)
  83. #define LCD_SYNC_EDGE BIT(24)
  84. #define LCD_INVERT_PIXEL_CLOCK BIT(22)
  85. #define LCD_INVERT_LINE_CLOCK BIT(21)
  86. #define LCD_INVERT_FRAME_CLOCK BIT(20)
  87. /* LCD Block */
  88. #define LCD_PID_REG 0x0
  89. #define LCD_CTRL_REG 0x4
  90. #define LCD_STAT_REG 0x8
  91. #define LCD_RASTER_CTRL_REG 0x28
  92. #define LCD_RASTER_TIMING_0_REG 0x2C
  93. #define LCD_RASTER_TIMING_1_REG 0x30
  94. #define LCD_RASTER_TIMING_2_REG 0x34
  95. #define LCD_DMA_CTRL_REG 0x40
  96. #define LCD_DMA_FRM_BUF_BASE_ADDR_0_REG 0x44
  97. #define LCD_DMA_FRM_BUF_CEILING_ADDR_0_REG 0x48
  98. #define LCD_DMA_FRM_BUF_BASE_ADDR_1_REG 0x4C
  99. #define LCD_DMA_FRM_BUF_CEILING_ADDR_1_REG 0x50
  100. /* Interrupt Registers available only in Version 2 */
  101. #define LCD_RAW_STAT_REG 0x58
  102. #define LCD_MASKED_STAT_REG 0x5c
  103. #define LCD_INT_ENABLE_SET_REG 0x60
  104. #define LCD_INT_ENABLE_CLR_REG 0x64
  105. #define LCD_END_OF_INT_IND_REG 0x68
  106. /* Clock registers available only on Version 2 */
  107. #define LCD_CLK_ENABLE_REG 0x6c
  108. #define LCD_CLK_RESET_REG 0x70
  109. #define LCD_CLK_MAIN_RESET BIT(3)
  110. #define LCD_NUM_BUFFERS 2
  111. #define WSI_TIMEOUT 50
  112. #define PALETTE_SIZE 256
  113. #define LEFT_MARGIN 64
  114. #define RIGHT_MARGIN 64
  115. #define UPPER_MARGIN 32
  116. #define LOWER_MARGIN 32
  117. static resource_size_t da8xx_fb_reg_base;
  118. static struct resource *lcdc_regs;
  119. static unsigned int lcd_revision;
  120. static irq_handler_t lcdc_irq_handler;
  121. static inline unsigned int lcdc_read(unsigned int addr)
  122. {
  123. return (unsigned int)__raw_readl(da8xx_fb_reg_base + (addr));
  124. }
  125. static inline void lcdc_write(unsigned int val, unsigned int addr)
  126. {
  127. __raw_writel(val, da8xx_fb_reg_base + (addr));
  128. }
  129. struct da8xx_fb_par {
  130. resource_size_t p_palette_base;
  131. unsigned char *v_palette_base;
  132. dma_addr_t vram_phys;
  133. unsigned long vram_size;
  134. void *vram_virt;
  135. unsigned int dma_start;
  136. unsigned int dma_end;
  137. struct clk *lcdc_clk;
  138. int irq;
  139. unsigned short pseudo_palette[16];
  140. unsigned int palette_sz;
  141. unsigned int pxl_clk;
  142. int blank;
  143. wait_queue_head_t vsync_wait;
  144. int vsync_flag;
  145. int vsync_timeout;
  146. #ifdef CONFIG_CPU_FREQ
  147. struct notifier_block freq_transition;
  148. unsigned int lcd_fck_rate;
  149. #endif
  150. void (*panel_power_ctrl)(int);
  151. };
  152. /* Variable Screen Information */
  153. static struct fb_var_screeninfo da8xx_fb_var __devinitdata = {
  154. .xoffset = 0,
  155. .yoffset = 0,
  156. .transp = {0, 0, 0},
  157. .nonstd = 0,
  158. .activate = 0,
  159. .height = -1,
  160. .width = -1,
  161. .accel_flags = 0,
  162. .left_margin = LEFT_MARGIN,
  163. .right_margin = RIGHT_MARGIN,
  164. .upper_margin = UPPER_MARGIN,
  165. .lower_margin = LOWER_MARGIN,
  166. .sync = 0,
  167. .vmode = FB_VMODE_NONINTERLACED
  168. };
  169. static struct fb_fix_screeninfo da8xx_fb_fix __devinitdata = {
  170. .id = "DA8xx FB Drv",
  171. .type = FB_TYPE_PACKED_PIXELS,
  172. .type_aux = 0,
  173. .visual = FB_VISUAL_PSEUDOCOLOR,
  174. .xpanstep = 0,
  175. .ypanstep = 1,
  176. .ywrapstep = 0,
  177. .accel = FB_ACCEL_NONE
  178. };
  179. struct da8xx_panel {
  180. const char name[25]; /* Full name <vendor>_<model> */
  181. unsigned short width;
  182. unsigned short height;
  183. int hfp; /* Horizontal front porch */
  184. int hbp; /* Horizontal back porch */
  185. int hsw; /* Horizontal Sync Pulse Width */
  186. int vfp; /* Vertical front porch */
  187. int vbp; /* Vertical back porch */
  188. int vsw; /* Vertical Sync Pulse Width */
  189. unsigned int pxl_clk; /* Pixel clock */
  190. unsigned char invert_pxl_clk; /* Invert Pixel clock */
  191. };
  192. static struct da8xx_panel known_lcd_panels[] = {
  193. /* Sharp LCD035Q3DG01 */
  194. [0] = {
  195. .name = "Sharp_LCD035Q3DG01",
  196. .width = 320,
  197. .height = 240,
  198. .hfp = 8,
  199. .hbp = 6,
  200. .hsw = 0,
  201. .vfp = 2,
  202. .vbp = 2,
  203. .vsw = 0,
  204. .pxl_clk = 4608000,
  205. .invert_pxl_clk = 1,
  206. },
  207. /* Sharp LK043T1DG01 */
  208. [1] = {
  209. .name = "Sharp_LK043T1DG01",
  210. .width = 480,
  211. .height = 272,
  212. .hfp = 2,
  213. .hbp = 2,
  214. .hsw = 41,
  215. .vfp = 2,
  216. .vbp = 2,
  217. .vsw = 10,
  218. .pxl_clk = 7833600,
  219. .invert_pxl_clk = 0,
  220. },
  221. [2] = {
  222. /* Hitachi SP10Q010 */
  223. .name = "SP10Q010",
  224. .width = 320,
  225. .height = 240,
  226. .hfp = 10,
  227. .hbp = 10,
  228. .hsw = 10,
  229. .vfp = 10,
  230. .vbp = 10,
  231. .vsw = 10,
  232. .pxl_clk = 7833600,
  233. .invert_pxl_clk = 0,
  234. },
  235. };
  236. /* Enable the Raster Engine of the LCD Controller */
  237. static inline void lcd_enable_raster(void)
  238. {
  239. u32 reg;
  240. /* Bring LCDC out of reset */
  241. if (lcd_revision == LCD_VERSION_2)
  242. lcdc_write(0, LCD_CLK_RESET_REG);
  243. reg = lcdc_read(LCD_RASTER_CTRL_REG);
  244. if (!(reg & LCD_RASTER_ENABLE))
  245. lcdc_write(reg | LCD_RASTER_ENABLE, LCD_RASTER_CTRL_REG);
  246. }
  247. /* Disable the Raster Engine of the LCD Controller */
  248. static inline void lcd_disable_raster(void)
  249. {
  250. u32 reg;
  251. reg = lcdc_read(LCD_RASTER_CTRL_REG);
  252. if (reg & LCD_RASTER_ENABLE)
  253. lcdc_write(reg & ~LCD_RASTER_ENABLE, LCD_RASTER_CTRL_REG);
  254. if (lcd_revision == LCD_VERSION_2)
  255. /* Write 1 to reset LCDC */
  256. lcdc_write(LCD_CLK_MAIN_RESET, LCD_CLK_RESET_REG);
  257. }
  258. static void lcd_blit(int load_mode, struct da8xx_fb_par *par)
  259. {
  260. u32 start;
  261. u32 end;
  262. u32 reg_ras;
  263. u32 reg_dma;
  264. u32 reg_int;
  265. /* init reg to clear PLM (loading mode) fields */
  266. reg_ras = lcdc_read(LCD_RASTER_CTRL_REG);
  267. reg_ras &= ~(3 << 20);
  268. reg_dma = lcdc_read(LCD_DMA_CTRL_REG);
  269. if (load_mode == LOAD_DATA) {
  270. start = par->dma_start;
  271. end = par->dma_end;
  272. reg_ras |= LCD_PALETTE_LOAD_MODE(DATA_ONLY);
  273. if (lcd_revision == LCD_VERSION_1) {
  274. reg_dma |= LCD_V1_END_OF_FRAME_INT_ENA;
  275. } else {
  276. reg_int = lcdc_read(LCD_INT_ENABLE_SET_REG) |
  277. LCD_V2_END_OF_FRAME0_INT_ENA |
  278. LCD_V2_END_OF_FRAME1_INT_ENA;
  279. lcdc_write(reg_int, LCD_INT_ENABLE_SET_REG);
  280. }
  281. reg_dma |= LCD_DUAL_FRAME_BUFFER_ENABLE;
  282. lcdc_write(start, LCD_DMA_FRM_BUF_BASE_ADDR_0_REG);
  283. lcdc_write(end, LCD_DMA_FRM_BUF_CEILING_ADDR_0_REG);
  284. lcdc_write(start, LCD_DMA_FRM_BUF_BASE_ADDR_1_REG);
  285. lcdc_write(end, LCD_DMA_FRM_BUF_CEILING_ADDR_1_REG);
  286. } else if (load_mode == LOAD_PALETTE) {
  287. start = par->p_palette_base;
  288. end = start + par->palette_sz - 1;
  289. reg_ras |= LCD_PALETTE_LOAD_MODE(PALETTE_ONLY);
  290. if (lcd_revision == LCD_VERSION_1) {
  291. reg_ras |= LCD_V1_PL_INT_ENA;
  292. } else {
  293. reg_int = lcdc_read(LCD_INT_ENABLE_SET_REG) |
  294. LCD_V2_PL_INT_ENA;
  295. lcdc_write(reg_int, LCD_INT_ENABLE_SET_REG);
  296. }
  297. lcdc_write(start, LCD_DMA_FRM_BUF_BASE_ADDR_0_REG);
  298. lcdc_write(end, LCD_DMA_FRM_BUF_CEILING_ADDR_0_REG);
  299. }
  300. lcdc_write(reg_dma, LCD_DMA_CTRL_REG);
  301. lcdc_write(reg_ras, LCD_RASTER_CTRL_REG);
  302. /*
  303. * The Raster enable bit must be set after all other control fields are
  304. * set.
  305. */
  306. lcd_enable_raster();
  307. }
  308. /* Configure the Burst Size of DMA */
  309. static int lcd_cfg_dma(int burst_size)
  310. {
  311. u32 reg;
  312. reg = lcdc_read(LCD_DMA_CTRL_REG) & 0x00000001;
  313. switch (burst_size) {
  314. case 1:
  315. reg |= LCD_DMA_BURST_SIZE(LCD_DMA_BURST_1);
  316. break;
  317. case 2:
  318. reg |= LCD_DMA_BURST_SIZE(LCD_DMA_BURST_2);
  319. break;
  320. case 4:
  321. reg |= LCD_DMA_BURST_SIZE(LCD_DMA_BURST_4);
  322. break;
  323. case 8:
  324. reg |= LCD_DMA_BURST_SIZE(LCD_DMA_BURST_8);
  325. break;
  326. case 16:
  327. reg |= LCD_DMA_BURST_SIZE(LCD_DMA_BURST_16);
  328. break;
  329. default:
  330. return -EINVAL;
  331. }
  332. lcdc_write(reg, LCD_DMA_CTRL_REG);
  333. return 0;
  334. }
  335. static void lcd_cfg_ac_bias(int period, int transitions_per_int)
  336. {
  337. u32 reg;
  338. /* Set the AC Bias Period and Number of Transisitons per Interrupt */
  339. reg = lcdc_read(LCD_RASTER_TIMING_2_REG) & 0xFFF00000;
  340. reg |= LCD_AC_BIAS_FREQUENCY(period) |
  341. LCD_AC_BIAS_TRANSITIONS_PER_INT(transitions_per_int);
  342. lcdc_write(reg, LCD_RASTER_TIMING_2_REG);
  343. }
  344. static void lcd_cfg_horizontal_sync(int back_porch, int pulse_width,
  345. int front_porch)
  346. {
  347. u32 reg;
  348. reg = lcdc_read(LCD_RASTER_TIMING_0_REG) & 0xf;
  349. reg |= ((back_porch & 0xff) << 24)
  350. | ((front_porch & 0xff) << 16)
  351. | ((pulse_width & 0x3f) << 10);
  352. lcdc_write(reg, LCD_RASTER_TIMING_0_REG);
  353. }
  354. static void lcd_cfg_vertical_sync(int back_porch, int pulse_width,
  355. int front_porch)
  356. {
  357. u32 reg;
  358. reg = lcdc_read(LCD_RASTER_TIMING_1_REG) & 0x3ff;
  359. reg |= ((back_porch & 0xff) << 24)
  360. | ((front_porch & 0xff) << 16)
  361. | ((pulse_width & 0x3f) << 10);
  362. lcdc_write(reg, LCD_RASTER_TIMING_1_REG);
  363. }
  364. static int lcd_cfg_display(const struct lcd_ctrl_config *cfg)
  365. {
  366. u32 reg;
  367. u32 reg_int;
  368. reg = lcdc_read(LCD_RASTER_CTRL_REG) & ~(LCD_TFT_MODE |
  369. LCD_MONO_8BIT_MODE |
  370. LCD_MONOCHROME_MODE);
  371. switch (cfg->p_disp_panel->panel_shade) {
  372. case MONOCHROME:
  373. reg |= LCD_MONOCHROME_MODE;
  374. if (cfg->mono_8bit_mode)
  375. reg |= LCD_MONO_8BIT_MODE;
  376. break;
  377. case COLOR_ACTIVE:
  378. reg |= LCD_TFT_MODE;
  379. if (cfg->tft_alt_mode)
  380. reg |= LCD_TFT_ALT_ENABLE;
  381. break;
  382. case COLOR_PASSIVE:
  383. if (cfg->stn_565_mode)
  384. reg |= LCD_STN_565_ENABLE;
  385. break;
  386. default:
  387. return -EINVAL;
  388. }
  389. /* enable additional interrupts here */
  390. if (lcd_revision == LCD_VERSION_1) {
  391. reg |= LCD_V1_UNDERFLOW_INT_ENA;
  392. } else {
  393. reg_int = lcdc_read(LCD_INT_ENABLE_SET_REG) |
  394. LCD_V2_UNDERFLOW_INT_ENA;
  395. lcdc_write(reg_int, LCD_INT_ENABLE_SET_REG);
  396. }
  397. lcdc_write(reg, LCD_RASTER_CTRL_REG);
  398. reg = lcdc_read(LCD_RASTER_TIMING_2_REG);
  399. if (cfg->sync_ctrl)
  400. reg |= LCD_SYNC_CTRL;
  401. else
  402. reg &= ~LCD_SYNC_CTRL;
  403. if (cfg->sync_edge)
  404. reg |= LCD_SYNC_EDGE;
  405. else
  406. reg &= ~LCD_SYNC_EDGE;
  407. if (cfg->invert_line_clock)
  408. reg |= LCD_INVERT_LINE_CLOCK;
  409. else
  410. reg &= ~LCD_INVERT_LINE_CLOCK;
  411. if (cfg->invert_frm_clock)
  412. reg |= LCD_INVERT_FRAME_CLOCK;
  413. else
  414. reg &= ~LCD_INVERT_FRAME_CLOCK;
  415. lcdc_write(reg, LCD_RASTER_TIMING_2_REG);
  416. return 0;
  417. }
  418. static int lcd_cfg_frame_buffer(struct da8xx_fb_par *par, u32 width, u32 height,
  419. u32 bpp, u32 raster_order)
  420. {
  421. u32 reg;
  422. /* Set the Panel Width */
  423. /* Pixels per line = (PPL + 1)*16 */
  424. if (lcd_revision == LCD_VERSION_1) {
  425. /*
  426. * 0x3F in bits 4..9 gives max horizontal resolution = 1024
  427. * pixels.
  428. */
  429. width &= 0x3f0;
  430. } else {
  431. /*
  432. * 0x7F in bits 4..10 gives max horizontal resolution = 2048
  433. * pixels.
  434. */
  435. width &= 0x7f0;
  436. }
  437. reg = lcdc_read(LCD_RASTER_TIMING_0_REG);
  438. reg &= 0xfffffc00;
  439. if (lcd_revision == LCD_VERSION_1) {
  440. reg |= ((width >> 4) - 1) << 4;
  441. } else {
  442. width = (width >> 4) - 1;
  443. reg |= ((width & 0x3f) << 4) | ((width & 0x40) >> 3);
  444. }
  445. lcdc_write(reg, LCD_RASTER_TIMING_0_REG);
  446. /* Set the Panel Height */
  447. /* Set bits 9:0 of Lines Per Pixel */
  448. reg = lcdc_read(LCD_RASTER_TIMING_1_REG);
  449. reg = ((height - 1) & 0x3ff) | (reg & 0xfffffc00);
  450. lcdc_write(reg, LCD_RASTER_TIMING_1_REG);
  451. /* Set bit 10 of Lines Per Pixel */
  452. if (lcd_revision == LCD_VERSION_2) {
  453. reg = lcdc_read(LCD_RASTER_TIMING_2_REG);
  454. reg |= ((height - 1) & 0x400) << 16;
  455. lcdc_write(reg, LCD_RASTER_TIMING_2_REG);
  456. }
  457. /* Set the Raster Order of the Frame Buffer */
  458. reg = lcdc_read(LCD_RASTER_CTRL_REG) & ~(1 << 8);
  459. if (raster_order)
  460. reg |= LCD_RASTER_ORDER;
  461. lcdc_write(reg, LCD_RASTER_CTRL_REG);
  462. switch (bpp) {
  463. case 1:
  464. case 2:
  465. case 4:
  466. case 16:
  467. par->palette_sz = 16 * 2;
  468. break;
  469. case 8:
  470. par->palette_sz = 256 * 2;
  471. break;
  472. default:
  473. return -EINVAL;
  474. }
  475. return 0;
  476. }
  477. static int fb_setcolreg(unsigned regno, unsigned red, unsigned green,
  478. unsigned blue, unsigned transp,
  479. struct fb_info *info)
  480. {
  481. struct da8xx_fb_par *par = info->par;
  482. unsigned short *palette = (unsigned short *) par->v_palette_base;
  483. u_short pal;
  484. int update_hw = 0;
  485. if (regno > 255)
  486. return 1;
  487. if (info->fix.visual == FB_VISUAL_DIRECTCOLOR)
  488. return 1;
  489. if (info->var.bits_per_pixel == 4) {
  490. if (regno > 15)
  491. return 1;
  492. if (info->var.grayscale) {
  493. pal = regno;
  494. } else {
  495. red >>= 4;
  496. green >>= 8;
  497. blue >>= 12;
  498. pal = (red & 0x0f00);
  499. pal |= (green & 0x00f0);
  500. pal |= (blue & 0x000f);
  501. }
  502. if (regno == 0)
  503. pal |= 0x2000;
  504. palette[regno] = pal;
  505. } else if (info->var.bits_per_pixel == 8) {
  506. red >>= 4;
  507. green >>= 8;
  508. blue >>= 12;
  509. pal = (red & 0x0f00);
  510. pal |= (green & 0x00f0);
  511. pal |= (blue & 0x000f);
  512. if (palette[regno] != pal) {
  513. update_hw = 1;
  514. palette[regno] = pal;
  515. }
  516. } else if ((info->var.bits_per_pixel == 16) && regno < 16) {
  517. red >>= (16 - info->var.red.length);
  518. red <<= info->var.red.offset;
  519. green >>= (16 - info->var.green.length);
  520. green <<= info->var.green.offset;
  521. blue >>= (16 - info->var.blue.length);
  522. blue <<= info->var.blue.offset;
  523. par->pseudo_palette[regno] = red | green | blue;
  524. if (palette[0] != 0x4000) {
  525. update_hw = 1;
  526. palette[0] = 0x4000;
  527. }
  528. }
  529. /* Update the palette in the h/w as needed. */
  530. if (update_hw)
  531. lcd_blit(LOAD_PALETTE, par);
  532. return 0;
  533. }
  534. static void lcd_reset(struct da8xx_fb_par *par)
  535. {
  536. /* Disable the Raster if previously Enabled */
  537. lcd_disable_raster();
  538. /* DMA has to be disabled */
  539. lcdc_write(0, LCD_DMA_CTRL_REG);
  540. lcdc_write(0, LCD_RASTER_CTRL_REG);
  541. if (lcd_revision == LCD_VERSION_2) {
  542. lcdc_write(0, LCD_INT_ENABLE_SET_REG);
  543. /* Write 1 to reset */
  544. lcdc_write(LCD_CLK_MAIN_RESET, LCD_CLK_RESET_REG);
  545. lcdc_write(0, LCD_CLK_RESET_REG);
  546. }
  547. }
  548. static void lcd_calc_clk_divider(struct da8xx_fb_par *par)
  549. {
  550. unsigned int lcd_clk, div;
  551. lcd_clk = clk_get_rate(par->lcdc_clk);
  552. div = lcd_clk / par->pxl_clk;
  553. /* Configure the LCD clock divisor. */
  554. lcdc_write(LCD_CLK_DIVISOR(div) |
  555. (LCD_RASTER_MODE & 0x1), LCD_CTRL_REG);
  556. if (lcd_revision == LCD_VERSION_2)
  557. lcdc_write(LCD_V2_DMA_CLK_EN | LCD_V2_LIDD_CLK_EN |
  558. LCD_V2_CORE_CLK_EN, LCD_CLK_ENABLE_REG);
  559. }
  560. static int lcd_init(struct da8xx_fb_par *par, const struct lcd_ctrl_config *cfg,
  561. struct da8xx_panel *panel)
  562. {
  563. u32 bpp;
  564. int ret = 0;
  565. lcd_reset(par);
  566. /* Calculate the divider */
  567. lcd_calc_clk_divider(par);
  568. if (panel->invert_pxl_clk)
  569. lcdc_write((lcdc_read(LCD_RASTER_TIMING_2_REG) |
  570. LCD_INVERT_PIXEL_CLOCK), LCD_RASTER_TIMING_2_REG);
  571. else
  572. lcdc_write((lcdc_read(LCD_RASTER_TIMING_2_REG) &
  573. ~LCD_INVERT_PIXEL_CLOCK), LCD_RASTER_TIMING_2_REG);
  574. /* Configure the DMA burst size. */
  575. ret = lcd_cfg_dma(cfg->dma_burst_sz);
  576. if (ret < 0)
  577. return ret;
  578. /* Configure the AC bias properties. */
  579. lcd_cfg_ac_bias(cfg->ac_bias, cfg->ac_bias_intrpt);
  580. /* Configure the vertical and horizontal sync properties. */
  581. lcd_cfg_vertical_sync(panel->vbp, panel->vsw, panel->vfp);
  582. lcd_cfg_horizontal_sync(panel->hbp, panel->hsw, panel->hfp);
  583. /* Configure for disply */
  584. ret = lcd_cfg_display(cfg);
  585. if (ret < 0)
  586. return ret;
  587. if (QVGA != cfg->p_disp_panel->panel_type)
  588. return -EINVAL;
  589. if (cfg->bpp <= cfg->p_disp_panel->max_bpp &&
  590. cfg->bpp >= cfg->p_disp_panel->min_bpp)
  591. bpp = cfg->bpp;
  592. else
  593. bpp = cfg->p_disp_panel->max_bpp;
  594. if (bpp == 12)
  595. bpp = 16;
  596. ret = lcd_cfg_frame_buffer(par, (unsigned int)panel->width,
  597. (unsigned int)panel->height, bpp,
  598. cfg->raster_order);
  599. if (ret < 0)
  600. return ret;
  601. /* Configure FDD */
  602. lcdc_write((lcdc_read(LCD_RASTER_CTRL_REG) & 0xfff00fff) |
  603. (cfg->fdd << 12), LCD_RASTER_CTRL_REG);
  604. return 0;
  605. }
  606. /* IRQ handler for version 2 of LCDC */
  607. static irqreturn_t lcdc_irq_handler_rev02(int irq, void *arg)
  608. {
  609. struct da8xx_fb_par *par = arg;
  610. u32 stat = lcdc_read(LCD_MASKED_STAT_REG);
  611. u32 reg_int;
  612. if ((stat & LCD_SYNC_LOST) && (stat & LCD_FIFO_UNDERFLOW)) {
  613. lcd_disable_raster();
  614. lcdc_write(stat, LCD_MASKED_STAT_REG);
  615. lcd_enable_raster();
  616. } else if (stat & LCD_PL_LOAD_DONE) {
  617. /*
  618. * Must disable raster before changing state of any control bit.
  619. * And also must be disabled before clearing the PL loading
  620. * interrupt via the following write to the status register. If
  621. * this is done after then one gets multiple PL done interrupts.
  622. */
  623. lcd_disable_raster();
  624. lcdc_write(stat, LCD_MASKED_STAT_REG);
  625. /* Disable PL completion inerrupt */
  626. reg_int = lcdc_read(LCD_INT_ENABLE_CLR_REG) |
  627. (LCD_V2_PL_INT_ENA);
  628. lcdc_write(reg_int, LCD_INT_ENABLE_CLR_REG);
  629. /* Setup and start data loading mode */
  630. lcd_blit(LOAD_DATA, par);
  631. } else {
  632. lcdc_write(stat, LCD_MASKED_STAT_REG);
  633. if (stat & LCD_END_OF_FRAME0) {
  634. lcdc_write(par->dma_start,
  635. LCD_DMA_FRM_BUF_BASE_ADDR_0_REG);
  636. lcdc_write(par->dma_end,
  637. LCD_DMA_FRM_BUF_CEILING_ADDR_0_REG);
  638. par->vsync_flag = 1;
  639. wake_up_interruptible(&par->vsync_wait);
  640. }
  641. if (stat & LCD_END_OF_FRAME1) {
  642. lcdc_write(par->dma_start,
  643. LCD_DMA_FRM_BUF_BASE_ADDR_1_REG);
  644. lcdc_write(par->dma_end,
  645. LCD_DMA_FRM_BUF_CEILING_ADDR_1_REG);
  646. par->vsync_flag = 1;
  647. wake_up_interruptible(&par->vsync_wait);
  648. }
  649. }
  650. lcdc_write(0, LCD_END_OF_INT_IND_REG);
  651. return IRQ_HANDLED;
  652. }
  653. /* IRQ handler for version 1 LCDC */
  654. static irqreturn_t lcdc_irq_handler_rev01(int irq, void *arg)
  655. {
  656. struct da8xx_fb_par *par = arg;
  657. u32 stat = lcdc_read(LCD_STAT_REG);
  658. u32 reg_ras;
  659. if ((stat & LCD_SYNC_LOST) && (stat & LCD_FIFO_UNDERFLOW)) {
  660. lcd_disable_raster();
  661. lcdc_write(stat, LCD_STAT_REG);
  662. lcd_enable_raster();
  663. } else if (stat & LCD_PL_LOAD_DONE) {
  664. /*
  665. * Must disable raster before changing state of any control bit.
  666. * And also must be disabled before clearing the PL loading
  667. * interrupt via the following write to the status register. If
  668. * this is done after then one gets multiple PL done interrupts.
  669. */
  670. lcd_disable_raster();
  671. lcdc_write(stat, LCD_STAT_REG);
  672. /* Disable PL completion inerrupt */
  673. reg_ras = lcdc_read(LCD_RASTER_CTRL_REG);
  674. reg_ras &= ~LCD_V1_PL_INT_ENA;
  675. lcdc_write(reg_ras, LCD_RASTER_CTRL_REG);
  676. /* Setup and start data loading mode */
  677. lcd_blit(LOAD_DATA, par);
  678. } else {
  679. lcdc_write(stat, LCD_STAT_REG);
  680. if (stat & LCD_END_OF_FRAME0) {
  681. lcdc_write(par->dma_start,
  682. LCD_DMA_FRM_BUF_BASE_ADDR_0_REG);
  683. lcdc_write(par->dma_end,
  684. LCD_DMA_FRM_BUF_CEILING_ADDR_0_REG);
  685. par->vsync_flag = 1;
  686. wake_up_interruptible(&par->vsync_wait);
  687. }
  688. if (stat & LCD_END_OF_FRAME1) {
  689. lcdc_write(par->dma_start,
  690. LCD_DMA_FRM_BUF_BASE_ADDR_1_REG);
  691. lcdc_write(par->dma_end,
  692. LCD_DMA_FRM_BUF_CEILING_ADDR_1_REG);
  693. par->vsync_flag = 1;
  694. wake_up_interruptible(&par->vsync_wait);
  695. }
  696. }
  697. return IRQ_HANDLED;
  698. }
  699. static int fb_check_var(struct fb_var_screeninfo *var,
  700. struct fb_info *info)
  701. {
  702. int err = 0;
  703. switch (var->bits_per_pixel) {
  704. case 1:
  705. case 8:
  706. var->red.offset = 0;
  707. var->red.length = 8;
  708. var->green.offset = 0;
  709. var->green.length = 8;
  710. var->blue.offset = 0;
  711. var->blue.length = 8;
  712. var->transp.offset = 0;
  713. var->transp.length = 0;
  714. var->nonstd = 0;
  715. break;
  716. case 4:
  717. var->red.offset = 0;
  718. var->red.length = 4;
  719. var->green.offset = 0;
  720. var->green.length = 4;
  721. var->blue.offset = 0;
  722. var->blue.length = 4;
  723. var->transp.offset = 0;
  724. var->transp.length = 0;
  725. var->nonstd = FB_NONSTD_REV_PIX_IN_B;
  726. break;
  727. case 16: /* RGB 565 */
  728. var->red.offset = 11;
  729. var->red.length = 5;
  730. var->green.offset = 5;
  731. var->green.length = 6;
  732. var->blue.offset = 0;
  733. var->blue.length = 5;
  734. var->transp.offset = 0;
  735. var->transp.length = 0;
  736. var->nonstd = 0;
  737. break;
  738. default:
  739. err = -EINVAL;
  740. }
  741. var->red.msb_right = 0;
  742. var->green.msb_right = 0;
  743. var->blue.msb_right = 0;
  744. var->transp.msb_right = 0;
  745. return err;
  746. }
  747. #ifdef CONFIG_CPU_FREQ
  748. static int lcd_da8xx_cpufreq_transition(struct notifier_block *nb,
  749. unsigned long val, void *data)
  750. {
  751. struct da8xx_fb_par *par;
  752. par = container_of(nb, struct da8xx_fb_par, freq_transition);
  753. if (val == CPUFREQ_POSTCHANGE) {
  754. if (par->lcd_fck_rate != clk_get_rate(par->lcdc_clk)) {
  755. par->lcd_fck_rate = clk_get_rate(par->lcdc_clk);
  756. lcd_disable_raster();
  757. lcd_calc_clk_divider(par);
  758. lcd_enable_raster();
  759. }
  760. }
  761. return 0;
  762. }
  763. static inline int lcd_da8xx_cpufreq_register(struct da8xx_fb_par *par)
  764. {
  765. par->freq_transition.notifier_call = lcd_da8xx_cpufreq_transition;
  766. return cpufreq_register_notifier(&par->freq_transition,
  767. CPUFREQ_TRANSITION_NOTIFIER);
  768. }
  769. static inline void lcd_da8xx_cpufreq_deregister(struct da8xx_fb_par *par)
  770. {
  771. cpufreq_unregister_notifier(&par->freq_transition,
  772. CPUFREQ_TRANSITION_NOTIFIER);
  773. }
  774. #endif
  775. static int __devexit fb_remove(struct platform_device *dev)
  776. {
  777. struct fb_info *info = dev_get_drvdata(&dev->dev);
  778. if (info) {
  779. struct da8xx_fb_par *par = info->par;
  780. #ifdef CONFIG_CPU_FREQ
  781. lcd_da8xx_cpufreq_deregister(par);
  782. #endif
  783. if (par->panel_power_ctrl)
  784. par->panel_power_ctrl(0);
  785. lcd_disable_raster();
  786. lcdc_write(0, LCD_RASTER_CTRL_REG);
  787. /* disable DMA */
  788. lcdc_write(0, LCD_DMA_CTRL_REG);
  789. unregister_framebuffer(info);
  790. fb_dealloc_cmap(&info->cmap);
  791. dma_free_coherent(NULL, PALETTE_SIZE, par->v_palette_base,
  792. par->p_palette_base);
  793. dma_free_coherent(NULL, par->vram_size, par->vram_virt,
  794. par->vram_phys);
  795. free_irq(par->irq, par);
  796. clk_disable(par->lcdc_clk);
  797. clk_put(par->lcdc_clk);
  798. framebuffer_release(info);
  799. iounmap((void __iomem *)da8xx_fb_reg_base);
  800. release_mem_region(lcdc_regs->start, resource_size(lcdc_regs));
  801. }
  802. return 0;
  803. }
  804. /*
  805. * Function to wait for vertical sync which for this LCD peripheral
  806. * translates into waiting for the current raster frame to complete.
  807. */
  808. static int fb_wait_for_vsync(struct fb_info *info)
  809. {
  810. struct da8xx_fb_par *par = info->par;
  811. int ret;
  812. /*
  813. * Set flag to 0 and wait for isr to set to 1. It would seem there is a
  814. * race condition here where the ISR could have occurred just before or
  815. * just after this set. But since we are just coarsely waiting for
  816. * a frame to complete then that's OK. i.e. if the frame completed
  817. * just before this code executed then we have to wait another full
  818. * frame time but there is no way to avoid such a situation. On the
  819. * other hand if the frame completed just after then we don't need
  820. * to wait long at all. Either way we are guaranteed to return to the
  821. * user immediately after a frame completion which is all that is
  822. * required.
  823. */
  824. par->vsync_flag = 0;
  825. ret = wait_event_interruptible_timeout(par->vsync_wait,
  826. par->vsync_flag != 0,
  827. par->vsync_timeout);
  828. if (ret < 0)
  829. return ret;
  830. if (ret == 0)
  831. return -ETIMEDOUT;
  832. return 0;
  833. }
  834. static int fb_ioctl(struct fb_info *info, unsigned int cmd,
  835. unsigned long arg)
  836. {
  837. struct lcd_sync_arg sync_arg;
  838. switch (cmd) {
  839. case FBIOGET_CONTRAST:
  840. case FBIOPUT_CONTRAST:
  841. case FBIGET_BRIGHTNESS:
  842. case FBIPUT_BRIGHTNESS:
  843. case FBIGET_COLOR:
  844. case FBIPUT_COLOR:
  845. return -ENOTTY;
  846. case FBIPUT_HSYNC:
  847. if (copy_from_user(&sync_arg, (char *)arg,
  848. sizeof(struct lcd_sync_arg)))
  849. return -EFAULT;
  850. lcd_cfg_horizontal_sync(sync_arg.back_porch,
  851. sync_arg.pulse_width,
  852. sync_arg.front_porch);
  853. break;
  854. case FBIPUT_VSYNC:
  855. if (copy_from_user(&sync_arg, (char *)arg,
  856. sizeof(struct lcd_sync_arg)))
  857. return -EFAULT;
  858. lcd_cfg_vertical_sync(sync_arg.back_porch,
  859. sync_arg.pulse_width,
  860. sync_arg.front_porch);
  861. break;
  862. case FBIO_WAITFORVSYNC:
  863. return fb_wait_for_vsync(info);
  864. default:
  865. return -EINVAL;
  866. }
  867. return 0;
  868. }
  869. static int cfb_blank(int blank, struct fb_info *info)
  870. {
  871. struct da8xx_fb_par *par = info->par;
  872. int ret = 0;
  873. if (par->blank == blank)
  874. return 0;
  875. par->blank = blank;
  876. switch (blank) {
  877. case FB_BLANK_UNBLANK:
  878. if (par->panel_power_ctrl)
  879. par->panel_power_ctrl(1);
  880. lcd_enable_raster();
  881. break;
  882. case FB_BLANK_POWERDOWN:
  883. if (par->panel_power_ctrl)
  884. par->panel_power_ctrl(0);
  885. lcd_disable_raster();
  886. break;
  887. default:
  888. ret = -EINVAL;
  889. }
  890. return ret;
  891. }
  892. /*
  893. * Set new x,y offsets in the virtual display for the visible area and switch
  894. * to the new mode.
  895. */
  896. static int da8xx_pan_display(struct fb_var_screeninfo *var,
  897. struct fb_info *fbi)
  898. {
  899. int ret = 0;
  900. struct fb_var_screeninfo new_var;
  901. struct da8xx_fb_par *par = fbi->par;
  902. struct fb_fix_screeninfo *fix = &fbi->fix;
  903. unsigned int end;
  904. unsigned int start;
  905. if (var->xoffset != fbi->var.xoffset ||
  906. var->yoffset != fbi->var.yoffset) {
  907. memcpy(&new_var, &fbi->var, sizeof(new_var));
  908. new_var.xoffset = var->xoffset;
  909. new_var.yoffset = var->yoffset;
  910. if (fb_check_var(&new_var, fbi))
  911. ret = -EINVAL;
  912. else {
  913. memcpy(&fbi->var, &new_var, sizeof(new_var));
  914. start = fix->smem_start +
  915. new_var.yoffset * fix->line_length +
  916. new_var.xoffset * fbi->var.bits_per_pixel / 8;
  917. end = start + fbi->var.yres * fix->line_length - 1;
  918. par->dma_start = start;
  919. par->dma_end = end;
  920. }
  921. }
  922. return ret;
  923. }
  924. static struct fb_ops da8xx_fb_ops = {
  925. .owner = THIS_MODULE,
  926. .fb_check_var = fb_check_var,
  927. .fb_setcolreg = fb_setcolreg,
  928. .fb_pan_display = da8xx_pan_display,
  929. .fb_ioctl = fb_ioctl,
  930. .fb_fillrect = cfb_fillrect,
  931. .fb_copyarea = cfb_copyarea,
  932. .fb_imageblit = cfb_imageblit,
  933. .fb_blank = cfb_blank,
  934. };
  935. /* Calculate and return pixel clock period in pico seconds */
  936. static unsigned int da8xxfb_pixel_clk_period(struct da8xx_fb_par *par)
  937. {
  938. unsigned int lcd_clk, div;
  939. unsigned int configured_pix_clk;
  940. unsigned long long pix_clk_period_picosec = 1000000000000ULL;
  941. lcd_clk = clk_get_rate(par->lcdc_clk);
  942. div = lcd_clk / par->pxl_clk;
  943. configured_pix_clk = (lcd_clk / div);
  944. do_div(pix_clk_period_picosec, configured_pix_clk);
  945. return pix_clk_period_picosec;
  946. }
  947. static int __devinit fb_probe(struct platform_device *device)
  948. {
  949. struct da8xx_lcdc_platform_data *fb_pdata =
  950. device->dev.platform_data;
  951. struct lcd_ctrl_config *lcd_cfg;
  952. struct da8xx_panel *lcdc_info;
  953. struct fb_info *da8xx_fb_info;
  954. struct clk *fb_clk = NULL;
  955. struct da8xx_fb_par *par;
  956. resource_size_t len;
  957. int ret, i;
  958. if (fb_pdata == NULL) {
  959. dev_err(&device->dev, "Can not get platform data\n");
  960. return -ENOENT;
  961. }
  962. lcdc_regs = platform_get_resource(device, IORESOURCE_MEM, 0);
  963. if (!lcdc_regs) {
  964. dev_err(&device->dev,
  965. "Can not get memory resource for LCD controller\n");
  966. return -ENOENT;
  967. }
  968. len = resource_size(lcdc_regs);
  969. lcdc_regs = request_mem_region(lcdc_regs->start, len, lcdc_regs->name);
  970. if (!lcdc_regs)
  971. return -EBUSY;
  972. da8xx_fb_reg_base = (resource_size_t)ioremap(lcdc_regs->start, len);
  973. if (!da8xx_fb_reg_base) {
  974. ret = -EBUSY;
  975. goto err_request_mem;
  976. }
  977. fb_clk = clk_get(&device->dev, NULL);
  978. if (IS_ERR(fb_clk)) {
  979. dev_err(&device->dev, "Can not get device clock\n");
  980. ret = -ENODEV;
  981. goto err_ioremap;
  982. }
  983. ret = clk_enable(fb_clk);
  984. if (ret)
  985. goto err_clk_put;
  986. /* Determine LCD IP Version */
  987. switch (lcdc_read(LCD_PID_REG)) {
  988. case 0x4C100102:
  989. lcd_revision = LCD_VERSION_1;
  990. break;
  991. case 0x4F200800:
  992. lcd_revision = LCD_VERSION_2;
  993. break;
  994. default:
  995. dev_warn(&device->dev, "Unknown PID Reg value 0x%x, "
  996. "defaulting to LCD revision 1\n",
  997. lcdc_read(LCD_PID_REG));
  998. lcd_revision = LCD_VERSION_1;
  999. break;
  1000. }
  1001. for (i = 0, lcdc_info = known_lcd_panels;
  1002. i < ARRAY_SIZE(known_lcd_panels);
  1003. i++, lcdc_info++) {
  1004. if (strcmp(fb_pdata->type, lcdc_info->name) == 0)
  1005. break;
  1006. }
  1007. if (i == ARRAY_SIZE(known_lcd_panels)) {
  1008. dev_err(&device->dev, "GLCD: No valid panel found\n");
  1009. ret = -ENODEV;
  1010. goto err_clk_disable;
  1011. } else
  1012. dev_info(&device->dev, "GLCD: Found %s panel\n",
  1013. fb_pdata->type);
  1014. lcd_cfg = (struct lcd_ctrl_config *)fb_pdata->controller_data;
  1015. da8xx_fb_info = framebuffer_alloc(sizeof(struct da8xx_fb_par),
  1016. &device->dev);
  1017. if (!da8xx_fb_info) {
  1018. dev_dbg(&device->dev, "Memory allocation failed for fb_info\n");
  1019. ret = -ENOMEM;
  1020. goto err_clk_disable;
  1021. }
  1022. par = da8xx_fb_info->par;
  1023. par->lcdc_clk = fb_clk;
  1024. #ifdef CONFIG_CPU_FREQ
  1025. par->lcd_fck_rate = clk_get_rate(fb_clk);
  1026. #endif
  1027. par->pxl_clk = lcdc_info->pxl_clk;
  1028. if (fb_pdata->panel_power_ctrl) {
  1029. par->panel_power_ctrl = fb_pdata->panel_power_ctrl;
  1030. par->panel_power_ctrl(1);
  1031. }
  1032. if (lcd_init(par, lcd_cfg, lcdc_info) < 0) {
  1033. dev_err(&device->dev, "lcd_init failed\n");
  1034. ret = -EFAULT;
  1035. goto err_release_fb;
  1036. }
  1037. /* allocate frame buffer */
  1038. par->vram_size = lcdc_info->width * lcdc_info->height * lcd_cfg->bpp;
  1039. par->vram_size = PAGE_ALIGN(par->vram_size/8);
  1040. par->vram_size = par->vram_size * LCD_NUM_BUFFERS;
  1041. par->vram_virt = dma_alloc_coherent(NULL,
  1042. par->vram_size,
  1043. (resource_size_t *) &par->vram_phys,
  1044. GFP_KERNEL | GFP_DMA);
  1045. if (!par->vram_virt) {
  1046. dev_err(&device->dev,
  1047. "GLCD: kmalloc for frame buffer failed\n");
  1048. ret = -EINVAL;
  1049. goto err_release_fb;
  1050. }
  1051. da8xx_fb_info->screen_base = (char __iomem *) par->vram_virt;
  1052. da8xx_fb_fix.smem_start = par->vram_phys;
  1053. da8xx_fb_fix.smem_len = par->vram_size;
  1054. da8xx_fb_fix.line_length = (lcdc_info->width * lcd_cfg->bpp) / 8;
  1055. par->dma_start = par->vram_phys;
  1056. par->dma_end = par->dma_start + lcdc_info->height *
  1057. da8xx_fb_fix.line_length - 1;
  1058. /* allocate palette buffer */
  1059. par->v_palette_base = dma_alloc_coherent(NULL,
  1060. PALETTE_SIZE,
  1061. (resource_size_t *)
  1062. &par->p_palette_base,
  1063. GFP_KERNEL | GFP_DMA);
  1064. if (!par->v_palette_base) {
  1065. dev_err(&device->dev,
  1066. "GLCD: kmalloc for palette buffer failed\n");
  1067. ret = -EINVAL;
  1068. goto err_release_fb_mem;
  1069. }
  1070. memset(par->v_palette_base, 0, PALETTE_SIZE);
  1071. par->irq = platform_get_irq(device, 0);
  1072. if (par->irq < 0) {
  1073. ret = -ENOENT;
  1074. goto err_release_pl_mem;
  1075. }
  1076. /* Initialize par */
  1077. da8xx_fb_info->var.bits_per_pixel = lcd_cfg->bpp;
  1078. da8xx_fb_var.xres = lcdc_info->width;
  1079. da8xx_fb_var.xres_virtual = lcdc_info->width;
  1080. da8xx_fb_var.yres = lcdc_info->height;
  1081. da8xx_fb_var.yres_virtual = lcdc_info->height * LCD_NUM_BUFFERS;
  1082. da8xx_fb_var.grayscale =
  1083. lcd_cfg->p_disp_panel->panel_shade == MONOCHROME ? 1 : 0;
  1084. da8xx_fb_var.bits_per_pixel = lcd_cfg->bpp;
  1085. da8xx_fb_var.hsync_len = lcdc_info->hsw;
  1086. da8xx_fb_var.vsync_len = lcdc_info->vsw;
  1087. da8xx_fb_var.right_margin = lcdc_info->hfp;
  1088. da8xx_fb_var.left_margin = lcdc_info->hbp;
  1089. da8xx_fb_var.lower_margin = lcdc_info->vfp;
  1090. da8xx_fb_var.upper_margin = lcdc_info->vbp;
  1091. da8xx_fb_var.pixclock = da8xxfb_pixel_clk_period(par);
  1092. /* Initialize fbinfo */
  1093. da8xx_fb_info->flags = FBINFO_FLAG_DEFAULT;
  1094. da8xx_fb_info->fix = da8xx_fb_fix;
  1095. da8xx_fb_info->var = da8xx_fb_var;
  1096. da8xx_fb_info->fbops = &da8xx_fb_ops;
  1097. da8xx_fb_info->pseudo_palette = par->pseudo_palette;
  1098. da8xx_fb_info->fix.visual = (da8xx_fb_info->var.bits_per_pixel <= 8) ?
  1099. FB_VISUAL_PSEUDOCOLOR : FB_VISUAL_TRUECOLOR;
  1100. ret = fb_alloc_cmap(&da8xx_fb_info->cmap, PALETTE_SIZE, 0);
  1101. if (ret)
  1102. goto err_release_pl_mem;
  1103. da8xx_fb_info->cmap.len = par->palette_sz;
  1104. /* initialize var_screeninfo */
  1105. da8xx_fb_var.activate = FB_ACTIVATE_FORCE;
  1106. fb_set_var(da8xx_fb_info, &da8xx_fb_var);
  1107. dev_set_drvdata(&device->dev, da8xx_fb_info);
  1108. /* initialize the vsync wait queue */
  1109. init_waitqueue_head(&par->vsync_wait);
  1110. par->vsync_timeout = HZ / 5;
  1111. /* Register the Frame Buffer */
  1112. if (register_framebuffer(da8xx_fb_info) < 0) {
  1113. dev_err(&device->dev,
  1114. "GLCD: Frame Buffer Registration Failed!\n");
  1115. ret = -EINVAL;
  1116. goto err_dealloc_cmap;
  1117. }
  1118. #ifdef CONFIG_CPU_FREQ
  1119. ret = lcd_da8xx_cpufreq_register(par);
  1120. if (ret) {
  1121. dev_err(&device->dev, "failed to register cpufreq\n");
  1122. goto err_cpu_freq;
  1123. }
  1124. #endif
  1125. if (lcd_revision == LCD_VERSION_1)
  1126. lcdc_irq_handler = lcdc_irq_handler_rev01;
  1127. else
  1128. lcdc_irq_handler = lcdc_irq_handler_rev02;
  1129. ret = request_irq(par->irq, lcdc_irq_handler, 0,
  1130. DRIVER_NAME, par);
  1131. if (ret)
  1132. goto irq_freq;
  1133. return 0;
  1134. irq_freq:
  1135. #ifdef CONFIG_CPU_FREQ
  1136. lcd_da8xx_cpufreq_deregister(par);
  1137. err_cpu_freq:
  1138. #endif
  1139. unregister_framebuffer(da8xx_fb_info);
  1140. err_dealloc_cmap:
  1141. fb_dealloc_cmap(&da8xx_fb_info->cmap);
  1142. err_release_pl_mem:
  1143. dma_free_coherent(NULL, PALETTE_SIZE, par->v_palette_base,
  1144. par->p_palette_base);
  1145. err_release_fb_mem:
  1146. dma_free_coherent(NULL, par->vram_size, par->vram_virt, par->vram_phys);
  1147. err_release_fb:
  1148. framebuffer_release(da8xx_fb_info);
  1149. err_clk_disable:
  1150. clk_disable(fb_clk);
  1151. err_clk_put:
  1152. clk_put(fb_clk);
  1153. err_ioremap:
  1154. iounmap((void __iomem *)da8xx_fb_reg_base);
  1155. err_request_mem:
  1156. release_mem_region(lcdc_regs->start, len);
  1157. return ret;
  1158. }
  1159. #ifdef CONFIG_PM
  1160. static int fb_suspend(struct platform_device *dev, pm_message_t state)
  1161. {
  1162. struct fb_info *info = platform_get_drvdata(dev);
  1163. struct da8xx_fb_par *par = info->par;
  1164. console_lock();
  1165. if (par->panel_power_ctrl)
  1166. par->panel_power_ctrl(0);
  1167. fb_set_suspend(info, 1);
  1168. lcd_disable_raster();
  1169. clk_disable(par->lcdc_clk);
  1170. console_unlock();
  1171. return 0;
  1172. }
  1173. static int fb_resume(struct platform_device *dev)
  1174. {
  1175. struct fb_info *info = platform_get_drvdata(dev);
  1176. struct da8xx_fb_par *par = info->par;
  1177. console_lock();
  1178. if (par->panel_power_ctrl)
  1179. par->panel_power_ctrl(1);
  1180. clk_enable(par->lcdc_clk);
  1181. lcd_enable_raster();
  1182. fb_set_suspend(info, 0);
  1183. console_unlock();
  1184. return 0;
  1185. }
  1186. #else
  1187. #define fb_suspend NULL
  1188. #define fb_resume NULL
  1189. #endif
  1190. static struct platform_driver da8xx_fb_driver = {
  1191. .probe = fb_probe,
  1192. .remove = __devexit_p(fb_remove),
  1193. .suspend = fb_suspend,
  1194. .resume = fb_resume,
  1195. .driver = {
  1196. .name = DRIVER_NAME,
  1197. .owner = THIS_MODULE,
  1198. },
  1199. };
  1200. static int __init da8xx_fb_init(void)
  1201. {
  1202. return platform_driver_register(&da8xx_fb_driver);
  1203. }
  1204. static void __exit da8xx_fb_cleanup(void)
  1205. {
  1206. platform_driver_unregister(&da8xx_fb_driver);
  1207. }
  1208. module_init(da8xx_fb_init);
  1209. module_exit(da8xx_fb_cleanup);
  1210. MODULE_DESCRIPTION("Framebuffer driver for TI da8xx/omap-l1xx");
  1211. MODULE_AUTHOR("Texas Instruments");
  1212. MODULE_LICENSE("GPL");