vid_pollux.c 4.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206
  1. /*
  2. * (C) Gražvydas "notaz" Ignotas, 2009,2013
  3. *
  4. * This work is licensed under the terms of any of these licenses
  5. * (at your option):
  6. * - GNU GPL, version 2 or later.
  7. * - GNU LGPL, version 2.1 or later.
  8. * - MAME license.
  9. * See the COPYING file in the top-level directory.
  10. *
  11. * <random_info=mem_map>
  12. * 00000000-029fffff linux (42MB)
  13. * 02a00000-02dfffff fb (4MB, 153600B really used)
  14. * 02e00000-02ffffff sound dma (2MB)
  15. * 03000000-03ffffff MPEGDEC (?, 16MB)
  16. * </random_info>
  17. */
  18. #include <stdio.h>
  19. #include <stdlib.h>
  20. #include <string.h>
  21. #include <sys/types.h>
  22. #include <sys/stat.h>
  23. #include <fcntl.h>
  24. #include <sys/ioctl.h>
  25. #include <sys/mman.h>
  26. #include <linux/fb.h>
  27. #include <unistd.h>
  28. #include "../libpicofe/gp2x/soc.h"
  29. #include "../libpicofe/gp2x/plat_gp2x.h"
  30. #include "../libpicofe/gp2x/pollux_set.h"
  31. #include "../common/emu.h"
  32. #include "../common/arm_utils.h"
  33. #include "plat.h"
  34. #define FB_BUF_COUNT 4
  35. #define FB_MEM_SIZE (320*240*2 * FB_BUF_COUNT)
  36. static unsigned int fb_paddr[FB_BUF_COUNT];
  37. static int fb_work_buf;
  38. static int fbdev = -1;
  39. /* video stuff */
  40. static void pollux_video_flip(int buf_count)
  41. {
  42. memregl[0x406C>>2] = memregl[0x446C>>2] = fb_paddr[fb_work_buf];
  43. memregl[0x4058>>2] |= 0x10;
  44. memregl[0x4458>>2] |= 0x10;
  45. fb_work_buf++;
  46. if (fb_work_buf >= buf_count)
  47. fb_work_buf = 0;
  48. g_screen_ptr = gp2x_screens[fb_work_buf];
  49. }
  50. static void gp2x_video_flip_(void)
  51. {
  52. pollux_video_flip(FB_BUF_COUNT);
  53. }
  54. /* doulblebuffered flip */
  55. static void gp2x_video_flip2_(void)
  56. {
  57. pollux_video_flip(2);
  58. }
  59. static void gp2x_video_changemode_ll_(int bpp, int is_pal)
  60. {
  61. static int prev_bpp = 0;
  62. int code = 0, bytes = 2;
  63. int rot_cmd[2] = { 0, 0 };
  64. unsigned int r;
  65. char buff[32];
  66. int ret;
  67. if (bpp == prev_bpp)
  68. return;
  69. prev_bpp = bpp;
  70. printf("changemode: %dbpp rot=%d\n", abs(bpp), bpp < 0);
  71. /* negative bpp means rotated mode */
  72. rot_cmd[0] = (bpp < 0) ? 6 : 5;
  73. ret = ioctl(fbdev, _IOW('D', 90, int[2]), rot_cmd);
  74. if (ret < 0)
  75. perror("rot ioctl failed");
  76. memregl[0x4004>>2] = (bpp < 0) ? 0x013f00ef : 0x00ef013f;
  77. memregl[0x4000>>2] |= 1 << 3;
  78. /* the above ioctl resets LCD timings, so set them here */
  79. snprintf(buff, sizeof(buff), "POLLUX_LCD_TIMINGS_%s",
  80. is_pal ? "PAL" : "NTSC");
  81. pollux_set_fromenv(memregs, buff);
  82. switch (abs(bpp))
  83. {
  84. case 8:
  85. code = 0x443a;
  86. bytes = 1;
  87. break;
  88. case 15:
  89. case 16:
  90. code = 0x4432;
  91. bytes = 2;
  92. break;
  93. default:
  94. printf("unhandled bpp request: %d\n", abs(bpp));
  95. return;
  96. }
  97. // program both MLCs so that TV-out works
  98. memregl[0x405c>>2] = memregl[0x445c>>2] = bytes;
  99. memregl[0x4060>>2] = memregl[0x4460>>2] =
  100. bytes * (bpp < 0 ? 240 : 320);
  101. r = memregl[0x4058>>2];
  102. r = (r & 0xffff) | (code << 16) | 0x10;
  103. memregl[0x4058>>2] = r;
  104. r = memregl[0x4458>>2];
  105. r = (r & 0xffff) | (code << 16) | 0x10;
  106. memregl[0x4458>>2] = r;
  107. }
  108. static void gp2x_video_setpalette_(int *pal, int len)
  109. {
  110. /* pollux palette is 16bpp only.. */
  111. int i;
  112. for (i = 0; i < len; i++)
  113. {
  114. int c = pal[i];
  115. c = ((c >> 8) & 0xf800) | ((c >> 5) & 0x07c0) | ((c >> 3) & 0x001f);
  116. memregl[0x4070>>2] = (i << 24) | c;
  117. }
  118. }
  119. static void gp2x_video_RGB_setscaling_(int ln_offs, int W, int H)
  120. {
  121. /* maybe a job for 3d hardware? */
  122. }
  123. static void gp2x_video_wait_vsync_(void)
  124. {
  125. while (!(memregl[0x308c>>2] & (1 << 10)))
  126. spend_cycles(128);
  127. memregl[0x308c>>2] |= 1 << 10;
  128. }
  129. void vid_pollux_init(void)
  130. {
  131. struct fb_fix_screeninfo fbfix;
  132. int i, ret;
  133. fbdev = open("/dev/fb0", O_RDWR);
  134. if (fbdev < 0) {
  135. perror("can't open fbdev");
  136. exit(1);
  137. }
  138. ret = ioctl(fbdev, FBIOGET_FSCREENINFO, &fbfix);
  139. if (ret == -1) {
  140. perror("ioctl(fbdev) failed");
  141. exit(1);
  142. }
  143. printf("framebuffer: \"%s\" @ %08lx\n", fbfix.id, fbfix.smem_start);
  144. fb_paddr[0] = fbfix.smem_start;
  145. gp2x_screens[0] = mmap(0, FB_MEM_SIZE, PROT_READ|PROT_WRITE,
  146. MAP_SHARED, memdev, fb_paddr[0]);
  147. if (gp2x_screens[0] == MAP_FAILED)
  148. {
  149. perror("mmap(gp2x_screens) failed");
  150. exit(1);
  151. }
  152. memset(gp2x_screens[0], 0, FB_MEM_SIZE);
  153. printf(" %p -> %08x\n", gp2x_screens[0], fb_paddr[0]);
  154. for (i = 1; i < FB_BUF_COUNT; i++)
  155. {
  156. fb_paddr[i] = fb_paddr[i-1] + 320*240*2;
  157. gp2x_screens[i] = (char *)gp2x_screens[i-1] + 320*240*2;
  158. printf(" %p -> %08x\n", gp2x_screens[i], fb_paddr[i]);
  159. }
  160. fb_work_buf = 0;
  161. g_screen_ptr = gp2x_screens[0];
  162. gp2x_video_flip = gp2x_video_flip_;
  163. gp2x_video_flip2 = gp2x_video_flip2_;
  164. gp2x_video_changemode_ll = gp2x_video_changemode_ll_;
  165. gp2x_video_setpalette = gp2x_video_setpalette_;
  166. gp2x_video_RGB_setscaling = gp2x_video_RGB_setscaling_;
  167. gp2x_video_wait_vsync = gp2x_video_wait_vsync_;
  168. }
  169. void vid_pollux_finish(void)
  170. {
  171. memset(gp2x_screens[0], 0, FB_MEM_SIZE);
  172. munmap(gp2x_screens[0], FB_MEM_SIZE);
  173. close(fbdev);
  174. fbdev = -1;
  175. }