hitfb.c 11 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480
  1. /*
  2. * linux/drivers/video/hitfb.c -- Hitachi LCD frame buffer device
  3. *
  4. * (C) 1999 Mihai Spatar
  5. * (C) 2000 YAEGASHI Takeshi
  6. * (C) 2003, 2004 Paul Mundt
  7. * (C) 2003, 2004, 2006 Andriy Skulysh
  8. *
  9. * This file is subject to the terms and conditions of the GNU General Public
  10. * License. See the file COPYING in the main directory of this archive for
  11. * more details.
  12. */
  13. #include <linux/module.h>
  14. #include <linux/kernel.h>
  15. #include <linux/errno.h>
  16. #include <linux/string.h>
  17. #include <linux/mm.h>
  18. #include <linux/slab.h>
  19. #include <linux/delay.h>
  20. #include <linux/init.h>
  21. #include <linux/platform_device.h>
  22. #include <linux/fb.h>
  23. #include <asm/machvec.h>
  24. #include <asm/uaccess.h>
  25. #include <asm/pgtable.h>
  26. #include <asm/io.h>
  27. #include <asm/hd64461.h>
  28. #include <asm/cpu/dac.h>
  29. #define WIDTH 640
  30. static struct fb_var_screeninfo hitfb_var __initdata = {
  31. .activate = FB_ACTIVATE_NOW,
  32. .height = -1,
  33. .width = -1,
  34. .vmode = FB_VMODE_NONINTERLACED,
  35. };
  36. static struct fb_fix_screeninfo hitfb_fix __initdata = {
  37. .id = "Hitachi HD64461",
  38. .type = FB_TYPE_PACKED_PIXELS,
  39. .accel = FB_ACCEL_NONE,
  40. };
  41. static u32 pseudo_palette[16];
  42. static struct fb_info fb_info;
  43. static inline void hitfb_accel_wait(void)
  44. {
  45. while (fb_readw(HD64461_GRCFGR) & HD64461_GRCFGR_ACCSTATUS) ;
  46. }
  47. static inline void hitfb_accel_start(int truecolor)
  48. {
  49. if (truecolor) {
  50. fb_writew(6, HD64461_GRCFGR);
  51. } else {
  52. fb_writew(7, HD64461_GRCFGR);
  53. }
  54. }
  55. static inline void hitfb_accel_set_dest(int truecolor, u16 dx, u16 dy,
  56. u16 width, u16 height)
  57. {
  58. u32 saddr = WIDTH * dy + dx;
  59. if (truecolor)
  60. saddr <<= 1;
  61. fb_writew(width-1, HD64461_BBTDWR);
  62. fb_writew(height-1, HD64461_BBTDHR);
  63. fb_writew(saddr & 0xffff, HD64461_BBTDSARL);
  64. fb_writew(saddr >> 16, HD64461_BBTDSARH);
  65. }
  66. static inline void hitfb_accel_bitblt(int truecolor, u16 sx, u16 sy, u16 dx,
  67. u16 dy, u16 width, u16 height, u16 rop,
  68. u32 mask_addr)
  69. {
  70. u32 saddr, daddr;
  71. u32 maddr = 0;
  72. height--;
  73. width--;
  74. fb_writew(rop, HD64461_BBTROPR);
  75. if ((sy < dy) || ((sy == dy) && (sx <= dx))) {
  76. saddr = WIDTH * (sy + height) + sx + width;
  77. daddr = WIDTH * (dy + height) + dx + width;
  78. if (mask_addr) {
  79. if (truecolor)
  80. maddr = ((width >> 3) + 1) * (height + 1) - 1;
  81. else
  82. maddr =
  83. (((width >> 4) + 1) * (height + 1) - 1) * 2;
  84. fb_writew((1 << 5) | 1, HD64461_BBTMDR);
  85. } else
  86. fb_writew(1, HD64461_BBTMDR);
  87. } else {
  88. saddr = WIDTH * sy + sx;
  89. daddr = WIDTH * dy + dx;
  90. if (mask_addr) {
  91. fb_writew((1 << 5), HD64461_BBTMDR);
  92. } else {
  93. fb_writew(0, HD64461_BBTMDR);
  94. }
  95. }
  96. if (truecolor) {
  97. saddr <<= 1;
  98. daddr <<= 1;
  99. }
  100. fb_writew(width, HD64461_BBTDWR);
  101. fb_writew(height, HD64461_BBTDHR);
  102. fb_writew(saddr & 0xffff, HD64461_BBTSSARL);
  103. fb_writew(saddr >> 16, HD64461_BBTSSARH);
  104. fb_writew(daddr & 0xffff, HD64461_BBTDSARL);
  105. fb_writew(daddr >> 16, HD64461_BBTDSARH);
  106. if (mask_addr) {
  107. maddr += mask_addr;
  108. fb_writew(maddr & 0xffff, HD64461_BBTMARL);
  109. fb_writew(maddr >> 16, HD64461_BBTMARH);
  110. }
  111. hitfb_accel_start(truecolor);
  112. }
  113. static void hitfb_fillrect(struct fb_info *p, const struct fb_fillrect *rect)
  114. {
  115. if (rect->rop != ROP_COPY)
  116. cfb_fillrect(p, rect);
  117. else {
  118. hitfb_accel_wait();
  119. fb_writew(0x00f0, HD64461_BBTROPR);
  120. fb_writew(16, HD64461_BBTMDR);
  121. if (p->var.bits_per_pixel == 16) {
  122. fb_writew(((u32 *) (p->pseudo_palette))[rect->color],
  123. HD64461_GRSCR);
  124. hitfb_accel_set_dest(1, rect->dx, rect->dy, rect->width,
  125. rect->height);
  126. hitfb_accel_start(1);
  127. } else {
  128. fb_writew(rect->color, HD64461_GRSCR);
  129. hitfb_accel_set_dest(0, rect->dx, rect->dy, rect->width,
  130. rect->height);
  131. hitfb_accel_start(0);
  132. }
  133. }
  134. }
  135. static void hitfb_copyarea(struct fb_info *p, const struct fb_copyarea *area)
  136. {
  137. hitfb_accel_wait();
  138. hitfb_accel_bitblt(p->var.bits_per_pixel == 16, area->sx, area->sy,
  139. area->dx, area->dy, area->width, area->height,
  140. 0x00cc, 0);
  141. }
  142. static int hitfb_pan_display(struct fb_var_screeninfo *var,
  143. struct fb_info *info)
  144. {
  145. int xoffset = var->xoffset;
  146. int yoffset = var->yoffset;
  147. if (xoffset != 0)
  148. return -EINVAL;
  149. fb_writew((yoffset*info->fix.line_length)>>10, HD64461_LCDCBAR);
  150. return 0;
  151. }
  152. int hitfb_blank(int blank_mode, struct fb_info *info)
  153. {
  154. unsigned short v;
  155. if (blank_mode) {
  156. v = fb_readw(HD64461_LDR1);
  157. v &= ~HD64461_LDR1_DON;
  158. fb_writew(v, HD64461_LDR1);
  159. v = fb_readw(HD64461_LCDCCR);
  160. v |= HD64461_LCDCCR_MOFF;
  161. fb_writew(v, HD64461_LCDCCR);
  162. v = fb_readw(HD64461_STBCR);
  163. v |= HD64461_STBCR_SLCDST;
  164. fb_writew(v, HD64461_STBCR);
  165. } else {
  166. v = fb_readw(HD64461_STBCR);
  167. v &= ~HD64461_STBCR_SLCDST;
  168. fb_writew(v, HD64461_STBCR);
  169. v = fb_readw(HD64461_LCDCCR);
  170. v &= ~(HD64461_LCDCCR_MOFF | HD64461_LCDCCR_STREQ);
  171. fb_writew(v, HD64461_LCDCCR);
  172. do {
  173. v = fb_readw(HD64461_LCDCCR);
  174. } while(v&HD64461_LCDCCR_STBACK);
  175. v = fb_readw(HD64461_LDR1);
  176. v |= HD64461_LDR1_DON;
  177. fb_writew(v, HD64461_LDR1);
  178. }
  179. return 0;
  180. }
  181. static int hitfb_setcolreg(unsigned regno, unsigned red, unsigned green,
  182. unsigned blue, unsigned transp, struct fb_info *info)
  183. {
  184. if (regno >= 256)
  185. return 1;
  186. switch (info->var.bits_per_pixel) {
  187. case 8:
  188. fb_writew(regno << 8, HD64461_CPTWAR);
  189. fb_writew(red >> 10, HD64461_CPTWDR);
  190. fb_writew(green >> 10, HD64461_CPTWDR);
  191. fb_writew(blue >> 10, HD64461_CPTWDR);
  192. break;
  193. case 16:
  194. if (regno >= 16)
  195. return 1;
  196. ((u32 *) (info->pseudo_palette))[regno] =
  197. ((red & 0xf800)) |
  198. ((green & 0xfc00) >> 5) | ((blue & 0xf800) >> 11);
  199. break;
  200. }
  201. return 0;
  202. }
  203. static int hitfb_sync(struct fb_info *info)
  204. {
  205. hitfb_accel_wait();
  206. return 0;
  207. }
  208. static int hitfb_check_var(struct fb_var_screeninfo *var, struct fb_info *info)
  209. {
  210. int maxy;
  211. var->xres = info->var.xres;
  212. var->xres_virtual = info->var.xres;
  213. var->yres = info->var.yres;
  214. if ((var->bits_per_pixel != 8) && (var->bits_per_pixel != 16))
  215. var->bits_per_pixel = info->var.bits_per_pixel;
  216. if (var->yres_virtual < var->yres)
  217. var->yres_virtual = var->yres;
  218. maxy = info->fix.smem_len / var->xres;
  219. if (var->bits_per_pixel == 16)
  220. maxy /= 2;
  221. if (var->yres_virtual > maxy)
  222. var->yres_virtual = maxy;
  223. var->xoffset = 0;
  224. var->yoffset = 0;
  225. switch (var->bits_per_pixel) {
  226. case 8:
  227. var->red.offset = 0;
  228. var->red.length = 8;
  229. var->green.offset = 0;
  230. var->green.length = 8;
  231. var->blue.offset = 0;
  232. var->blue.length = 8;
  233. var->transp.offset = 0;
  234. var->transp.length = 0;
  235. break;
  236. case 16: /* RGB 565 */
  237. var->red.offset = 11;
  238. var->red.length = 5;
  239. var->green.offset = 5;
  240. var->green.length = 6;
  241. var->blue.offset = 0;
  242. var->blue.length = 5;
  243. var->transp.offset = 0;
  244. var->transp.length = 0;
  245. break;
  246. }
  247. return 0;
  248. }
  249. static int hitfb_set_par(struct fb_info *info)
  250. {
  251. unsigned short ldr3;
  252. switch (info->var.bits_per_pixel) {
  253. case 8:
  254. info->fix.line_length = info->var.xres;
  255. info->fix.visual = FB_VISUAL_PSEUDOCOLOR;
  256. info->fix.ypanstep = 16;
  257. break;
  258. case 16:
  259. info->fix.line_length = info->var.xres*2;
  260. info->fix.visual = FB_VISUAL_TRUECOLOR;
  261. info->fix.ypanstep = 8;
  262. break;
  263. }
  264. fb_writew(info->fix.line_length, HD64461_LCDCLOR);
  265. ldr3 = fb_readw(HD64461_LDR3);
  266. ldr3 &= ~15;
  267. ldr3 |= (info->var.bits_per_pixel == 8) ? 4 : 8;
  268. fb_writew(ldr3, HD64461_LDR3);
  269. return 0;
  270. }
  271. static struct fb_ops hitfb_ops = {
  272. .owner = THIS_MODULE,
  273. .fb_check_var = hitfb_check_var,
  274. .fb_set_par = hitfb_set_par,
  275. .fb_setcolreg = hitfb_setcolreg,
  276. .fb_blank = hitfb_blank,
  277. .fb_sync = hitfb_sync,
  278. .fb_pan_display = hitfb_pan_display,
  279. .fb_fillrect = hitfb_fillrect,
  280. .fb_copyarea = hitfb_copyarea,
  281. .fb_imageblit = cfb_imageblit,
  282. };
  283. static int __init hitfb_probe(struct platform_device *dev)
  284. {
  285. unsigned short lcdclor, ldr3, ldvndr;
  286. if (fb_get_options("hitfb", NULL))
  287. return -ENODEV;
  288. hitfb_fix.mmio_start = CONFIG_HD64461_IOBASE+0x1000;
  289. hitfb_fix.mmio_len = 0x1000;
  290. hitfb_fix.smem_start = CONFIG_HD64461_IOBASE + 0x02000000;
  291. hitfb_fix.smem_len = 512 * 1024;
  292. lcdclor = fb_readw(HD64461_LCDCLOR);
  293. ldvndr = fb_readw(HD64461_LDVNDR);
  294. ldr3 = fb_readw(HD64461_LDR3);
  295. switch (ldr3 & 15) {
  296. default:
  297. case 4:
  298. hitfb_var.bits_per_pixel = 8;
  299. hitfb_var.xres = lcdclor;
  300. break;
  301. case 8:
  302. hitfb_var.bits_per_pixel = 16;
  303. hitfb_var.xres = lcdclor / 2;
  304. break;
  305. }
  306. hitfb_fix.line_length = lcdclor;
  307. hitfb_fix.visual = (hitfb_var.bits_per_pixel == 8) ?
  308. FB_VISUAL_PSEUDOCOLOR : FB_VISUAL_TRUECOLOR;
  309. hitfb_var.yres = ldvndr + 1;
  310. hitfb_var.xres_virtual = hitfb_var.xres;
  311. hitfb_var.yres_virtual = hitfb_fix.smem_len / lcdclor;
  312. switch (hitfb_var.bits_per_pixel) {
  313. case 8:
  314. hitfb_var.red.offset = 0;
  315. hitfb_var.red.length = 8;
  316. hitfb_var.green.offset = 0;
  317. hitfb_var.green.length = 8;
  318. hitfb_var.blue.offset = 0;
  319. hitfb_var.blue.length = 8;
  320. hitfb_var.transp.offset = 0;
  321. hitfb_var.transp.length = 0;
  322. break;
  323. case 16: /* RGB 565 */
  324. hitfb_var.red.offset = 11;
  325. hitfb_var.red.length = 5;
  326. hitfb_var.green.offset = 5;
  327. hitfb_var.green.length = 6;
  328. hitfb_var.blue.offset = 0;
  329. hitfb_var.blue.length = 5;
  330. hitfb_var.transp.offset = 0;
  331. hitfb_var.transp.length = 0;
  332. break;
  333. }
  334. fb_info.fbops = &hitfb_ops;
  335. fb_info.var = hitfb_var;
  336. fb_info.fix = hitfb_fix;
  337. fb_info.pseudo_palette = pseudo_palette;
  338. fb_info.flags = FBINFO_DEFAULT | FBINFO_HWACCEL_YPAN |
  339. FBINFO_HWACCEL_FILLRECT | FBINFO_HWACCEL_COPYAREA;
  340. fb_info.screen_base = (void *)hitfb_fix.smem_start;
  341. fb_alloc_cmap(&fb_info.cmap, 256, 0);
  342. if (register_framebuffer(&fb_info) < 0)
  343. return -EINVAL;
  344. printk(KERN_INFO "fb%d: %s frame buffer device\n",
  345. fb_info.node, fb_info.fix.id);
  346. return 0;
  347. }
  348. static int __devexit hitfb_remove(struct platform_device *dev)
  349. {
  350. return unregister_framebuffer(&fb_info);
  351. }
  352. #ifdef CONFIG_PM
  353. static int hitfb_suspend(struct platform_device *dev, pm_message_t state)
  354. {
  355. u16 v;
  356. hitfb_blank(1,0);
  357. v = fb_readw(HD64461_STBCR);
  358. v |= HD64461_STBCR_SLCKE_IST;
  359. fb_writew(v, HD64461_STBCR);
  360. return 0;
  361. }
  362. static int hitfb_resume(struct platform_device *dev)
  363. {
  364. u16 v;
  365. v = fb_readw(HD64461_STBCR);
  366. v &= ~HD64461_STBCR_SLCKE_OST;
  367. msleep(100);
  368. v = fb_readw(HD64461_STBCR);
  369. v &= ~HD64461_STBCR_SLCKE_IST;
  370. fb_writew(v, HD64461_STBCR);
  371. hitfb_blank(0,0);
  372. return 0;
  373. }
  374. #endif
  375. static struct platform_driver hitfb_driver = {
  376. .probe = hitfb_probe,
  377. .remove = __devexit_p(hitfb_remove),
  378. #ifdef CONFIG_PM
  379. .suspend = hitfb_suspend,
  380. .resume = hitfb_resume,
  381. #endif
  382. .driver = {
  383. .name = "hitfb",
  384. },
  385. };
  386. static struct platform_device hitfb_device = {
  387. .name = "hitfb",
  388. .id = -1,
  389. };
  390. static int __init hitfb_init(void)
  391. {
  392. int ret;
  393. ret = platform_driver_register(&hitfb_driver);
  394. if (!ret) {
  395. ret = platform_device_register(&hitfb_device);
  396. if (ret)
  397. platform_driver_unregister(&hitfb_driver);
  398. }
  399. return ret;
  400. }
  401. static void __exit hitfb_exit(void)
  402. {
  403. platform_device_unregister(&hitfb_device);
  404. platform_driver_unregister(&hitfb_driver);
  405. }
  406. module_init(hitfb_init);
  407. module_exit(hitfb_exit);
  408. MODULE_LICENSE("GPL");