drv_lcd.c 13 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458
  1. /*
  2. * Copyright (c) 2006-2024, RT-Thread Development Team
  3. *
  4. * SPDX-License-Identifier: Apache-2.0
  5. *
  6. * Change Logs:
  7. * Date Author Notes
  8. * 2022-11-24 Rbb666 the first version
  9. */
  10. #include <rtthread.h>
  11. #include <rtdevice.h>
  12. #ifdef BSP_USING_LCD
  13. #ifdef SOC_SERIES_R7FA8M85
  14. #include <ra8/lcd_config.h>
  15. #endif
  16. #include <drv_lcd.h>
  17. #include "hal_data.h"
  18. #define DRV_DEBUG
  19. #define LOG_TAG "drv_lcd"
  20. #include <drv_log.h>
  21. struct drv_lcd_device
  22. {
  23. struct rt_device parent;
  24. struct rt_device_graphic_info lcd_info;
  25. };
  26. struct drv_lcd_device _lcd;
  27. static uint16_t screen_rotation;
  28. static struct rt_completion sync_completion;
  29. static uint16_t *gp_single_buffer = NULL;
  30. static uint16_t *gp_double_buffer = NULL;
  31. static uint16_t *lcd_current_working_buffer = (uint16_t *) &fb_background[0];
  32. #ifdef SOC_SERIES_R7FA8M85
  33. static uint8_t lcd_framebuffer[LCD_BUF_SIZE] BSP_ALIGN_VARIABLE(64) BSP_PLACE_IN_SECTION(".sdram");
  34. #else
  35. static uint8_t lcd_framebuffer[LCD_BUF_SIZE] BSP_ALIGN_VARIABLE(64);
  36. #endif
  37. // G2D
  38. extern d2_device *d2_handle0;
  39. static d2_device **_d2_handle_user = &d2_handle0;
  40. static d2_renderbuffer *renderbuffer;
  41. extern void ra8_mipi_lcd_init(void);
  42. rt_weak void DisplayVsyncCallback(display_callback_args_t *p_args)
  43. {
  44. rt_interrupt_enter();
  45. if (DISPLAY_EVENT_LINE_DETECTION == p_args->event)
  46. {
  47. rt_completion_done(&sync_completion);
  48. }
  49. rt_interrupt_leave();
  50. }
  51. // Wait until Vsync is triggered through callback function
  52. static void vsync_wait(void)
  53. {
  54. rt_completion_wait(&sync_completion, RT_WAITING_FOREVER);
  55. }
  56. static void turn_on_lcd_backlight(void)
  57. {
  58. #ifdef BSP_USING_LCD_PWM_BACKLIGHT
  59. struct rt_device_pwm *pwm_dev;
  60. /* turn on the LCD backlight */
  61. pwm_dev = (struct rt_device_pwm *)rt_device_find(LCD_PWM_DEV_NAME);
  62. /* pwm frequency:100K = 10000ns */
  63. rt_pwm_set(pwm_dev, 0, 10000, 7000);
  64. rt_pwm_enable(pwm_dev, 0);
  65. #else
  66. rt_pin_mode(LCD_BL_PIN, PIN_MODE_OUTPUT); /* LCD_BL */
  67. rt_pin_write(LCD_BL_PIN, PIN_HIGH);
  68. #endif
  69. }
  70. static void ra_bsp_lcd_clear(uint16_t color)
  71. {
  72. for (uint32_t i = 0; i < LCD_BUF_SIZE; i++)
  73. {
  74. lcd_current_working_buffer[i] = color;
  75. }
  76. }
  77. void lcd_draw_pixel(uint32_t x, uint32_t y, uint16_t color)
  78. {
  79. // Verify pixel is within LCD range
  80. if ((x <= LCD_WIDTH) && (y <= LCD_HEIGHT))
  81. {
  82. switch (screen_rotation)
  83. {
  84. case ROTATION_ZERO:
  85. {
  86. lcd_current_working_buffer[(y * LCD_WIDTH) + x] = color;
  87. break;
  88. }
  89. case ROTATION_180:
  90. {
  91. lcd_current_working_buffer[((LCD_HEIGHT - y) * LCD_WIDTH) + (LCD_WIDTH - x)] = color;
  92. break;
  93. }
  94. default:
  95. {
  96. lcd_current_working_buffer[(y * LCD_WIDTH) + x] = color;
  97. break;
  98. }
  99. }
  100. }
  101. else
  102. {
  103. LOG_D("draw pixel outof range:%d,%d", x, y);
  104. }
  105. }
  106. void lcd_fill_array(uint16_t x_start, uint16_t y_start, uint16_t x_end, uint16_t y_end, void *pcolor)
  107. {
  108. uint16_t *pixel = RT_NULL;
  109. uint16_t cycle_y, x_offset = 0;
  110. pixel = (uint16_t *)pcolor;
  111. for (cycle_y = y_start; cycle_y <= y_end;)
  112. {
  113. for (x_offset = 0; x_start + x_offset <= x_end; x_offset++)
  114. {
  115. lcd_draw_pixel(x_start + x_offset, cycle_y, *pixel++);
  116. }
  117. cycle_y++;
  118. }
  119. }
  120. d2_device *d2_handle_obj_get(void)
  121. {
  122. return *_d2_handle_user;
  123. }
  124. d2_renderbuffer *d2_renderbuffer_get(void)
  125. {
  126. return renderbuffer;
  127. }
  128. void lcd_draw_jpg(int32_t x, int32_t y, const void *p, int32_t xSize, int32_t ySize)
  129. {
  130. uint32_t ModeSrc;
  131. ModeSrc = d2_mode_rgb565;
  132. // Generate render operations
  133. d2_framebuffer(d2_handle_obj_get(), (uint16_t *)&fb_background[0], LCD_WIDTH, LCD_WIDTH, LCD_HEIGHT, ModeSrc);
  134. d2_selectrenderbuffer(d2_handle_obj_get(), d2_renderbuffer_get());
  135. d2_cliprect(d2_handle_obj_get(), 0, 0, LCD_WIDTH, LCD_HEIGHT);
  136. d2_setblitsrc(d2_handle_obj_get(), (void *) p, xSize, xSize, ySize, ModeSrc);
  137. d2_blitcopy(d2_handle_obj_get(), xSize, ySize, 0, 0, (d2_width)(LCD_WIDTH << 4), (d2_width)(LCD_HEIGHT << 4),
  138. (d2_point)(x << 4), (d2_point)(y << 4), 0);
  139. // Execute render operations
  140. d2_executerenderbuffer(d2_handle_obj_get(), d2_renderbuffer_get(), 0);
  141. // In single-buffered mode always wait for DRW to finish before returning
  142. d2_flushframe(d2_handle_obj_get());
  143. }
  144. void lcd_gpu_fill_array(size_t x1, size_t y1, size_t x2, size_t y2, uint16_t *color_data)
  145. {
  146. uint32_t ModeSrc;
  147. int32_t width;
  148. int32_t heigh;
  149. width = (x2 - x1) + 1;
  150. heigh = (y2 - y1) + 1;
  151. ModeSrc = d2_mode_rgb565;
  152. // Generate render operations
  153. d2_framebuffer(d2_handle_obj_get(), (uint16_t *)&fb_background[0], LCD_WIDTH, LCD_WIDTH, LCD_HEIGHT, ModeSrc);
  154. d2_selectrenderbuffer(d2_handle_obj_get(), d2_renderbuffer_get());
  155. d2_cliprect(d2_handle_obj_get(), 0, 0, LCD_WIDTH, LCD_HEIGHT);
  156. d2_setblitsrc(d2_handle_obj_get(), (void *) color_data, width, width, heigh, ModeSrc);
  157. d2_blitcopy(d2_handle_obj_get(), width, heigh, 0, 0, (d2_width)(LCD_WIDTH << 4), (d2_width)(LCD_HEIGHT << 4),
  158. (d2_point)(x1 << 4), (d2_point)(y1 << 4), 0);
  159. // Execute render operations
  160. d2_executerenderbuffer(d2_handle_obj_get(), d2_renderbuffer_get(), 0);
  161. // In single-buffered mode always wait for DRW to finish before returning
  162. d2_flushframe(d2_handle_obj_get());
  163. }
  164. void g2d_display_write_area(const void *pSrc, void *pDst, int WidthSrc, int HeightSrc, int x, int y)
  165. {
  166. uint32_t ModeSrc;
  167. ModeSrc = d2_mode_rgb565;
  168. /* Set the new buffer to the current draw buffer */
  169. d2_framebuffer(d2_handle_obj_get(), (uint16_t *)pDst, LCD_WIDTH, LCD_WIDTH, LCD_HEIGHT, ModeSrc);
  170. d2_selectrenderbuffer(d2_handle_obj_get(), d2_renderbuffer_get());
  171. d2_cliprect(d2_handle_obj_get(), 0, 0, LCD_WIDTH, LCD_HEIGHT);
  172. d2_setblitsrc(d2_handle_obj_get(), (void *) pSrc, WidthSrc, WidthSrc, HeightSrc, ModeSrc);
  173. d2_blitcopy(d2_handle_obj_get(), WidthSrc, HeightSrc, 0, 0, (d2_width)(WidthSrc << 4), (d2_width)(HeightSrc << 4),
  174. (d2_point)(x << 4), (d2_point)(y << 4), 0);
  175. /* End the current display list */
  176. d2_executerenderbuffer(d2_handle_obj_get(), d2_renderbuffer_get(), 0);
  177. d2_flushframe(d2_handle_obj_get());
  178. }
  179. static int g2d_drv_hwInit(void)
  180. {
  181. d2_s32 d2_err;
  182. uint32_t ModeSrc;
  183. ModeSrc = d2_mode_rgb565;
  184. // Initialize D/AVE 2D driver
  185. *_d2_handle_user = d2_opendevice(0);
  186. d2_err = d2_inithw(*_d2_handle_user, 0);
  187. if (d2_err != D2_OK)
  188. {
  189. LOG_E("g2d init fail");
  190. d2_closedevice(*_d2_handle_user);
  191. return -RT_ERROR;
  192. }
  193. // Clear both buffers
  194. d2_framebuffer(*_d2_handle_user, (uint16_t *)&fb_background[0], LCD_WIDTH, LCD_WIDTH,
  195. LCD_HEIGHT, ModeSrc);
  196. d2_clear(*_d2_handle_user, 0x000000);
  197. // Set various D2 parameters
  198. d2_setblendmode(*_d2_handle_user, d2_bm_alpha, d2_bm_one_minus_alpha);
  199. d2_setalphamode(*_d2_handle_user, d2_am_constant);
  200. d2_setalpha(*_d2_handle_user, UINT8_MAX);
  201. d2_setantialiasing(*_d2_handle_user, 1);
  202. d2_setlinecap(*_d2_handle_user, d2_lc_butt);
  203. d2_setlinejoin(*_d2_handle_user, d2_lj_miter);
  204. renderbuffer = d2_newrenderbuffer(*_d2_handle_user, 20, 20);
  205. if (!renderbuffer)
  206. {
  207. LOG_E("no renderbuffer");
  208. d2_closedevice(*_d2_handle_user);
  209. return -RT_ERROR;
  210. }
  211. return RT_EOK;
  212. }
  213. static rt_err_t ra_lcd_control(rt_device_t device, int cmd, void *args)
  214. {
  215. struct drv_lcd_device *lcd = (struct drv_lcd_device *)device;
  216. switch (cmd)
  217. {
  218. case RTGRAPHIC_CTRL_RECT_UPDATE:
  219. {
  220. struct rt_device_rect_info *info = (struct rt_device_rect_info *)args;
  221. #if defined (__DCACHE_PRESENT) && (__DCACHE_PRESENT == 1U)
  222. SCB_CleanInvalidateDCache_by_Addr((uint32_t *)lcd->lcd_info.framebuffer, sizeof(fb_background[0]));
  223. #endif
  224. #if defined(ENABLE_DOUBLE_BUFFER) && ENABLE_DOUBLE_BUFFER
  225. /* Swap the active framebuffer */
  226. lcd_current_working_buffer = (lcd_current_working_buffer == gp_single_buffer) ? gp_double_buffer : gp_single_buffer;
  227. #endif
  228. g2d_display_write_area((uint8_t *)lcd->lcd_info.framebuffer, lcd_current_working_buffer,
  229. info->width, info->height, info->x, info->y);
  230. #if defined(ENABLE_DOUBLE_BUFFER) && ENABLE_DOUBLE_BUFFER
  231. /* Now that the framebuffer is ready, update the GLCDC buffer pointer on the next Vsync */
  232. fsp_err_t err = R_GLCDC_BufferChange(&g_display0_ctrl, (uint8_t *) lcd_current_working_buffer, DISPLAY_FRAME_LAYER_1);
  233. RT_ASSERT(err == 0);
  234. #endif
  235. /* wait for vsync interrupt */
  236. vsync_wait();
  237. }
  238. break;
  239. case RTGRAPHIC_CTRL_POWERON:
  240. turn_on_lcd_backlight();
  241. break;
  242. case RTGRAPHIC_CTRL_POWEROFF:
  243. rt_pin_write(LCD_BL_PIN, PIN_LOW);
  244. break;
  245. case RTGRAPHIC_CTRL_GET_INFO:
  246. {
  247. struct rt_device_graphic_info *info = (struct rt_device_graphic_info *)args;
  248. RT_ASSERT(info != RT_NULL);
  249. info->pixel_format = lcd->lcd_info.pixel_format;
  250. info->bits_per_pixel = 16;
  251. info->width = lcd->lcd_info.width;
  252. info->height = lcd->lcd_info.height;
  253. info->framebuffer = lcd->lcd_info.framebuffer;
  254. }
  255. break;
  256. case RTGRAPHIC_CTRL_SET_MODE:
  257. break;
  258. }
  259. return RT_EOK;
  260. }
  261. static rt_err_t drv_lcd_init(struct rt_device *device)
  262. {
  263. return RT_EOK;
  264. }
  265. static void reset_lcd_panel(void)
  266. {
  267. rt_pin_mode(LCD_RST_PIN, PIN_MODE_OUTPUT);
  268. rt_pin_write(LCD_RST_PIN, PIN_LOW);
  269. rt_thread_mdelay(100);
  270. rt_pin_write(LCD_RST_PIN, PIN_HIGH);
  271. rt_thread_mdelay(100);
  272. }
  273. static rt_err_t ra_bsp_lcd_init(void)
  274. {
  275. fsp_err_t error;
  276. /* Set screen rotation to default view */
  277. screen_rotation = ROTATION_ZERO;
  278. /* Display driver open */
  279. error = R_GLCDC_Open(&g_display0_ctrl, &g_display0_cfg);
  280. if (FSP_SUCCESS == error)
  281. {
  282. /* config mipi */
  283. ra8_mipi_lcd_init();
  284. /* Initialize g2d */
  285. error = g2d_drv_hwInit();
  286. /** Display driver start */
  287. error = R_GLCDC_Start(&g_display0_ctrl);
  288. }
  289. return error;
  290. }
  291. int rt_hw_lcd_init(void)
  292. {
  293. struct rt_device *device = &_lcd.parent;
  294. /* memset _lcd to zero */
  295. memset(&_lcd, 0x00, sizeof(_lcd));
  296. /* config LCD dev info */
  297. _lcd.lcd_info.height = LCD_HEIGHT;
  298. _lcd.lcd_info.width = LCD_WIDTH;
  299. _lcd.lcd_info.bits_per_pixel = LCD_BITS_PER_PIXEL;
  300. _lcd.lcd_info.pixel_format = LCD_PIXEL_FORMAT;
  301. _lcd.lcd_info.framebuffer = (uint8_t *)lcd_framebuffer;
  302. if (_lcd.lcd_info.framebuffer == NULL)
  303. {
  304. LOG_E("alloc lcd framebuffer fail");
  305. return -RT_ERROR;
  306. }
  307. LOG_D("\nlcd framebuffer address:%#x", _lcd.lcd_info.framebuffer);
  308. memset(_lcd.lcd_info.framebuffer, 0x0, LCD_BUF_SIZE);
  309. device->type = RT_Device_Class_Graphic;
  310. #ifdef RT_USING_DEVICE_OPS
  311. device->ops = &lcd_ops;
  312. #else
  313. device->init = drv_lcd_init;
  314. device->control = ra_lcd_control;
  315. #endif
  316. /* register lcd device */
  317. rt_device_register(device, "lcd", RT_DEVICE_FLAG_RDWR);
  318. rt_completion_init(&sync_completion);
  319. /* Initialize buffer pointers */
  320. gp_single_buffer = (uint16_t *) g_display0_cfg.input[0].p_base;
  321. /* Double buffer for drawing color bands with good quality */
  322. gp_double_buffer = gp_single_buffer + LCD_BUF_SIZE;
  323. reset_lcd_panel();
  324. ra_bsp_lcd_init();
  325. /* turn on lcd backlight */
  326. turn_on_lcd_backlight();
  327. ra_bsp_lcd_clear(0x0);
  328. screen_rotation = ROTATION_ZERO;
  329. return RT_EOK;
  330. }
  331. INIT_DEVICE_EXPORT(rt_hw_lcd_init);
  332. #ifdef SOC_SERIES_R7FA8M85
  333. rt_weak void ra8_mipi_lcd_init(void)
  334. {
  335. LOG_E("please Implementation function %s", __func__);
  336. }
  337. #endif
  338. int lcd_test(void)
  339. {
  340. struct drv_lcd_device *lcd;
  341. struct rt_device_rect_info rect_info;
  342. rect_info.x = 0;
  343. rect_info.y = 0;
  344. rect_info.width = LCD_WIDTH;
  345. rect_info.height = LCD_HEIGHT;
  346. lcd = (struct drv_lcd_device *)rt_device_find("lcd");
  347. for (int i = 0; i < 2; i++)
  348. {
  349. /* red */
  350. for (int i = 0; i < LCD_BUF_SIZE / 2; i++)
  351. {
  352. lcd->lcd_info.framebuffer[2 * i] = 0x00;
  353. lcd->lcd_info.framebuffer[2 * i + 1] = 0xF8;
  354. }
  355. LOG_D("red buffer...");
  356. lcd->parent.control(&lcd->parent, RTGRAPHIC_CTRL_RECT_UPDATE, &rect_info);
  357. rt_thread_mdelay(1000);
  358. /* green */
  359. for (int i = 0; i < LCD_BUF_SIZE / 2; i++)
  360. {
  361. lcd->lcd_info.framebuffer[2 * i] = 0xE0;
  362. lcd->lcd_info.framebuffer[2 * i + 1] = 0x07;
  363. }
  364. LOG_D("green buffer...");
  365. lcd->parent.control(&lcd->parent, RTGRAPHIC_CTRL_RECT_UPDATE, &rect_info);
  366. rt_thread_mdelay(1000);
  367. /* blue */
  368. for (int i = 0; i < LCD_BUF_SIZE / 2; i++)
  369. {
  370. lcd->lcd_info.framebuffer[2 * i] = 0x1F;
  371. lcd->lcd_info.framebuffer[2 * i + 1] = 0x00;
  372. }
  373. LOG_D("blue buffer...");
  374. lcd->parent.control(&lcd->parent, RTGRAPHIC_CTRL_RECT_UPDATE, &rect_info);
  375. rt_thread_mdelay(1000);
  376. }
  377. return RT_EOK;
  378. }
  379. MSH_CMD_EXPORT(lcd_test, lcd test cmd);
  380. #endif /* BSP_USING_LCD */