au1200fb.c 51 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922
  1. /*
  2. * BRIEF MODULE DESCRIPTION
  3. * Au1200 LCD Driver.
  4. *
  5. * Copyright 2004-2005 AMD
  6. * Author: AMD
  7. *
  8. * Based on:
  9. * linux/drivers/video/skeletonfb.c -- Skeleton for a frame buffer device
  10. * Created 28 Dec 1997 by Geert Uytterhoeven
  11. *
  12. * This program is free software; you can redistribute it and/or modify it
  13. * under the terms of the GNU General Public License as published by the
  14. * Free Software Foundation; either version 2 of the License, or (at your
  15. * option) any later version.
  16. *
  17. * THIS SOFTWARE IS PROVIDED ``AS IS'' AND ANY EXPRESS OR IMPLIED
  18. * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
  19. * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN
  20. * NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
  21. * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  22. * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF
  23. * USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
  24. * ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  25. * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
  26. * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  27. *
  28. * You should have received a copy of the GNU General Public License along
  29. * with this program; if not, write to the Free Software Foundation, Inc.,
  30. * 675 Mass Ave, Cambridge, MA 02139, USA.
  31. */
  32. #include <linux/module.h>
  33. #include <linux/platform_device.h>
  34. #include <linux/kernel.h>
  35. #include <linux/errno.h>
  36. #include <linux/string.h>
  37. #include <linux/mm.h>
  38. #include <linux/fb.h>
  39. #include <linux/init.h>
  40. #include <linux/interrupt.h>
  41. #include <linux/ctype.h>
  42. #include <linux/dma-mapping.h>
  43. #include <asm/mach-au1x00/au1000.h>
  44. #include "au1200fb.h"
  45. #ifdef CONFIG_PM
  46. #include <asm/mach-au1x00/au1xxx_pm.h>
  47. #endif
  48. #ifndef CONFIG_FB_AU1200_DEVS
  49. #define CONFIG_FB_AU1200_DEVS 4
  50. #endif
  51. #define DRIVER_NAME "au1200fb"
  52. #define DRIVER_DESC "LCD controller driver for AU1200 processors"
  53. #define DEBUG 1
  54. #define print_err(f, arg...) printk(KERN_ERR DRIVER_NAME ": " f "\n", ## arg)
  55. #define print_warn(f, arg...) printk(KERN_WARNING DRIVER_NAME ": " f "\n", ## arg)
  56. #define print_info(f, arg...) printk(KERN_INFO DRIVER_NAME ": " f "\n", ## arg)
  57. #if DEBUG
  58. #define print_dbg(f, arg...) printk(KERN_DEBUG __FILE__ ": " f "\n", ## arg)
  59. #else
  60. #define print_dbg(f, arg...) do {} while (0)
  61. #endif
  62. #define AU1200_LCD_FB_IOCTL 0x46FF
  63. #define AU1200_LCD_SET_SCREEN 1
  64. #define AU1200_LCD_GET_SCREEN 2
  65. #define AU1200_LCD_SET_WINDOW 3
  66. #define AU1200_LCD_GET_WINDOW 4
  67. #define AU1200_LCD_SET_PANEL 5
  68. #define AU1200_LCD_GET_PANEL 6
  69. #define SCREEN_SIZE (1<< 1)
  70. #define SCREEN_BACKCOLOR (1<< 2)
  71. #define SCREEN_BRIGHTNESS (1<< 3)
  72. #define SCREEN_COLORKEY (1<< 4)
  73. #define SCREEN_MASK (1<< 5)
  74. struct au1200_lcd_global_regs_t {
  75. unsigned int flags;
  76. unsigned int xsize;
  77. unsigned int ysize;
  78. unsigned int backcolor;
  79. unsigned int brightness;
  80. unsigned int colorkey;
  81. unsigned int mask;
  82. unsigned int panel_choice;
  83. char panel_desc[80];
  84. };
  85. #define WIN_POSITION (1<< 0)
  86. #define WIN_ALPHA_COLOR (1<< 1)
  87. #define WIN_ALPHA_MODE (1<< 2)
  88. #define WIN_PRIORITY (1<< 3)
  89. #define WIN_CHANNEL (1<< 4)
  90. #define WIN_BUFFER_FORMAT (1<< 5)
  91. #define WIN_COLOR_ORDER (1<< 6)
  92. #define WIN_PIXEL_ORDER (1<< 7)
  93. #define WIN_SIZE (1<< 8)
  94. #define WIN_COLORKEY_MODE (1<< 9)
  95. #define WIN_DOUBLE_BUFFER_MODE (1<< 10)
  96. #define WIN_RAM_ARRAY_MODE (1<< 11)
  97. #define WIN_BUFFER_SCALE (1<< 12)
  98. #define WIN_ENABLE (1<< 13)
  99. struct au1200_lcd_window_regs_t {
  100. unsigned int flags;
  101. unsigned int xpos;
  102. unsigned int ypos;
  103. unsigned int alpha_color;
  104. unsigned int alpha_mode;
  105. unsigned int priority;
  106. unsigned int channel;
  107. unsigned int buffer_format;
  108. unsigned int color_order;
  109. unsigned int pixel_order;
  110. unsigned int xsize;
  111. unsigned int ysize;
  112. unsigned int colorkey_mode;
  113. unsigned int double_buffer_mode;
  114. unsigned int ram_array_mode;
  115. unsigned int xscale;
  116. unsigned int yscale;
  117. unsigned int enable;
  118. };
  119. struct au1200_lcd_iodata_t {
  120. unsigned int subcmd;
  121. struct au1200_lcd_global_regs_t global;
  122. struct au1200_lcd_window_regs_t window;
  123. };
  124. #if defined(__BIG_ENDIAN)
  125. #define LCD_CONTROL_DEFAULT_PO LCD_CONTROL_PO_11
  126. #else
  127. #define LCD_CONTROL_DEFAULT_PO LCD_CONTROL_PO_00
  128. #endif
  129. #define LCD_CONTROL_DEFAULT_SBPPF LCD_CONTROL_SBPPF_565
  130. /* Private, per-framebuffer management information (independent of the panel itself) */
  131. struct au1200fb_device {
  132. struct fb_info fb_info; /* FB driver info record */
  133. int plane;
  134. unsigned char* fb_mem; /* FrameBuffer memory map */
  135. unsigned int fb_len;
  136. dma_addr_t fb_phys;
  137. };
  138. static struct au1200fb_device _au1200fb_devices[CONFIG_FB_AU1200_DEVS];
  139. /********************************************************************/
  140. /* LCD controller restrictions */
  141. #define AU1200_LCD_MAX_XRES 1280
  142. #define AU1200_LCD_MAX_YRES 1024
  143. #define AU1200_LCD_MAX_BPP 32
  144. #define AU1200_LCD_MAX_CLK 96000000 /* fixme: this needs to go away ? */
  145. #define AU1200_LCD_NBR_PALETTE_ENTRIES 256
  146. /* Default number of visible screen buffer to allocate */
  147. #define AU1200FB_NBR_VIDEO_BUFFERS 1
  148. /********************************************************************/
  149. static struct au1200_lcd *lcd = (struct au1200_lcd *) AU1200_LCD_ADDR;
  150. static int window_index = 2; /* default is zero */
  151. static int panel_index = 2; /* default is zero */
  152. static struct window_settings *win;
  153. static struct panel_settings *panel;
  154. static int noblanking = 1;
  155. static int nohwcursor = 0;
  156. struct window_settings {
  157. unsigned char name[64];
  158. uint32 mode_backcolor;
  159. uint32 mode_colorkey;
  160. uint32 mode_colorkeymsk;
  161. struct {
  162. int xres;
  163. int yres;
  164. int xpos;
  165. int ypos;
  166. uint32 mode_winctrl1; /* winctrl1[FRM,CCO,PO,PIPE] */
  167. uint32 mode_winenable;
  168. } w[4];
  169. };
  170. #if defined(__BIG_ENDIAN)
  171. #define LCD_WINCTRL1_PO_16BPP LCD_WINCTRL1_PO_00
  172. #else
  173. #define LCD_WINCTRL1_PO_16BPP LCD_WINCTRL1_PO_01
  174. #endif
  175. extern int board_au1200fb_panel_init (void);
  176. extern int board_au1200fb_panel_shutdown (void);
  177. #ifdef CONFIG_PM
  178. int au1200fb_pm_callback(au1xxx_power_dev_t *dev,
  179. au1xxx_request_t request, void *data);
  180. au1xxx_power_dev_t *LCD_pm_dev;
  181. #endif
  182. /*
  183. * Default window configurations
  184. */
  185. static struct window_settings windows[] = {
  186. { /* Index 0 */
  187. "0-FS gfx, 1-video, 2-ovly gfx, 3-ovly gfx",
  188. /* mode_backcolor */ 0x006600ff,
  189. /* mode_colorkey,msk*/ 0, 0,
  190. {
  191. {
  192. /* xres, yres, xpos, ypos */ 0, 0, 0, 0,
  193. /* mode_winctrl1 */ LCD_WINCTRL1_FRM_16BPP565 |
  194. LCD_WINCTRL1_PO_16BPP,
  195. /* mode_winenable*/ LCD_WINENABLE_WEN0,
  196. },
  197. {
  198. /* xres, yres, xpos, ypos */ 100, 100, 100, 100,
  199. /* mode_winctrl1 */ LCD_WINCTRL1_FRM_16BPP565 |
  200. LCD_WINCTRL1_PO_16BPP |
  201. LCD_WINCTRL1_PIPE,
  202. /* mode_winenable*/ LCD_WINENABLE_WEN1,
  203. },
  204. {
  205. /* xres, yres, xpos, ypos */ 0, 0, 0, 0,
  206. /* mode_winctrl1 */ LCD_WINCTRL1_FRM_16BPP565 |
  207. LCD_WINCTRL1_PO_16BPP,
  208. /* mode_winenable*/ 0,
  209. },
  210. {
  211. /* xres, yres, xpos, ypos */ 0, 0, 0, 0,
  212. /* mode_winctrl1 */ LCD_WINCTRL1_FRM_16BPP565 |
  213. LCD_WINCTRL1_PO_16BPP |
  214. LCD_WINCTRL1_PIPE,
  215. /* mode_winenable*/ 0,
  216. },
  217. },
  218. },
  219. { /* Index 1 */
  220. "0-FS gfx, 1-video, 2-ovly gfx, 3-ovly gfx",
  221. /* mode_backcolor */ 0x006600ff,
  222. /* mode_colorkey,msk*/ 0, 0,
  223. {
  224. {
  225. /* xres, yres, xpos, ypos */ 320, 240, 5, 5,
  226. /* mode_winctrl1 */ LCD_WINCTRL1_FRM_24BPP |
  227. LCD_WINCTRL1_PO_00,
  228. /* mode_winenable*/ LCD_WINENABLE_WEN0,
  229. },
  230. {
  231. /* xres, yres, xpos, ypos */ 0, 0, 0, 0,
  232. /* mode_winctrl1 */ LCD_WINCTRL1_FRM_16BPP565
  233. | LCD_WINCTRL1_PO_16BPP,
  234. /* mode_winenable*/ 0,
  235. },
  236. {
  237. /* xres, yres, xpos, ypos */ 100, 100, 0, 0,
  238. /* mode_winctrl1 */ LCD_WINCTRL1_FRM_16BPP565 |
  239. LCD_WINCTRL1_PO_16BPP |
  240. LCD_WINCTRL1_PIPE,
  241. /* mode_winenable*/ 0/*LCD_WINENABLE_WEN2*/,
  242. },
  243. {
  244. /* xres, yres, xpos, ypos */ 200, 25, 0, 0,
  245. /* mode_winctrl1 */ LCD_WINCTRL1_FRM_16BPP565 |
  246. LCD_WINCTRL1_PO_16BPP |
  247. LCD_WINCTRL1_PIPE,
  248. /* mode_winenable*/ 0,
  249. },
  250. },
  251. },
  252. { /* Index 2 */
  253. "0-FS gfx, 1-video, 2-ovly gfx, 3-ovly gfx",
  254. /* mode_backcolor */ 0x006600ff,
  255. /* mode_colorkey,msk*/ 0, 0,
  256. {
  257. {
  258. /* xres, yres, xpos, ypos */ 0, 0, 0, 0,
  259. /* mode_winctrl1 */ LCD_WINCTRL1_FRM_16BPP565 |
  260. LCD_WINCTRL1_PO_16BPP,
  261. /* mode_winenable*/ LCD_WINENABLE_WEN0,
  262. },
  263. {
  264. /* xres, yres, xpos, ypos */ 0, 0, 0, 0,
  265. /* mode_winctrl1 */ LCD_WINCTRL1_FRM_16BPP565 |
  266. LCD_WINCTRL1_PO_16BPP,
  267. /* mode_winenable*/ 0,
  268. },
  269. {
  270. /* xres, yres, xpos, ypos */ 0, 0, 0, 0,
  271. /* mode_winctrl1 */ LCD_WINCTRL1_FRM_32BPP |
  272. LCD_WINCTRL1_PO_00|LCD_WINCTRL1_PIPE,
  273. /* mode_winenable*/ 0/*LCD_WINENABLE_WEN2*/,
  274. },
  275. {
  276. /* xres, yres, xpos, ypos */ 0, 0, 0, 0,
  277. /* mode_winctrl1 */ LCD_WINCTRL1_FRM_16BPP565 |
  278. LCD_WINCTRL1_PO_16BPP |
  279. LCD_WINCTRL1_PIPE,
  280. /* mode_winenable*/ 0,
  281. },
  282. },
  283. },
  284. /* Need VGA 640 @ 24bpp, @ 32bpp */
  285. /* Need VGA 800 @ 24bpp, @ 32bpp */
  286. /* Need VGA 1024 @ 24bpp, @ 32bpp */
  287. };
  288. /*
  289. * Controller configurations for various panels.
  290. */
  291. struct panel_settings
  292. {
  293. const char name[25]; /* Full name <vendor>_<model> */
  294. struct fb_monspecs monspecs; /* FB monitor specs */
  295. /* panel timings */
  296. uint32 mode_screen;
  297. uint32 mode_horztiming;
  298. uint32 mode_verttiming;
  299. uint32 mode_clkcontrol;
  300. uint32 mode_pwmdiv;
  301. uint32 mode_pwmhi;
  302. uint32 mode_outmask;
  303. uint32 mode_fifoctrl;
  304. uint32 mode_toyclksrc;
  305. uint32 mode_backlight;
  306. uint32 mode_auxpll;
  307. int (*device_init)(void);
  308. int (*device_shutdown)(void);
  309. #define Xres min_xres
  310. #define Yres min_yres
  311. u32 min_xres; /* Minimum horizontal resolution */
  312. u32 max_xres; /* Maximum horizontal resolution */
  313. u32 min_yres; /* Minimum vertical resolution */
  314. u32 max_yres; /* Maximum vertical resolution */
  315. };
  316. /********************************************************************/
  317. /* fixme: Maybe a modedb for the CRT ? otherwise panels should be as-is */
  318. /* List of panels known to work with the AU1200 LCD controller.
  319. * To add a new panel, enter the same specifications as the
  320. * Generic_TFT one, and MAKE SURE that it doesn't conflicts
  321. * with the controller restrictions. Restrictions are:
  322. *
  323. * STN color panels: max_bpp <= 12
  324. * STN mono panels: max_bpp <= 4
  325. * TFT panels: max_bpp <= 16
  326. * max_xres <= 800
  327. * max_yres <= 600
  328. */
  329. static struct panel_settings known_lcd_panels[] =
  330. {
  331. [0] = { /* QVGA 320x240 H:33.3kHz V:110Hz */
  332. .name = "QVGA_320x240",
  333. .monspecs = {
  334. .modedb = NULL,
  335. .modedb_len = 0,
  336. .hfmin = 30000,
  337. .hfmax = 70000,
  338. .vfmin = 60,
  339. .vfmax = 60,
  340. .dclkmin = 6000000,
  341. .dclkmax = 28000000,
  342. .input = FB_DISP_RGB,
  343. },
  344. .mode_screen = LCD_SCREEN_SX_N(320) |
  345. LCD_SCREEN_SY_N(240),
  346. .mode_horztiming = 0x00c4623b,
  347. .mode_verttiming = 0x00502814,
  348. .mode_clkcontrol = 0x00020002, /* /4=24Mhz */
  349. .mode_pwmdiv = 0x00000000,
  350. .mode_pwmhi = 0x00000000,
  351. .mode_outmask = 0x00FFFFFF,
  352. .mode_fifoctrl = 0x2f2f2f2f,
  353. .mode_toyclksrc = 0x00000004, /* AUXPLL directly */
  354. .mode_backlight = 0x00000000,
  355. .mode_auxpll = 8, /* 96MHz AUXPLL */
  356. .device_init = NULL,
  357. .device_shutdown = NULL,
  358. 320, 320,
  359. 240, 240,
  360. },
  361. [1] = { /* VGA 640x480 H:30.3kHz V:58Hz */
  362. .name = "VGA_640x480",
  363. .monspecs = {
  364. .modedb = NULL,
  365. .modedb_len = 0,
  366. .hfmin = 30000,
  367. .hfmax = 70000,
  368. .vfmin = 60,
  369. .vfmax = 60,
  370. .dclkmin = 6000000,
  371. .dclkmax = 28000000,
  372. .input = FB_DISP_RGB,
  373. },
  374. .mode_screen = 0x13f9df80,
  375. .mode_horztiming = 0x003c5859,
  376. .mode_verttiming = 0x00741201,
  377. .mode_clkcontrol = 0x00020001, /* /4=24Mhz */
  378. .mode_pwmdiv = 0x00000000,
  379. .mode_pwmhi = 0x00000000,
  380. .mode_outmask = 0x00FFFFFF,
  381. .mode_fifoctrl = 0x2f2f2f2f,
  382. .mode_toyclksrc = 0x00000004, /* AUXPLL directly */
  383. .mode_backlight = 0x00000000,
  384. .mode_auxpll = 8, /* 96MHz AUXPLL */
  385. .device_init = NULL,
  386. .device_shutdown = NULL,
  387. 640, 480,
  388. 640, 480,
  389. },
  390. [2] = { /* SVGA 800x600 H:46.1kHz V:69Hz */
  391. .name = "SVGA_800x600",
  392. .monspecs = {
  393. .modedb = NULL,
  394. .modedb_len = 0,
  395. .hfmin = 30000,
  396. .hfmax = 70000,
  397. .vfmin = 60,
  398. .vfmax = 60,
  399. .dclkmin = 6000000,
  400. .dclkmax = 28000000,
  401. .input = FB_DISP_RGB,
  402. },
  403. .mode_screen = 0x18fa5780,
  404. .mode_horztiming = 0x00dc7e77,
  405. .mode_verttiming = 0x00584805,
  406. .mode_clkcontrol = 0x00020000, /* /2=48Mhz */
  407. .mode_pwmdiv = 0x00000000,
  408. .mode_pwmhi = 0x00000000,
  409. .mode_outmask = 0x00FFFFFF,
  410. .mode_fifoctrl = 0x2f2f2f2f,
  411. .mode_toyclksrc = 0x00000004, /* AUXPLL directly */
  412. .mode_backlight = 0x00000000,
  413. .mode_auxpll = 8, /* 96MHz AUXPLL */
  414. .device_init = NULL,
  415. .device_shutdown = NULL,
  416. 800, 800,
  417. 600, 600,
  418. },
  419. [3] = { /* XVGA 1024x768 H:56.2kHz V:70Hz */
  420. .name = "XVGA_1024x768",
  421. .monspecs = {
  422. .modedb = NULL,
  423. .modedb_len = 0,
  424. .hfmin = 30000,
  425. .hfmax = 70000,
  426. .vfmin = 60,
  427. .vfmax = 60,
  428. .dclkmin = 6000000,
  429. .dclkmax = 28000000,
  430. .input = FB_DISP_RGB,
  431. },
  432. .mode_screen = 0x1ffaff80,
  433. .mode_horztiming = 0x007d0e57,
  434. .mode_verttiming = 0x00740a01,
  435. .mode_clkcontrol = 0x000A0000, /* /1 */
  436. .mode_pwmdiv = 0x00000000,
  437. .mode_pwmhi = 0x00000000,
  438. .mode_outmask = 0x00FFFFFF,
  439. .mode_fifoctrl = 0x2f2f2f2f,
  440. .mode_toyclksrc = 0x00000004, /* AUXPLL directly */
  441. .mode_backlight = 0x00000000,
  442. .mode_auxpll = 6, /* 72MHz AUXPLL */
  443. .device_init = NULL,
  444. .device_shutdown = NULL,
  445. 1024, 1024,
  446. 768, 768,
  447. },
  448. [4] = { /* XVGA XVGA 1280x1024 H:68.5kHz V:65Hz */
  449. .name = "XVGA_1280x1024",
  450. .monspecs = {
  451. .modedb = NULL,
  452. .modedb_len = 0,
  453. .hfmin = 30000,
  454. .hfmax = 70000,
  455. .vfmin = 60,
  456. .vfmax = 60,
  457. .dclkmin = 6000000,
  458. .dclkmax = 28000000,
  459. .input = FB_DISP_RGB,
  460. },
  461. .mode_screen = 0x27fbff80,
  462. .mode_horztiming = 0x00cdb2c7,
  463. .mode_verttiming = 0x00600002,
  464. .mode_clkcontrol = 0x000A0000, /* /1 */
  465. .mode_pwmdiv = 0x00000000,
  466. .mode_pwmhi = 0x00000000,
  467. .mode_outmask = 0x00FFFFFF,
  468. .mode_fifoctrl = 0x2f2f2f2f,
  469. .mode_toyclksrc = 0x00000004, /* AUXPLL directly */
  470. .mode_backlight = 0x00000000,
  471. .mode_auxpll = 10, /* 120MHz AUXPLL */
  472. .device_init = NULL,
  473. .device_shutdown = NULL,
  474. 1280, 1280,
  475. 1024, 1024,
  476. },
  477. [5] = { /* Samsung 1024x768 TFT */
  478. .name = "Samsung_1024x768_TFT",
  479. .monspecs = {
  480. .modedb = NULL,
  481. .modedb_len = 0,
  482. .hfmin = 30000,
  483. .hfmax = 70000,
  484. .vfmin = 60,
  485. .vfmax = 60,
  486. .dclkmin = 6000000,
  487. .dclkmax = 28000000,
  488. .input = FB_DISP_RGB,
  489. },
  490. .mode_screen = 0x1ffaff80,
  491. .mode_horztiming = 0x018cc677,
  492. .mode_verttiming = 0x00241217,
  493. .mode_clkcontrol = 0x00000000, /* SCB 0x1 /4=24Mhz */
  494. .mode_pwmdiv = 0x8000063f, /* SCB 0x0 */
  495. .mode_pwmhi = 0x03400000, /* SCB 0x0 */
  496. .mode_outmask = 0x00FFFFFF,
  497. .mode_fifoctrl = 0x2f2f2f2f,
  498. .mode_toyclksrc = 0x00000004, /* AUXPLL directly */
  499. .mode_backlight = 0x00000000,
  500. .mode_auxpll = 8, /* 96MHz AUXPLL */
  501. .device_init = board_au1200fb_panel_init,
  502. .device_shutdown = board_au1200fb_panel_shutdown,
  503. 1024, 1024,
  504. 768, 768,
  505. },
  506. [6] = { /* Toshiba 640x480 TFT */
  507. .name = "Toshiba_640x480_TFT",
  508. .monspecs = {
  509. .modedb = NULL,
  510. .modedb_len = 0,
  511. .hfmin = 30000,
  512. .hfmax = 70000,
  513. .vfmin = 60,
  514. .vfmax = 60,
  515. .dclkmin = 6000000,
  516. .dclkmax = 28000000,
  517. .input = FB_DISP_RGB,
  518. },
  519. .mode_screen = LCD_SCREEN_SX_N(640) |
  520. LCD_SCREEN_SY_N(480),
  521. .mode_horztiming = LCD_HORZTIMING_HPW_N(96) |
  522. LCD_HORZTIMING_HND1_N(13) | LCD_HORZTIMING_HND2_N(51),
  523. .mode_verttiming = LCD_VERTTIMING_VPW_N(2) |
  524. LCD_VERTTIMING_VND1_N(11) | LCD_VERTTIMING_VND2_N(32),
  525. .mode_clkcontrol = 0x00000000, /* /4=24Mhz */
  526. .mode_pwmdiv = 0x8000063f,
  527. .mode_pwmhi = 0x03400000,
  528. .mode_outmask = 0x00fcfcfc,
  529. .mode_fifoctrl = 0x2f2f2f2f,
  530. .mode_toyclksrc = 0x00000004, /* AUXPLL directly */
  531. .mode_backlight = 0x00000000,
  532. .mode_auxpll = 8, /* 96MHz AUXPLL */
  533. .device_init = board_au1200fb_panel_init,
  534. .device_shutdown = board_au1200fb_panel_shutdown,
  535. 640, 480,
  536. 640, 480,
  537. },
  538. [7] = { /* Sharp 320x240 TFT */
  539. .name = "Sharp_320x240_TFT",
  540. .monspecs = {
  541. .modedb = NULL,
  542. .modedb_len = 0,
  543. .hfmin = 12500,
  544. .hfmax = 20000,
  545. .vfmin = 38,
  546. .vfmax = 81,
  547. .dclkmin = 4500000,
  548. .dclkmax = 6800000,
  549. .input = FB_DISP_RGB,
  550. },
  551. .mode_screen = LCD_SCREEN_SX_N(320) |
  552. LCD_SCREEN_SY_N(240),
  553. .mode_horztiming = LCD_HORZTIMING_HPW_N(60) |
  554. LCD_HORZTIMING_HND1_N(13) | LCD_HORZTIMING_HND2_N(2),
  555. .mode_verttiming = LCD_VERTTIMING_VPW_N(2) |
  556. LCD_VERTTIMING_VND1_N(2) | LCD_VERTTIMING_VND2_N(5),
  557. .mode_clkcontrol = LCD_CLKCONTROL_PCD_N(7), /*16=6Mhz*/
  558. .mode_pwmdiv = 0x8000063f,
  559. .mode_pwmhi = 0x03400000,
  560. .mode_outmask = 0x00fcfcfc,
  561. .mode_fifoctrl = 0x2f2f2f2f,
  562. .mode_toyclksrc = 0x00000004, /* AUXPLL directly */
  563. .mode_backlight = 0x00000000,
  564. .mode_auxpll = 8, /* 96MHz AUXPLL */
  565. .device_init = board_au1200fb_panel_init,
  566. .device_shutdown = board_au1200fb_panel_shutdown,
  567. 320, 320,
  568. 240, 240,
  569. },
  570. [8] = { /* Toppoly TD070WGCB2 7" 856x480 TFT */
  571. .name = "Toppoly_TD070WGCB2",
  572. .monspecs = {
  573. .modedb = NULL,
  574. .modedb_len = 0,
  575. .hfmin = 30000,
  576. .hfmax = 70000,
  577. .vfmin = 60,
  578. .vfmax = 60,
  579. .dclkmin = 6000000,
  580. .dclkmax = 28000000,
  581. .input = FB_DISP_RGB,
  582. },
  583. .mode_screen = LCD_SCREEN_SX_N(856) |
  584. LCD_SCREEN_SY_N(480),
  585. .mode_horztiming = LCD_HORZTIMING_HND2_N(43) |
  586. LCD_HORZTIMING_HND1_N(43) | LCD_HORZTIMING_HPW_N(114),
  587. .mode_verttiming = LCD_VERTTIMING_VND2_N(20) |
  588. LCD_VERTTIMING_VND1_N(21) | LCD_VERTTIMING_VPW_N(4),
  589. .mode_clkcontrol = 0x00020001, /* /4=24Mhz */
  590. .mode_pwmdiv = 0x8000063f,
  591. .mode_pwmhi = 0x03400000,
  592. .mode_outmask = 0x00fcfcfc,
  593. .mode_fifoctrl = 0x2f2f2f2f,
  594. .mode_toyclksrc = 0x00000004, /* AUXPLL directly */
  595. .mode_backlight = 0x00000000,
  596. .mode_auxpll = 8, /* 96MHz AUXPLL */
  597. .device_init = board_au1200fb_panel_init,
  598. .device_shutdown = board_au1200fb_panel_shutdown,
  599. 856, 856,
  600. 480, 480,
  601. },
  602. };
  603. #define NUM_PANELS (ARRAY_SIZE(known_lcd_panels))
  604. /********************************************************************/
  605. #ifdef CONFIG_PM
  606. static int set_brightness(unsigned int brightness)
  607. {
  608. unsigned int hi1, divider;
  609. /* limit brightness pwm duty to >= 30/1600 */
  610. if (brightness < 30) {
  611. brightness = 30;
  612. }
  613. divider = (lcd->pwmdiv & 0x3FFFF) + 1;
  614. hi1 = (lcd->pwmhi >> 16) + 1;
  615. hi1 = (((brightness & 0xFF) + 1) * divider >> 8);
  616. lcd->pwmhi &= 0xFFFF;
  617. lcd->pwmhi |= (hi1 << 16);
  618. return brightness;
  619. }
  620. #endif /* CONFIG_PM */
  621. static int winbpp (unsigned int winctrl1)
  622. {
  623. int bits = 0;
  624. /* how many bits are needed for each pixel format */
  625. switch (winctrl1 & LCD_WINCTRL1_FRM) {
  626. case LCD_WINCTRL1_FRM_1BPP:
  627. bits = 1;
  628. break;
  629. case LCD_WINCTRL1_FRM_2BPP:
  630. bits = 2;
  631. break;
  632. case LCD_WINCTRL1_FRM_4BPP:
  633. bits = 4;
  634. break;
  635. case LCD_WINCTRL1_FRM_8BPP:
  636. bits = 8;
  637. break;
  638. case LCD_WINCTRL1_FRM_12BPP:
  639. case LCD_WINCTRL1_FRM_16BPP655:
  640. case LCD_WINCTRL1_FRM_16BPP565:
  641. case LCD_WINCTRL1_FRM_16BPP556:
  642. case LCD_WINCTRL1_FRM_16BPPI1555:
  643. case LCD_WINCTRL1_FRM_16BPPI5551:
  644. case LCD_WINCTRL1_FRM_16BPPA1555:
  645. case LCD_WINCTRL1_FRM_16BPPA5551:
  646. bits = 16;
  647. break;
  648. case LCD_WINCTRL1_FRM_24BPP:
  649. case LCD_WINCTRL1_FRM_32BPP:
  650. bits = 32;
  651. break;
  652. }
  653. return bits;
  654. }
  655. static int fbinfo2index (struct fb_info *fb_info)
  656. {
  657. int i;
  658. for (i = 0; i < CONFIG_FB_AU1200_DEVS; ++i) {
  659. if (fb_info == (struct fb_info *)(&_au1200fb_devices[i].fb_info))
  660. return i;
  661. }
  662. printk("au1200fb: ERROR: fbinfo2index failed!\n");
  663. return -1;
  664. }
  665. static int au1200_setlocation (struct au1200fb_device *fbdev, int plane,
  666. int xpos, int ypos)
  667. {
  668. uint32 winctrl0, winctrl1, winenable, fb_offset = 0;
  669. int xsz, ysz;
  670. /* FIX!!! NOT CHECKING FOR COMPLETE OFFSCREEN YET */
  671. winctrl0 = lcd->window[plane].winctrl0;
  672. winctrl1 = lcd->window[plane].winctrl1;
  673. winctrl0 &= (LCD_WINCTRL0_A | LCD_WINCTRL0_AEN);
  674. winctrl1 &= ~(LCD_WINCTRL1_SZX | LCD_WINCTRL1_SZY);
  675. /* Check for off-screen adjustments */
  676. xsz = win->w[plane].xres;
  677. ysz = win->w[plane].yres;
  678. if ((xpos + win->w[plane].xres) > panel->Xres) {
  679. /* Off-screen to the right */
  680. xsz = panel->Xres - xpos; /* off by 1 ??? */
  681. /*printk("off screen right\n");*/
  682. }
  683. if ((ypos + win->w[plane].yres) > panel->Yres) {
  684. /* Off-screen to the bottom */
  685. ysz = panel->Yres - ypos; /* off by 1 ??? */
  686. /*printk("off screen bottom\n");*/
  687. }
  688. if (xpos < 0) {
  689. /* Off-screen to the left */
  690. xsz = win->w[plane].xres + xpos;
  691. fb_offset += (((0 - xpos) * winbpp(lcd->window[plane].winctrl1))/8);
  692. xpos = 0;
  693. /*printk("off screen left\n");*/
  694. }
  695. if (ypos < 0) {
  696. /* Off-screen to the top */
  697. ysz = win->w[plane].yres + ypos;
  698. /* fixme: fb_offset += ((0-ypos)*fb_pars[plane].line_length); */
  699. ypos = 0;
  700. /*printk("off screen top\n");*/
  701. }
  702. /* record settings */
  703. win->w[plane].xpos = xpos;
  704. win->w[plane].ypos = ypos;
  705. xsz -= 1;
  706. ysz -= 1;
  707. winctrl0 |= (xpos << 21);
  708. winctrl0 |= (ypos << 10);
  709. winctrl1 |= (xsz << 11);
  710. winctrl1 |= (ysz << 0);
  711. /* Disable the window while making changes, then restore WINEN */
  712. winenable = lcd->winenable & (1 << plane);
  713. au_sync();
  714. lcd->winenable &= ~(1 << plane);
  715. lcd->window[plane].winctrl0 = winctrl0;
  716. lcd->window[plane].winctrl1 = winctrl1;
  717. lcd->window[plane].winbuf0 =
  718. lcd->window[plane].winbuf1 = fbdev->fb_phys;
  719. lcd->window[plane].winbufctrl = 0; /* select winbuf0 */
  720. lcd->winenable |= winenable;
  721. au_sync();
  722. return 0;
  723. }
  724. static void au1200_setpanel (struct panel_settings *newpanel)
  725. {
  726. /*
  727. * Perform global setup/init of LCD controller
  728. */
  729. uint32 winenable;
  730. /* Make sure all windows disabled */
  731. winenable = lcd->winenable;
  732. lcd->winenable = 0;
  733. au_sync();
  734. /*
  735. * Ensure everything is disabled before reconfiguring
  736. */
  737. if (lcd->screen & LCD_SCREEN_SEN) {
  738. /* Wait for vertical sync period */
  739. lcd->intstatus = LCD_INT_SS;
  740. while ((lcd->intstatus & LCD_INT_SS) == 0) {
  741. au_sync();
  742. }
  743. lcd->screen &= ~LCD_SCREEN_SEN; /*disable the controller*/
  744. do {
  745. lcd->intstatus = lcd->intstatus; /*clear interrupts*/
  746. au_sync();
  747. /*wait for controller to shut down*/
  748. } while ((lcd->intstatus & LCD_INT_SD) == 0);
  749. /* Call shutdown of current panel (if up) */
  750. /* this must occur last, because if an external clock is driving
  751. the controller, the clock cannot be turned off before first
  752. shutting down the controller.
  753. */
  754. if (panel->device_shutdown != NULL)
  755. panel->device_shutdown();
  756. }
  757. /* Newpanel == NULL indicates a shutdown operation only */
  758. if (newpanel == NULL)
  759. return;
  760. panel = newpanel;
  761. printk("Panel(%s), %dx%d\n", panel->name, panel->Xres, panel->Yres);
  762. /*
  763. * Setup clocking if internal LCD clock source (assumes sys_auxpll valid)
  764. */
  765. if (!(panel->mode_clkcontrol & LCD_CLKCONTROL_EXT))
  766. {
  767. uint32 sys_clksrc;
  768. au_writel(panel->mode_auxpll, SYS_AUXPLL);
  769. sys_clksrc = au_readl(SYS_CLKSRC) & ~0x0000001f;
  770. sys_clksrc |= panel->mode_toyclksrc;
  771. au_writel(sys_clksrc, SYS_CLKSRC);
  772. }
  773. /*
  774. * Configure panel timings
  775. */
  776. lcd->screen = panel->mode_screen;
  777. lcd->horztiming = panel->mode_horztiming;
  778. lcd->verttiming = panel->mode_verttiming;
  779. lcd->clkcontrol = panel->mode_clkcontrol;
  780. lcd->pwmdiv = panel->mode_pwmdiv;
  781. lcd->pwmhi = panel->mode_pwmhi;
  782. lcd->outmask = panel->mode_outmask;
  783. lcd->fifoctrl = panel->mode_fifoctrl;
  784. au_sync();
  785. /* fixme: Check window settings to make sure still valid
  786. * for new geometry */
  787. #if 0
  788. au1200_setlocation(fbdev, 0, win->w[0].xpos, win->w[0].ypos);
  789. au1200_setlocation(fbdev, 1, win->w[1].xpos, win->w[1].ypos);
  790. au1200_setlocation(fbdev, 2, win->w[2].xpos, win->w[2].ypos);
  791. au1200_setlocation(fbdev, 3, win->w[3].xpos, win->w[3].ypos);
  792. #endif
  793. lcd->winenable = winenable;
  794. /*
  795. * Re-enable screen now that it is configured
  796. */
  797. lcd->screen |= LCD_SCREEN_SEN;
  798. au_sync();
  799. /* Call init of panel */
  800. if (panel->device_init != NULL) panel->device_init();
  801. /* FIX!!!! not appropriate on panel change!!! Global setup/init */
  802. lcd->intenable = 0;
  803. lcd->intstatus = ~0;
  804. lcd->backcolor = win->mode_backcolor;
  805. /* Setup Color Key - FIX!!! */
  806. lcd->colorkey = win->mode_colorkey;
  807. lcd->colorkeymsk = win->mode_colorkeymsk;
  808. /* Setup HWCursor - FIX!!! Need to support this eventually */
  809. lcd->hwc.cursorctrl = 0;
  810. lcd->hwc.cursorpos = 0;
  811. lcd->hwc.cursorcolor0 = 0;
  812. lcd->hwc.cursorcolor1 = 0;
  813. lcd->hwc.cursorcolor2 = 0;
  814. lcd->hwc.cursorcolor3 = 0;
  815. #if 0
  816. #define D(X) printk("%25s: %08X\n", #X, X)
  817. D(lcd->screen);
  818. D(lcd->horztiming);
  819. D(lcd->verttiming);
  820. D(lcd->clkcontrol);
  821. D(lcd->pwmdiv);
  822. D(lcd->pwmhi);
  823. D(lcd->outmask);
  824. D(lcd->fifoctrl);
  825. D(lcd->window[0].winctrl0);
  826. D(lcd->window[0].winctrl1);
  827. D(lcd->window[0].winctrl2);
  828. D(lcd->window[0].winbuf0);
  829. D(lcd->window[0].winbuf1);
  830. D(lcd->window[0].winbufctrl);
  831. D(lcd->window[1].winctrl0);
  832. D(lcd->window[1].winctrl1);
  833. D(lcd->window[1].winctrl2);
  834. D(lcd->window[1].winbuf0);
  835. D(lcd->window[1].winbuf1);
  836. D(lcd->window[1].winbufctrl);
  837. D(lcd->window[2].winctrl0);
  838. D(lcd->window[2].winctrl1);
  839. D(lcd->window[2].winctrl2);
  840. D(lcd->window[2].winbuf0);
  841. D(lcd->window[2].winbuf1);
  842. D(lcd->window[2].winbufctrl);
  843. D(lcd->window[3].winctrl0);
  844. D(lcd->window[3].winctrl1);
  845. D(lcd->window[3].winctrl2);
  846. D(lcd->window[3].winbuf0);
  847. D(lcd->window[3].winbuf1);
  848. D(lcd->window[3].winbufctrl);
  849. D(lcd->winenable);
  850. D(lcd->intenable);
  851. D(lcd->intstatus);
  852. D(lcd->backcolor);
  853. D(lcd->winenable);
  854. D(lcd->colorkey);
  855. D(lcd->colorkeymsk);
  856. D(lcd->hwc.cursorctrl);
  857. D(lcd->hwc.cursorpos);
  858. D(lcd->hwc.cursorcolor0);
  859. D(lcd->hwc.cursorcolor1);
  860. D(lcd->hwc.cursorcolor2);
  861. D(lcd->hwc.cursorcolor3);
  862. #endif
  863. }
  864. static void au1200_setmode(struct au1200fb_device *fbdev)
  865. {
  866. int plane = fbdev->plane;
  867. /* Window/plane setup */
  868. lcd->window[plane].winctrl1 = ( 0
  869. | LCD_WINCTRL1_PRI_N(plane)
  870. | win->w[plane].mode_winctrl1 /* FRM,CCO,PO,PIPE */
  871. ) ;
  872. au1200_setlocation(fbdev, plane, win->w[plane].xpos, win->w[plane].ypos);
  873. lcd->window[plane].winctrl2 = ( 0
  874. | LCD_WINCTRL2_CKMODE_00
  875. | LCD_WINCTRL2_DBM
  876. | LCD_WINCTRL2_BX_N( fbdev->fb_info.fix.line_length)
  877. | LCD_WINCTRL2_SCX_1
  878. | LCD_WINCTRL2_SCY_1
  879. ) ;
  880. lcd->winenable |= win->w[plane].mode_winenable;
  881. au_sync();
  882. }
  883. /* Inline helpers */
  884. /*#define panel_is_dual(panel) ((panel->mode_screen & LCD_SCREEN_PT) == LCD_SCREEN_PT_010)*/
  885. /*#define panel_is_active(panel)((panel->mode_screen & LCD_SCREEN_PT) == LCD_SCREEN_PT_010)*/
  886. #define panel_is_color(panel) ((panel->mode_screen & LCD_SCREEN_PT) <= LCD_SCREEN_PT_CDSTN)
  887. /* Bitfields format supported by the controller. */
  888. static struct fb_bitfield rgb_bitfields[][4] = {
  889. /* Red, Green, Blue, Transp */
  890. [LCD_WINCTRL1_FRM_16BPP655 >> 25] =
  891. { { 10, 6, 0 }, { 5, 5, 0 }, { 0, 5, 0 }, { 0, 0, 0 } },
  892. [LCD_WINCTRL1_FRM_16BPP565 >> 25] =
  893. { { 11, 5, 0 }, { 5, 6, 0 }, { 0, 5, 0 }, { 0, 0, 0 } },
  894. [LCD_WINCTRL1_FRM_16BPP556 >> 25] =
  895. { { 11, 5, 0 }, { 6, 5, 0 }, { 0, 6, 0 }, { 0, 0, 0 } },
  896. [LCD_WINCTRL1_FRM_16BPPI1555 >> 25] =
  897. { { 10, 5, 0 }, { 5, 5, 0 }, { 0, 5, 0 }, { 0, 0, 0 } },
  898. [LCD_WINCTRL1_FRM_16BPPI5551 >> 25] =
  899. { { 11, 5, 0 }, { 6, 5, 0 }, { 1, 5, 0 }, { 0, 0, 0 } },
  900. [LCD_WINCTRL1_FRM_16BPPA1555 >> 25] =
  901. { { 10, 5, 0 }, { 5, 5, 0 }, { 0, 5, 0 }, { 15, 1, 0 } },
  902. [LCD_WINCTRL1_FRM_16BPPA5551 >> 25] =
  903. { { 11, 5, 0 }, { 6, 5, 0 }, { 1, 5, 0 }, { 0, 1, 0 } },
  904. [LCD_WINCTRL1_FRM_24BPP >> 25] =
  905. { { 16, 8, 0 }, { 8, 8, 0 }, { 0, 8, 0 }, { 0, 0, 0 } },
  906. [LCD_WINCTRL1_FRM_32BPP >> 25] =
  907. { { 16, 8, 0 }, { 8, 8, 0 }, { 0, 8, 0 }, { 24, 0, 0 } },
  908. };
  909. /*-------------------------------------------------------------------------*/
  910. /* Helpers */
  911. static void au1200fb_update_fbinfo(struct fb_info *fbi)
  912. {
  913. /* FIX!!!! This also needs to take the window pixel format into account!!! */
  914. /* Update var-dependent FB info */
  915. if (panel_is_color(panel)) {
  916. if (fbi->var.bits_per_pixel <= 8) {
  917. /* palettized */
  918. fbi->fix.visual = FB_VISUAL_PSEUDOCOLOR;
  919. fbi->fix.line_length = fbi->var.xres_virtual /
  920. (8/fbi->var.bits_per_pixel);
  921. } else {
  922. /* non-palettized */
  923. fbi->fix.visual = FB_VISUAL_TRUECOLOR;
  924. fbi->fix.line_length = fbi->var.xres_virtual * (fbi->var.bits_per_pixel / 8);
  925. }
  926. } else {
  927. /* mono FIX!!! mono 8 and 4 bits */
  928. fbi->fix.visual = FB_VISUAL_MONO10;
  929. fbi->fix.line_length = fbi->var.xres_virtual / 8;
  930. }
  931. fbi->screen_size = fbi->fix.line_length * fbi->var.yres_virtual;
  932. print_dbg("line length: %d\n", fbi->fix.line_length);
  933. print_dbg("bits_per_pixel: %d\n", fbi->var.bits_per_pixel);
  934. }
  935. /*-------------------------------------------------------------------------*/
  936. /* AU1200 framebuffer driver */
  937. /* fb_check_var
  938. * Validate var settings with hardware restrictions and modify it if necessary
  939. */
  940. static int au1200fb_fb_check_var(struct fb_var_screeninfo *var,
  941. struct fb_info *fbi)
  942. {
  943. struct au1200fb_device *fbdev = (struct au1200fb_device *)fbi;
  944. u32 pixclock;
  945. int screen_size, plane;
  946. plane = fbdev->plane;
  947. /* Make sure that the mode respect all LCD controller and
  948. * panel restrictions. */
  949. var->xres = win->w[plane].xres;
  950. var->yres = win->w[plane].yres;
  951. /* No need for virtual resolution support */
  952. var->xres_virtual = var->xres;
  953. var->yres_virtual = var->yres;
  954. var->bits_per_pixel = winbpp(win->w[plane].mode_winctrl1);
  955. screen_size = var->xres_virtual * var->yres_virtual;
  956. if (var->bits_per_pixel > 8) screen_size *= (var->bits_per_pixel / 8);
  957. else screen_size /= (8/var->bits_per_pixel);
  958. if (fbdev->fb_len < screen_size)
  959. return -EINVAL; /* Virtual screen is to big, abort */
  960. /* FIX!!!! what are the implicaitons of ignoring this for windows ??? */
  961. /* The max LCD clock is fixed to 48MHz (value of AUX_CLK). The pixel
  962. * clock can only be obtain by dividing this value by an even integer.
  963. * Fallback to a slower pixel clock if necessary. */
  964. pixclock = max((u32)(PICOS2KHZ(var->pixclock) * 1000), fbi->monspecs.dclkmin);
  965. pixclock = min(pixclock, min(fbi->monspecs.dclkmax, (u32)AU1200_LCD_MAX_CLK/2));
  966. if (AU1200_LCD_MAX_CLK % pixclock) {
  967. int diff = AU1200_LCD_MAX_CLK % pixclock;
  968. pixclock -= diff;
  969. }
  970. var->pixclock = KHZ2PICOS(pixclock/1000);
  971. #if 0
  972. if (!panel_is_active(panel)) {
  973. int pcd = AU1200_LCD_MAX_CLK / (pixclock * 2) - 1;
  974. if (!panel_is_color(panel)
  975. && (panel->control_base & LCD_CONTROL_MPI) && (pcd < 3)) {
  976. /* STN 8bit mono panel support is up to 6MHz pixclock */
  977. var->pixclock = KHZ2PICOS(6000);
  978. } else if (!pcd) {
  979. /* Other STN panel support is up to 12MHz */
  980. var->pixclock = KHZ2PICOS(12000);
  981. }
  982. }
  983. #endif
  984. /* Set bitfield accordingly */
  985. switch (var->bits_per_pixel) {
  986. case 16:
  987. {
  988. /* 16bpp True color.
  989. * These must be set to MATCH WINCTRL[FORM] */
  990. int idx;
  991. idx = (win->w[0].mode_winctrl1 & LCD_WINCTRL1_FRM) >> 25;
  992. var->red = rgb_bitfields[idx][0];
  993. var->green = rgb_bitfields[idx][1];
  994. var->blue = rgb_bitfields[idx][2];
  995. var->transp = rgb_bitfields[idx][3];
  996. break;
  997. }
  998. case 32:
  999. {
  1000. /* 32bpp True color.
  1001. * These must be set to MATCH WINCTRL[FORM] */
  1002. int idx;
  1003. idx = (win->w[0].mode_winctrl1 & LCD_WINCTRL1_FRM) >> 25;
  1004. var->red = rgb_bitfields[idx][0];
  1005. var->green = rgb_bitfields[idx][1];
  1006. var->blue = rgb_bitfields[idx][2];
  1007. var->transp = rgb_bitfields[idx][3];
  1008. break;
  1009. }
  1010. default:
  1011. print_dbg("Unsupported depth %dbpp", var->bits_per_pixel);
  1012. return -EINVAL;
  1013. }
  1014. return 0;
  1015. }
  1016. /* fb_set_par
  1017. * Set hardware with var settings. This will enable the controller with a
  1018. * specific mode, normally validated with the fb_check_var method
  1019. */
  1020. static int au1200fb_fb_set_par(struct fb_info *fbi)
  1021. {
  1022. struct au1200fb_device *fbdev = (struct au1200fb_device *)fbi;
  1023. au1200fb_update_fbinfo(fbi);
  1024. au1200_setmode(fbdev);
  1025. return 0;
  1026. }
  1027. /* fb_setcolreg
  1028. * Set color in LCD palette.
  1029. */
  1030. static int au1200fb_fb_setcolreg(unsigned regno, unsigned red, unsigned green,
  1031. unsigned blue, unsigned transp, struct fb_info *fbi)
  1032. {
  1033. volatile u32 *palette = lcd->palette;
  1034. u32 value;
  1035. if (regno > (AU1200_LCD_NBR_PALETTE_ENTRIES - 1))
  1036. return -EINVAL;
  1037. if (fbi->var.grayscale) {
  1038. /* Convert color to grayscale */
  1039. red = green = blue =
  1040. (19595 * red + 38470 * green + 7471 * blue) >> 16;
  1041. }
  1042. if (fbi->fix.visual == FB_VISUAL_TRUECOLOR) {
  1043. /* Place color in the pseudopalette */
  1044. if (regno > 16)
  1045. return -EINVAL;
  1046. palette = (u32*) fbi->pseudo_palette;
  1047. red >>= (16 - fbi->var.red.length);
  1048. green >>= (16 - fbi->var.green.length);
  1049. blue >>= (16 - fbi->var.blue.length);
  1050. value = (red << fbi->var.red.offset) |
  1051. (green << fbi->var.green.offset)|
  1052. (blue << fbi->var.blue.offset);
  1053. value &= 0xFFFF;
  1054. } else if (1 /*FIX!!! panel_is_active(fbdev->panel)*/) {
  1055. /* COLOR TFT PALLETTIZED (use RGB 565) */
  1056. value = (red & 0xF800)|((green >> 5) &
  1057. 0x07E0)|((blue >> 11) & 0x001F);
  1058. value &= 0xFFFF;
  1059. } else if (0 /*panel_is_color(fbdev->panel)*/) {
  1060. /* COLOR STN MODE */
  1061. value = 0x1234;
  1062. value &= 0xFFF;
  1063. } else {
  1064. /* MONOCHROME MODE */
  1065. value = (green >> 12) & 0x000F;
  1066. value &= 0xF;
  1067. }
  1068. palette[regno] = value;
  1069. return 0;
  1070. }
  1071. /* fb_blank
  1072. * Blank the screen. Depending on the mode, the screen will be
  1073. * activated with the backlight color, or desactivated
  1074. */
  1075. static int au1200fb_fb_blank(int blank_mode, struct fb_info *fbi)
  1076. {
  1077. /* Short-circuit screen blanking */
  1078. if (noblanking)
  1079. return 0;
  1080. switch (blank_mode) {
  1081. case FB_BLANK_UNBLANK:
  1082. case FB_BLANK_NORMAL:
  1083. /* printk("turn on panel\n"); */
  1084. au1200_setpanel(panel);
  1085. break;
  1086. case FB_BLANK_VSYNC_SUSPEND:
  1087. case FB_BLANK_HSYNC_SUSPEND:
  1088. case FB_BLANK_POWERDOWN:
  1089. /* printk("turn off panel\n"); */
  1090. au1200_setpanel(NULL);
  1091. break;
  1092. default:
  1093. break;
  1094. }
  1095. /* FB_BLANK_NORMAL is a soft blank */
  1096. return (blank_mode == FB_BLANK_NORMAL) ? -EINVAL : 0;
  1097. }
  1098. /* fb_mmap
  1099. * Map video memory in user space. We don't use the generic fb_mmap
  1100. * method mainly to allow the use of the TLB streaming flag (CCA=6)
  1101. */
  1102. static int au1200fb_fb_mmap(struct fb_info *info, struct vm_area_struct *vma)
  1103. {
  1104. unsigned int len;
  1105. unsigned long start=0, off;
  1106. struct au1200fb_device *fbdev = (struct au1200fb_device *) info;
  1107. #ifdef CONFIG_PM
  1108. au1xxx_pm_access(LCD_pm_dev);
  1109. #endif
  1110. if (vma->vm_pgoff > (~0UL >> PAGE_SHIFT)) {
  1111. return -EINVAL;
  1112. }
  1113. start = fbdev->fb_phys & PAGE_MASK;
  1114. len = PAGE_ALIGN((start & ~PAGE_MASK) + fbdev->fb_len);
  1115. off = vma->vm_pgoff << PAGE_SHIFT;
  1116. if ((vma->vm_end - vma->vm_start + off) > len) {
  1117. return -EINVAL;
  1118. }
  1119. off += start;
  1120. vma->vm_pgoff = off >> PAGE_SHIFT;
  1121. vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot);
  1122. pgprot_val(vma->vm_page_prot) |= _CACHE_MASK; /* CCA=7 */
  1123. vma->vm_flags |= VM_IO;
  1124. return io_remap_pfn_range(vma, vma->vm_start, off >> PAGE_SHIFT,
  1125. vma->vm_end - vma->vm_start,
  1126. vma->vm_page_prot);
  1127. return 0;
  1128. }
  1129. static void set_global(u_int cmd, struct au1200_lcd_global_regs_t *pdata)
  1130. {
  1131. unsigned int hi1, divider;
  1132. /* SCREEN_SIZE: user cannot reset size, must switch panel choice */
  1133. if (pdata->flags & SCREEN_BACKCOLOR)
  1134. lcd->backcolor = pdata->backcolor;
  1135. if (pdata->flags & SCREEN_BRIGHTNESS) {
  1136. // limit brightness pwm duty to >= 30/1600
  1137. if (pdata->brightness < 30) {
  1138. pdata->brightness = 30;
  1139. }
  1140. divider = (lcd->pwmdiv & 0x3FFFF) + 1;
  1141. hi1 = (lcd->pwmhi >> 16) + 1;
  1142. hi1 = (((pdata->brightness & 0xFF)+1) * divider >> 8);
  1143. lcd->pwmhi &= 0xFFFF;
  1144. lcd->pwmhi |= (hi1 << 16);
  1145. }
  1146. if (pdata->flags & SCREEN_COLORKEY)
  1147. lcd->colorkey = pdata->colorkey;
  1148. if (pdata->flags & SCREEN_MASK)
  1149. lcd->colorkeymsk = pdata->mask;
  1150. au_sync();
  1151. }
  1152. static void get_global(u_int cmd, struct au1200_lcd_global_regs_t *pdata)
  1153. {
  1154. unsigned int hi1, divider;
  1155. pdata->xsize = ((lcd->screen & LCD_SCREEN_SX) >> 19) + 1;
  1156. pdata->ysize = ((lcd->screen & LCD_SCREEN_SY) >> 8) + 1;
  1157. pdata->backcolor = lcd->backcolor;
  1158. pdata->colorkey = lcd->colorkey;
  1159. pdata->mask = lcd->colorkeymsk;
  1160. // brightness
  1161. hi1 = (lcd->pwmhi >> 16) + 1;
  1162. divider = (lcd->pwmdiv & 0x3FFFF) + 1;
  1163. pdata->brightness = ((hi1 << 8) / divider) - 1;
  1164. au_sync();
  1165. }
  1166. static void set_window(unsigned int plane,
  1167. struct au1200_lcd_window_regs_t *pdata)
  1168. {
  1169. unsigned int val, bpp;
  1170. /* Window control register 0 */
  1171. if (pdata->flags & WIN_POSITION) {
  1172. val = lcd->window[plane].winctrl0 & ~(LCD_WINCTRL0_OX |
  1173. LCD_WINCTRL0_OY);
  1174. val |= ((pdata->xpos << 21) & LCD_WINCTRL0_OX);
  1175. val |= ((pdata->ypos << 10) & LCD_WINCTRL0_OY);
  1176. lcd->window[plane].winctrl0 = val;
  1177. }
  1178. if (pdata->flags & WIN_ALPHA_COLOR) {
  1179. val = lcd->window[plane].winctrl0 & ~(LCD_WINCTRL0_A);
  1180. val |= ((pdata->alpha_color << 2) & LCD_WINCTRL0_A);
  1181. lcd->window[plane].winctrl0 = val;
  1182. }
  1183. if (pdata->flags & WIN_ALPHA_MODE) {
  1184. val = lcd->window[plane].winctrl0 & ~(LCD_WINCTRL0_AEN);
  1185. val |= ((pdata->alpha_mode << 1) & LCD_WINCTRL0_AEN);
  1186. lcd->window[plane].winctrl0 = val;
  1187. }
  1188. /* Window control register 1 */
  1189. if (pdata->flags & WIN_PRIORITY) {
  1190. val = lcd->window[plane].winctrl1 & ~(LCD_WINCTRL1_PRI);
  1191. val |= ((pdata->priority << 30) & LCD_WINCTRL1_PRI);
  1192. lcd->window[plane].winctrl1 = val;
  1193. }
  1194. if (pdata->flags & WIN_CHANNEL) {
  1195. val = lcd->window[plane].winctrl1 & ~(LCD_WINCTRL1_PIPE);
  1196. val |= ((pdata->channel << 29) & LCD_WINCTRL1_PIPE);
  1197. lcd->window[plane].winctrl1 = val;
  1198. }
  1199. if (pdata->flags & WIN_BUFFER_FORMAT) {
  1200. val = lcd->window[plane].winctrl1 & ~(LCD_WINCTRL1_FRM);
  1201. val |= ((pdata->buffer_format << 25) & LCD_WINCTRL1_FRM);
  1202. lcd->window[plane].winctrl1 = val;
  1203. }
  1204. if (pdata->flags & WIN_COLOR_ORDER) {
  1205. val = lcd->window[plane].winctrl1 & ~(LCD_WINCTRL1_CCO);
  1206. val |= ((pdata->color_order << 24) & LCD_WINCTRL1_CCO);
  1207. lcd->window[plane].winctrl1 = val;
  1208. }
  1209. if (pdata->flags & WIN_PIXEL_ORDER) {
  1210. val = lcd->window[plane].winctrl1 & ~(LCD_WINCTRL1_PO);
  1211. val |= ((pdata->pixel_order << 22) & LCD_WINCTRL1_PO);
  1212. lcd->window[plane].winctrl1 = val;
  1213. }
  1214. if (pdata->flags & WIN_SIZE) {
  1215. val = lcd->window[plane].winctrl1 & ~(LCD_WINCTRL1_SZX |
  1216. LCD_WINCTRL1_SZY);
  1217. val |= (((pdata->xsize << 11) - 1) & LCD_WINCTRL1_SZX);
  1218. val |= (((pdata->ysize) - 1) & LCD_WINCTRL1_SZY);
  1219. lcd->window[plane].winctrl1 = val;
  1220. /* program buffer line width */
  1221. bpp = winbpp(val) / 8;
  1222. val = lcd->window[plane].winctrl2 & ~(LCD_WINCTRL2_BX);
  1223. val |= (((pdata->xsize * bpp) << 8) & LCD_WINCTRL2_BX);
  1224. lcd->window[plane].winctrl2 = val;
  1225. }
  1226. /* Window control register 2 */
  1227. if (pdata->flags & WIN_COLORKEY_MODE) {
  1228. val = lcd->window[plane].winctrl2 & ~(LCD_WINCTRL2_CKMODE);
  1229. val |= ((pdata->colorkey_mode << 24) & LCD_WINCTRL2_CKMODE);
  1230. lcd->window[plane].winctrl2 = val;
  1231. }
  1232. if (pdata->flags & WIN_DOUBLE_BUFFER_MODE) {
  1233. val = lcd->window[plane].winctrl2 & ~(LCD_WINCTRL2_DBM);
  1234. val |= ((pdata->double_buffer_mode << 23) & LCD_WINCTRL2_DBM);
  1235. lcd->window[plane].winctrl2 = val;
  1236. }
  1237. if (pdata->flags & WIN_RAM_ARRAY_MODE) {
  1238. val = lcd->window[plane].winctrl2 & ~(LCD_WINCTRL2_RAM);
  1239. val |= ((pdata->ram_array_mode << 21) & LCD_WINCTRL2_RAM);
  1240. lcd->window[plane].winctrl2 = val;
  1241. }
  1242. /* Buffer line width programmed with WIN_SIZE */
  1243. if (pdata->flags & WIN_BUFFER_SCALE) {
  1244. val = lcd->window[plane].winctrl2 & ~(LCD_WINCTRL2_SCX |
  1245. LCD_WINCTRL2_SCY);
  1246. val |= ((pdata->xsize << 11) & LCD_WINCTRL2_SCX);
  1247. val |= ((pdata->ysize) & LCD_WINCTRL2_SCY);
  1248. lcd->window[plane].winctrl2 = val;
  1249. }
  1250. if (pdata->flags & WIN_ENABLE) {
  1251. val = lcd->winenable;
  1252. val &= ~(1<<plane);
  1253. val |= (pdata->enable & 1) << plane;
  1254. lcd->winenable = val;
  1255. }
  1256. au_sync();
  1257. }
  1258. static void get_window(unsigned int plane,
  1259. struct au1200_lcd_window_regs_t *pdata)
  1260. {
  1261. /* Window control register 0 */
  1262. pdata->xpos = (lcd->window[plane].winctrl0 & LCD_WINCTRL0_OX) >> 21;
  1263. pdata->ypos = (lcd->window[plane].winctrl0 & LCD_WINCTRL0_OY) >> 10;
  1264. pdata->alpha_color = (lcd->window[plane].winctrl0 & LCD_WINCTRL0_A) >> 2;
  1265. pdata->alpha_mode = (lcd->window[plane].winctrl0 & LCD_WINCTRL0_AEN) >> 1;
  1266. /* Window control register 1 */
  1267. pdata->priority = (lcd->window[plane].winctrl1& LCD_WINCTRL1_PRI) >> 30;
  1268. pdata->channel = (lcd->window[plane].winctrl1 & LCD_WINCTRL1_PIPE) >> 29;
  1269. pdata->buffer_format = (lcd->window[plane].winctrl1 & LCD_WINCTRL1_FRM) >> 25;
  1270. pdata->color_order = (lcd->window[plane].winctrl1 & LCD_WINCTRL1_CCO) >> 24;
  1271. pdata->pixel_order = (lcd->window[plane].winctrl1 & LCD_WINCTRL1_PO) >> 22;
  1272. pdata->xsize = ((lcd->window[plane].winctrl1 & LCD_WINCTRL1_SZX) >> 11) + 1;
  1273. pdata->ysize = (lcd->window[plane].winctrl1 & LCD_WINCTRL1_SZY) + 1;
  1274. /* Window control register 2 */
  1275. pdata->colorkey_mode = (lcd->window[plane].winctrl2 & LCD_WINCTRL2_CKMODE) >> 24;
  1276. pdata->double_buffer_mode = (lcd->window[plane].winctrl2 & LCD_WINCTRL2_DBM) >> 23;
  1277. pdata->ram_array_mode = (lcd->window[plane].winctrl2 & LCD_WINCTRL2_RAM) >> 21;
  1278. pdata->enable = (lcd->winenable >> plane) & 1;
  1279. au_sync();
  1280. }
  1281. static int au1200fb_ioctl(struct fb_info *info, unsigned int cmd,
  1282. unsigned long arg)
  1283. {
  1284. int plane;
  1285. int val;
  1286. #ifdef CONFIG_PM
  1287. au1xxx_pm_access(LCD_pm_dev);
  1288. #endif
  1289. plane = fbinfo2index(info);
  1290. print_dbg("au1200fb: ioctl %d on plane %d\n", cmd, plane);
  1291. if (cmd == AU1200_LCD_FB_IOCTL) {
  1292. struct au1200_lcd_iodata_t iodata;
  1293. if (copy_from_user(&iodata, (void __user *) arg, sizeof(iodata)))
  1294. return -EFAULT;
  1295. print_dbg("FB IOCTL called\n");
  1296. switch (iodata.subcmd) {
  1297. case AU1200_LCD_SET_SCREEN:
  1298. print_dbg("AU1200_LCD_SET_SCREEN\n");
  1299. set_global(cmd, &iodata.global);
  1300. break;
  1301. case AU1200_LCD_GET_SCREEN:
  1302. print_dbg("AU1200_LCD_GET_SCREEN\n");
  1303. get_global(cmd, &iodata.global);
  1304. break;
  1305. case AU1200_LCD_SET_WINDOW:
  1306. print_dbg("AU1200_LCD_SET_WINDOW\n");
  1307. set_window(plane, &iodata.window);
  1308. break;
  1309. case AU1200_LCD_GET_WINDOW:
  1310. print_dbg("AU1200_LCD_GET_WINDOW\n");
  1311. get_window(plane, &iodata.window);
  1312. break;
  1313. case AU1200_LCD_SET_PANEL:
  1314. print_dbg("AU1200_LCD_SET_PANEL\n");
  1315. if ((iodata.global.panel_choice >= 0) &&
  1316. (iodata.global.panel_choice <
  1317. NUM_PANELS))
  1318. {
  1319. struct panel_settings *newpanel;
  1320. panel_index = iodata.global.panel_choice;
  1321. newpanel = &known_lcd_panels[panel_index];
  1322. au1200_setpanel(newpanel);
  1323. }
  1324. break;
  1325. case AU1200_LCD_GET_PANEL:
  1326. print_dbg("AU1200_LCD_GET_PANEL\n");
  1327. iodata.global.panel_choice = panel_index;
  1328. break;
  1329. default:
  1330. return -EINVAL;
  1331. }
  1332. val = copy_to_user((void __user *) arg, &iodata, sizeof(iodata));
  1333. if (val) {
  1334. print_dbg("error: could not copy %d bytes\n", val);
  1335. return -EFAULT;
  1336. }
  1337. }
  1338. return 0;
  1339. }
  1340. static struct fb_ops au1200fb_fb_ops = {
  1341. .owner = THIS_MODULE,
  1342. .fb_check_var = au1200fb_fb_check_var,
  1343. .fb_set_par = au1200fb_fb_set_par,
  1344. .fb_setcolreg = au1200fb_fb_setcolreg,
  1345. .fb_blank = au1200fb_fb_blank,
  1346. .fb_fillrect = cfb_fillrect,
  1347. .fb_copyarea = cfb_copyarea,
  1348. .fb_imageblit = cfb_imageblit,
  1349. .fb_sync = NULL,
  1350. .fb_ioctl = au1200fb_ioctl,
  1351. .fb_mmap = au1200fb_fb_mmap,
  1352. };
  1353. /*-------------------------------------------------------------------------*/
  1354. static irqreturn_t au1200fb_handle_irq(int irq, void* dev_id)
  1355. {
  1356. /* Nothing to do for now, just clear any pending interrupt */
  1357. lcd->intstatus = lcd->intstatus;
  1358. au_sync();
  1359. return IRQ_HANDLED;
  1360. }
  1361. /*-------------------------------------------------------------------------*/
  1362. /* AU1200 LCD device probe helpers */
  1363. static int au1200fb_init_fbinfo(struct au1200fb_device *fbdev)
  1364. {
  1365. struct fb_info *fbi = &fbdev->fb_info;
  1366. int bpp;
  1367. memset(fbi, 0, sizeof(struct fb_info));
  1368. fbi->fbops = &au1200fb_fb_ops;
  1369. bpp = winbpp(win->w[fbdev->plane].mode_winctrl1);
  1370. /* Copy monitor specs from panel data */
  1371. /* fixme: we're setting up LCD controller windows, so these dont give a
  1372. damn as to what the monitor specs are (the panel itself does, but that
  1373. isnt done here...so maybe need a generic catchall monitor setting??? */
  1374. memcpy(&fbi->monspecs, &panel->monspecs, sizeof(struct fb_monspecs));
  1375. /* We first try the user mode passed in argument. If that failed,
  1376. * or if no one has been specified, we default to the first mode of the
  1377. * panel list. Note that after this call, var data will be set */
  1378. if (!fb_find_mode(&fbi->var,
  1379. fbi,
  1380. NULL, /* drv_info.opt_mode, */
  1381. fbi->monspecs.modedb,
  1382. fbi->monspecs.modedb_len,
  1383. fbi->monspecs.modedb,
  1384. bpp)) {
  1385. print_err("Cannot find valid mode for panel %s", panel->name);
  1386. return -EFAULT;
  1387. }
  1388. fbi->pseudo_palette = kmalloc(sizeof(u32) * 16, GFP_KERNEL);
  1389. if (!fbi->pseudo_palette) {
  1390. return -ENOMEM;
  1391. }
  1392. memset(fbi->pseudo_palette, 0, sizeof(u32) * 16);
  1393. if (fb_alloc_cmap(&fbi->cmap, AU1200_LCD_NBR_PALETTE_ENTRIES, 0) < 0) {
  1394. print_err("Fail to allocate colormap (%d entries)",
  1395. AU1200_LCD_NBR_PALETTE_ENTRIES);
  1396. kfree(fbi->pseudo_palette);
  1397. return -EFAULT;
  1398. }
  1399. strncpy(fbi->fix.id, "AU1200", sizeof(fbi->fix.id));
  1400. fbi->fix.smem_start = fbdev->fb_phys;
  1401. fbi->fix.smem_len = fbdev->fb_len;
  1402. fbi->fix.type = FB_TYPE_PACKED_PIXELS;
  1403. fbi->fix.xpanstep = 0;
  1404. fbi->fix.ypanstep = 0;
  1405. fbi->fix.mmio_start = 0;
  1406. fbi->fix.mmio_len = 0;
  1407. fbi->fix.accel = FB_ACCEL_NONE;
  1408. fbi->screen_base = (char __iomem *) fbdev->fb_mem;
  1409. au1200fb_update_fbinfo(fbi);
  1410. return 0;
  1411. }
  1412. /*-------------------------------------------------------------------------*/
  1413. /* AU1200 LCD controller device driver */
  1414. static int au1200fb_drv_probe(struct device *dev)
  1415. {
  1416. struct au1200fb_device *fbdev;
  1417. unsigned long page;
  1418. int bpp, plane, ret;
  1419. if (!dev)
  1420. return -EINVAL;
  1421. for (plane = 0; plane < CONFIG_FB_AU1200_DEVS; ++plane) {
  1422. bpp = winbpp(win->w[plane].mode_winctrl1);
  1423. if (win->w[plane].xres == 0)
  1424. win->w[plane].xres = panel->Xres;
  1425. if (win->w[plane].yres == 0)
  1426. win->w[plane].yres = panel->Yres;
  1427. fbdev = &_au1200fb_devices[plane];
  1428. memset(fbdev, 0, sizeof(struct au1200fb_device));
  1429. fbdev->plane = plane;
  1430. /* Allocate the framebuffer to the maximum screen size */
  1431. fbdev->fb_len = (win->w[plane].xres * win->w[plane].yres * bpp) / 8;
  1432. fbdev->fb_mem = dma_alloc_noncoherent(dev,
  1433. PAGE_ALIGN(fbdev->fb_len),
  1434. &fbdev->fb_phys, GFP_KERNEL);
  1435. if (!fbdev->fb_mem) {
  1436. print_err("fail to allocate frambuffer (size: %dK))",
  1437. fbdev->fb_len / 1024);
  1438. return -ENOMEM;
  1439. }
  1440. /*
  1441. * Set page reserved so that mmap will work. This is necessary
  1442. * since we'll be remapping normal memory.
  1443. */
  1444. for (page = (unsigned long)fbdev->fb_phys;
  1445. page < PAGE_ALIGN((unsigned long)fbdev->fb_phys +
  1446. fbdev->fb_len);
  1447. page += PAGE_SIZE) {
  1448. SetPageReserved(pfn_to_page(page >> PAGE_SHIFT)); /* LCD DMA is NOT coherent on Au1200 */
  1449. }
  1450. print_dbg("Framebuffer memory map at %p", fbdev->fb_mem);
  1451. print_dbg("phys=0x%08x, size=%dK", fbdev->fb_phys, fbdev->fb_len / 1024);
  1452. /* Init FB data */
  1453. if ((ret = au1200fb_init_fbinfo(fbdev)) < 0)
  1454. goto failed;
  1455. /* Register new framebuffer */
  1456. if ((ret = register_framebuffer(&fbdev->fb_info)) < 0) {
  1457. print_err("cannot register new framebuffer");
  1458. goto failed;
  1459. }
  1460. au1200fb_fb_set_par(&fbdev->fb_info);
  1461. #if !defined(CONFIG_FRAMEBUFFER_CONSOLE) && defined(CONFIG_LOGO)
  1462. if (plane == 0)
  1463. if (fb_prepare_logo(&fbdev->fb_info, FB_ROTATE_UR)) {
  1464. /* Start display and show logo on boot */
  1465. fb_set_cmap(&fbdev->fb_info.cmap,
  1466. &fbdev->fb_info);
  1467. fb_show_logo(&fbdev->fb_info, FB_ROTATE_UR);
  1468. }
  1469. #endif
  1470. }
  1471. /* Now hook interrupt too */
  1472. if ((ret = request_irq(AU1200_LCD_INT, au1200fb_handle_irq,
  1473. IRQF_DISABLED | IRQF_SHARED, "lcd", (void *)dev)) < 0) {
  1474. print_err("fail to request interrupt line %d (err: %d)",
  1475. AU1200_LCD_INT, ret);
  1476. goto failed;
  1477. }
  1478. return 0;
  1479. failed:
  1480. /* NOTE: This only does the current plane/window that failed; others are still active */
  1481. if (fbdev->fb_mem)
  1482. dma_free_noncoherent(dev, PAGE_ALIGN(fbdev->fb_len),
  1483. fbdev->fb_mem, fbdev->fb_phys);
  1484. if (fbdev->fb_info.cmap.len != 0)
  1485. fb_dealloc_cmap(&fbdev->fb_info.cmap);
  1486. if (fbdev->fb_info.pseudo_palette)
  1487. kfree(fbdev->fb_info.pseudo_palette);
  1488. if (plane == 0)
  1489. free_irq(AU1200_LCD_INT, (void*)dev);
  1490. return ret;
  1491. }
  1492. static int au1200fb_drv_remove(struct device *dev)
  1493. {
  1494. struct au1200fb_device *fbdev;
  1495. int plane;
  1496. if (!dev)
  1497. return -ENODEV;
  1498. /* Turn off the panel */
  1499. au1200_setpanel(NULL);
  1500. for (plane = 0; plane < CONFIG_FB_AU1200_DEVS; ++plane)
  1501. {
  1502. fbdev = &_au1200fb_devices[plane];
  1503. /* Clean up all probe data */
  1504. unregister_framebuffer(&fbdev->fb_info);
  1505. if (fbdev->fb_mem)
  1506. dma_free_noncoherent(dev, PAGE_ALIGN(fbdev->fb_len),
  1507. fbdev->fb_mem, fbdev->fb_phys);
  1508. if (fbdev->fb_info.cmap.len != 0)
  1509. fb_dealloc_cmap(&fbdev->fb_info.cmap);
  1510. if (fbdev->fb_info.pseudo_palette)
  1511. kfree(fbdev->fb_info.pseudo_palette);
  1512. }
  1513. free_irq(AU1200_LCD_INT, (void *)dev);
  1514. return 0;
  1515. }
  1516. #ifdef CONFIG_PM
  1517. static int au1200fb_drv_suspend(struct device *dev, u32 state, u32 level)
  1518. {
  1519. /* TODO */
  1520. return 0;
  1521. }
  1522. static int au1200fb_drv_resume(struct device *dev, u32 level)
  1523. {
  1524. /* TODO */
  1525. return 0;
  1526. }
  1527. #endif /* CONFIG_PM */
  1528. static struct device_driver au1200fb_driver = {
  1529. .name = "au1200-lcd",
  1530. .bus = &platform_bus_type,
  1531. .probe = au1200fb_drv_probe,
  1532. .remove = au1200fb_drv_remove,
  1533. #ifdef CONFIG_PM
  1534. .suspend = au1200fb_drv_suspend,
  1535. .resume = au1200fb_drv_resume,
  1536. #endif
  1537. };
  1538. /*-------------------------------------------------------------------------*/
  1539. /* Kernel driver */
  1540. static void au1200fb_setup(void)
  1541. {
  1542. char* options = NULL;
  1543. char* this_opt;
  1544. int num_panels = ARRAY_SIZE(known_lcd_panels);
  1545. int panel_idx = -1;
  1546. fb_get_options(DRIVER_NAME, &options);
  1547. if (options) {
  1548. while ((this_opt = strsep(&options,",")) != NULL) {
  1549. /* Panel option - can be panel name,
  1550. * "bs" for board-switch, or number/index */
  1551. if (!strncmp(this_opt, "panel:", 6)) {
  1552. int i;
  1553. long int li;
  1554. char *endptr;
  1555. this_opt += 6;
  1556. /* First check for index, which allows
  1557. * to short circuit this mess */
  1558. li = simple_strtol(this_opt, &endptr, 0);
  1559. if (*endptr == '\0') {
  1560. panel_idx = (int)li;
  1561. }
  1562. else if (strcmp(this_opt, "bs") == 0) {
  1563. extern int board_au1200fb_panel(void);
  1564. panel_idx = board_au1200fb_panel();
  1565. }
  1566. else
  1567. for (i = 0; i < num_panels; i++) {
  1568. if (!strcmp(this_opt, known_lcd_panels[i].name)) {
  1569. panel_idx = i;
  1570. break;
  1571. }
  1572. }
  1573. if ((panel_idx < 0) || (panel_idx >= num_panels)) {
  1574. print_warn("Panel %s not supported!", this_opt);
  1575. }
  1576. else
  1577. panel_index = panel_idx;
  1578. }
  1579. else if (strncmp(this_opt, "nohwcursor", 10) == 0) {
  1580. nohwcursor = 1;
  1581. }
  1582. /* Unsupported option */
  1583. else {
  1584. print_warn("Unsupported option \"%s\"", this_opt);
  1585. }
  1586. }
  1587. }
  1588. }
  1589. #ifdef CONFIG_PM
  1590. static int au1200fb_pm_callback(au1xxx_power_dev_t *dev,
  1591. au1xxx_request_t request, void *data) {
  1592. int retval = -1;
  1593. unsigned int d = 0;
  1594. unsigned int brightness = 0;
  1595. if (request == AU1XXX_PM_SLEEP) {
  1596. board_au1200fb_panel_shutdown();
  1597. }
  1598. else if (request == AU1XXX_PM_WAKEUP) {
  1599. if(dev->prev_state == SLEEP_STATE)
  1600. {
  1601. int plane;
  1602. au1200_setpanel(panel);
  1603. for (plane = 0; plane < CONFIG_FB_AU1200_DEVS; ++plane) {
  1604. struct au1200fb_device *fbdev;
  1605. fbdev = &_au1200fb_devices[plane];
  1606. au1200fb_fb_set_par(&fbdev->fb_info);
  1607. }
  1608. }
  1609. d = *((unsigned int*)data);
  1610. if(d <=10) brightness = 26;
  1611. else if(d<=20) brightness = 51;
  1612. else if(d<=30) brightness = 77;
  1613. else if(d<=40) brightness = 102;
  1614. else if(d<=50) brightness = 128;
  1615. else if(d<=60) brightness = 153;
  1616. else if(d<=70) brightness = 179;
  1617. else if(d<=80) brightness = 204;
  1618. else if(d<=90) brightness = 230;
  1619. else brightness = 255;
  1620. set_brightness(brightness);
  1621. } else if (request == AU1XXX_PM_GETSTATUS) {
  1622. return dev->cur_state;
  1623. } else if (request == AU1XXX_PM_ACCESS) {
  1624. if (dev->cur_state != SLEEP_STATE)
  1625. return retval;
  1626. else {
  1627. au1200_setpanel(panel);
  1628. }
  1629. } else if (request == AU1XXX_PM_IDLE) {
  1630. } else if (request == AU1XXX_PM_CLEANUP) {
  1631. }
  1632. return retval;
  1633. }
  1634. #endif
  1635. static int __init au1200fb_init(void)
  1636. {
  1637. print_info("" DRIVER_DESC "");
  1638. /* Setup driver with options */
  1639. au1200fb_setup();
  1640. /* Point to the panel selected */
  1641. panel = &known_lcd_panels[panel_index];
  1642. win = &windows[window_index];
  1643. printk(DRIVER_NAME ": Panel %d %s\n", panel_index, panel->name);
  1644. printk(DRIVER_NAME ": Win %d %s\n", window_index, win->name);
  1645. /* Kickstart the panel, the framebuffers/windows come soon enough */
  1646. au1200_setpanel(panel);
  1647. #ifdef CONFIG_PM
  1648. LCD_pm_dev = new_au1xxx_power_device("LCD", &au1200fb_pm_callback, NULL);
  1649. if ( LCD_pm_dev == NULL)
  1650. printk(KERN_INFO "Unable to create a power management device entry for the au1200fb.\n");
  1651. else
  1652. printk(KERN_INFO "Power management device entry for the au1200fb loaded.\n");
  1653. #endif
  1654. return driver_register(&au1200fb_driver);
  1655. }
  1656. static void __exit au1200fb_cleanup(void)
  1657. {
  1658. driver_unregister(&au1200fb_driver);
  1659. }
  1660. module_init(au1200fb_init);
  1661. module_exit(au1200fb_cleanup);
  1662. MODULE_DESCRIPTION(DRIVER_DESC);
  1663. MODULE_LICENSE("GPL");