hitfb.c 11 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502
  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 <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 inline void hitfb_accel_wait(void)
  42. {
  43. while (fb_readw(HD64461_GRCFGR) & HD64461_GRCFGR_ACCSTATUS) ;
  44. }
  45. static inline void hitfb_accel_start(int truecolor)
  46. {
  47. if (truecolor) {
  48. fb_writew(6, HD64461_GRCFGR);
  49. } else {
  50. fb_writew(7, HD64461_GRCFGR);
  51. }
  52. }
  53. static inline void hitfb_accel_set_dest(int truecolor, u16 dx, u16 dy,
  54. u16 width, u16 height)
  55. {
  56. u32 saddr = WIDTH * dy + dx;
  57. if (truecolor)
  58. saddr <<= 1;
  59. fb_writew(width-1, HD64461_BBTDWR);
  60. fb_writew(height-1, HD64461_BBTDHR);
  61. fb_writew(saddr & 0xffff, HD64461_BBTDSARL);
  62. fb_writew(saddr >> 16, HD64461_BBTDSARH);
  63. }
  64. static inline void hitfb_accel_bitblt(int truecolor, u16 sx, u16 sy, u16 dx,
  65. u16 dy, u16 width, u16 height, u16 rop,
  66. u32 mask_addr)
  67. {
  68. u32 saddr, daddr;
  69. u32 maddr = 0;
  70. height--;
  71. width--;
  72. fb_writew(rop, HD64461_BBTROPR);
  73. if ((sy < dy) || ((sy == dy) && (sx <= dx))) {
  74. saddr = WIDTH * (sy + height) + sx + width;
  75. daddr = WIDTH * (dy + height) + dx + width;
  76. if (mask_addr) {
  77. if (truecolor)
  78. maddr = ((width >> 3) + 1) * (height + 1) - 1;
  79. else
  80. maddr =
  81. (((width >> 4) + 1) * (height + 1) - 1) * 2;
  82. fb_writew((1 << 5) | 1, HD64461_BBTMDR);
  83. } else
  84. fb_writew(1, HD64461_BBTMDR);
  85. } else {
  86. saddr = WIDTH * sy + sx;
  87. daddr = WIDTH * dy + dx;
  88. if (mask_addr) {
  89. fb_writew((1 << 5), HD64461_BBTMDR);
  90. } else {
  91. fb_writew(0, HD64461_BBTMDR);
  92. }
  93. }
  94. if (truecolor) {
  95. saddr <<= 1;
  96. daddr <<= 1;
  97. }
  98. fb_writew(width, HD64461_BBTDWR);
  99. fb_writew(height, HD64461_BBTDHR);
  100. fb_writew(saddr & 0xffff, HD64461_BBTSSARL);
  101. fb_writew(saddr >> 16, HD64461_BBTSSARH);
  102. fb_writew(daddr & 0xffff, HD64461_BBTDSARL);
  103. fb_writew(daddr >> 16, HD64461_BBTDSARH);
  104. if (mask_addr) {
  105. maddr += mask_addr;
  106. fb_writew(maddr & 0xffff, HD64461_BBTMARL);
  107. fb_writew(maddr >> 16, HD64461_BBTMARH);
  108. }
  109. hitfb_accel_start(truecolor);
  110. }
  111. static void hitfb_fillrect(struct fb_info *p, const struct fb_fillrect *rect)
  112. {
  113. if (rect->rop != ROP_COPY)
  114. cfb_fillrect(p, rect);
  115. else {
  116. hitfb_accel_wait();
  117. fb_writew(0x00f0, HD64461_BBTROPR);
  118. fb_writew(16, HD64461_BBTMDR);
  119. if (p->var.bits_per_pixel == 16) {
  120. fb_writew(((u32 *) (p->pseudo_palette))[rect->color],
  121. HD64461_GRSCR);
  122. hitfb_accel_set_dest(1, rect->dx, rect->dy, rect->width,
  123. rect->height);
  124. hitfb_accel_start(1);
  125. } else {
  126. fb_writew(rect->color, HD64461_GRSCR);
  127. hitfb_accel_set_dest(0, rect->dx, rect->dy, rect->width,
  128. rect->height);
  129. hitfb_accel_start(0);
  130. }
  131. }
  132. }
  133. static void hitfb_copyarea(struct fb_info *p, const struct fb_copyarea *area)
  134. {
  135. hitfb_accel_wait();
  136. hitfb_accel_bitblt(p->var.bits_per_pixel == 16, area->sx, area->sy,
  137. area->dx, area->dy, area->width, area->height,
  138. 0x00cc, 0);
  139. }
  140. static int hitfb_pan_display(struct fb_var_screeninfo *var,
  141. struct fb_info *info)
  142. {
  143. int xoffset = var->xoffset;
  144. int yoffset = var->yoffset;
  145. if (xoffset != 0)
  146. return -EINVAL;
  147. fb_writew((yoffset*info->fix.line_length)>>10, HD64461_LCDCBAR);
  148. return 0;
  149. }
  150. int hitfb_blank(int blank_mode, struct fb_info *info)
  151. {
  152. unsigned short v;
  153. if (blank_mode) {
  154. v = fb_readw(HD64461_LDR1);
  155. v &= ~HD64461_LDR1_DON;
  156. fb_writew(v, HD64461_LDR1);
  157. v = fb_readw(HD64461_LCDCCR);
  158. v |= HD64461_LCDCCR_MOFF;
  159. fb_writew(v, HD64461_LCDCCR);
  160. v = fb_readw(HD64461_STBCR);
  161. v |= HD64461_STBCR_SLCDST;
  162. fb_writew(v, HD64461_STBCR);
  163. } else {
  164. v = fb_readw(HD64461_STBCR);
  165. v &= ~HD64461_STBCR_SLCDST;
  166. fb_writew(v, HD64461_STBCR);
  167. v = fb_readw(HD64461_LCDCCR);
  168. v &= ~(HD64461_LCDCCR_MOFF | HD64461_LCDCCR_STREQ);
  169. fb_writew(v, HD64461_LCDCCR);
  170. do {
  171. v = fb_readw(HD64461_LCDCCR);
  172. } while(v&HD64461_LCDCCR_STBACK);
  173. v = fb_readw(HD64461_LDR1);
  174. v |= HD64461_LDR1_DON;
  175. fb_writew(v, HD64461_LDR1);
  176. }
  177. return 0;
  178. }
  179. static int hitfb_setcolreg(unsigned regno, unsigned red, unsigned green,
  180. unsigned blue, unsigned transp, struct fb_info *info)
  181. {
  182. if (regno >= 256)
  183. return 1;
  184. switch (info->var.bits_per_pixel) {
  185. case 8:
  186. fb_writew(regno << 8, HD64461_CPTWAR);
  187. fb_writew(red >> 10, HD64461_CPTWDR);
  188. fb_writew(green >> 10, HD64461_CPTWDR);
  189. fb_writew(blue >> 10, HD64461_CPTWDR);
  190. break;
  191. case 16:
  192. if (regno >= 16)
  193. return 1;
  194. ((u32 *) (info->pseudo_palette))[regno] =
  195. ((red & 0xf800)) |
  196. ((green & 0xfc00) >> 5) | ((blue & 0xf800) >> 11);
  197. break;
  198. }
  199. return 0;
  200. }
  201. static int hitfb_sync(struct fb_info *info)
  202. {
  203. hitfb_accel_wait();
  204. return 0;
  205. }
  206. static int hitfb_check_var(struct fb_var_screeninfo *var, struct fb_info *info)
  207. {
  208. int maxy;
  209. var->xres = info->var.xres;
  210. var->xres_virtual = info->var.xres;
  211. var->yres = info->var.yres;
  212. if ((var->bits_per_pixel != 8) && (var->bits_per_pixel != 16))
  213. var->bits_per_pixel = info->var.bits_per_pixel;
  214. if (var->yres_virtual < var->yres)
  215. var->yres_virtual = var->yres;
  216. maxy = info->fix.smem_len / var->xres;
  217. if (var->bits_per_pixel == 16)
  218. maxy /= 2;
  219. if (var->yres_virtual > maxy)
  220. var->yres_virtual = maxy;
  221. var->xoffset = 0;
  222. var->yoffset = 0;
  223. switch (var->bits_per_pixel) {
  224. case 8:
  225. var->red.offset = 0;
  226. var->red.length = 8;
  227. var->green.offset = 0;
  228. var->green.length = 8;
  229. var->blue.offset = 0;
  230. var->blue.length = 8;
  231. var->transp.offset = 0;
  232. var->transp.length = 0;
  233. break;
  234. case 16: /* RGB 565 */
  235. var->red.offset = 11;
  236. var->red.length = 5;
  237. var->green.offset = 5;
  238. var->green.length = 6;
  239. var->blue.offset = 0;
  240. var->blue.length = 5;
  241. var->transp.offset = 0;
  242. var->transp.length = 0;
  243. break;
  244. }
  245. return 0;
  246. }
  247. static int hitfb_set_par(struct fb_info *info)
  248. {
  249. unsigned short ldr3;
  250. switch (info->var.bits_per_pixel) {
  251. case 8:
  252. info->fix.line_length = info->var.xres;
  253. info->fix.visual = FB_VISUAL_PSEUDOCOLOR;
  254. info->fix.ypanstep = 16;
  255. break;
  256. case 16:
  257. info->fix.line_length = info->var.xres*2;
  258. info->fix.visual = FB_VISUAL_TRUECOLOR;
  259. info->fix.ypanstep = 8;
  260. break;
  261. }
  262. fb_writew(info->fix.line_length, HD64461_LCDCLOR);
  263. ldr3 = fb_readw(HD64461_LDR3);
  264. ldr3 &= ~15;
  265. ldr3 |= (info->var.bits_per_pixel == 8) ? 4 : 8;
  266. fb_writew(ldr3, HD64461_LDR3);
  267. return 0;
  268. }
  269. static struct fb_ops hitfb_ops = {
  270. .owner = THIS_MODULE,
  271. .fb_check_var = hitfb_check_var,
  272. .fb_set_par = hitfb_set_par,
  273. .fb_setcolreg = hitfb_setcolreg,
  274. .fb_blank = hitfb_blank,
  275. .fb_sync = hitfb_sync,
  276. .fb_pan_display = hitfb_pan_display,
  277. .fb_fillrect = hitfb_fillrect,
  278. .fb_copyarea = hitfb_copyarea,
  279. .fb_imageblit = cfb_imageblit,
  280. };
  281. static int __init hitfb_probe(struct platform_device *dev)
  282. {
  283. unsigned short lcdclor, ldr3, ldvndr;
  284. struct fb_info *info;
  285. int ret;
  286. if (fb_get_options("hitfb", NULL))
  287. return -ENODEV;
  288. hitfb_fix.mmio_start = HD64461_IO_OFFSET(0x1000);
  289. hitfb_fix.mmio_len = 0x1000;
  290. hitfb_fix.smem_start = HD64461_IO_OFFSET(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. info = framebuffer_alloc(sizeof(u32) * 16, &dev->dev);
  335. if (unlikely(!info))
  336. return -ENOMEM;
  337. info->fbops = &hitfb_ops;
  338. info->var = hitfb_var;
  339. info->fix = hitfb_fix;
  340. info->pseudo_palette = info->par;
  341. info->flags = FBINFO_DEFAULT | FBINFO_HWACCEL_YPAN |
  342. FBINFO_HWACCEL_FILLRECT | FBINFO_HWACCEL_COPYAREA;
  343. info->screen_base = (void *)hitfb_fix.smem_start;
  344. ret = fb_alloc_cmap(&info->cmap, 256, 0);
  345. if (unlikely(ret < 0))
  346. goto err_fb;
  347. ret = register_framebuffer(info);
  348. if (unlikely(ret < 0))
  349. goto err;
  350. platform_set_drvdata(dev, info);
  351. printk(KERN_INFO "fb%d: %s frame buffer device\n",
  352. info->node, info->fix.id);
  353. return 0;
  354. err:
  355. fb_dealloc_cmap(&info->cmap);
  356. err_fb:
  357. framebuffer_release(info);
  358. return ret;
  359. }
  360. static int __exit hitfb_remove(struct platform_device *dev)
  361. {
  362. struct fb_info *info = platform_get_drvdata(dev);
  363. unregister_framebuffer(info);
  364. fb_dealloc_cmap(&info->cmap);
  365. framebuffer_release(info);
  366. return 0;
  367. }
  368. static int hitfb_suspend(struct device *dev)
  369. {
  370. u16 v;
  371. hitfb_blank(1,0);
  372. v = fb_readw(HD64461_STBCR);
  373. v |= HD64461_STBCR_SLCKE_IST;
  374. fb_writew(v, HD64461_STBCR);
  375. return 0;
  376. }
  377. static int hitfb_resume(struct device *dev)
  378. {
  379. u16 v;
  380. v = fb_readw(HD64461_STBCR);
  381. v &= ~HD64461_STBCR_SLCKE_OST;
  382. msleep(100);
  383. v = fb_readw(HD64461_STBCR);
  384. v &= ~HD64461_STBCR_SLCKE_IST;
  385. fb_writew(v, HD64461_STBCR);
  386. hitfb_blank(0,0);
  387. return 0;
  388. }
  389. static const struct dev_pm_ops hitfb_dev_pm_ops = {
  390. .suspend = hitfb_suspend,
  391. .resume = hitfb_resume,
  392. };
  393. static struct platform_driver hitfb_driver = {
  394. .probe = hitfb_probe,
  395. .remove = __exit_p(hitfb_remove),
  396. .driver = {
  397. .name = "hitfb",
  398. .owner = THIS_MODULE,
  399. .pm = &hitfb_dev_pm_ops,
  400. },
  401. };
  402. static struct platform_device hitfb_device = {
  403. .name = "hitfb",
  404. .id = -1,
  405. };
  406. static int __init hitfb_init(void)
  407. {
  408. int ret;
  409. ret = platform_driver_register(&hitfb_driver);
  410. if (!ret) {
  411. ret = platform_device_register(&hitfb_device);
  412. if (ret)
  413. platform_driver_unregister(&hitfb_driver);
  414. }
  415. return ret;
  416. }
  417. static void __exit hitfb_exit(void)
  418. {
  419. platform_device_unregister(&hitfb_device);
  420. platform_driver_unregister(&hitfb_driver);
  421. }
  422. module_init(hitfb_init);
  423. module_exit(hitfb_exit);
  424. MODULE_LICENSE("GPL");