393 lines
13 KiB
C
393 lines
13 KiB
C
|
/**************************************************************************//**
|
||
|
|
*
|
||
|
|
* @copyright (C) 2020 Nuvoton Technology Corp. All rights reserved.
|
||
|
|
*
|
||
|
|
* SPDX-License-Identifier: Apache-2.0
|
||
|
|
*
|
||
|
|
* Change Logs:
|
||
|
|
* Date Author Notes
|
||
|
|
* 2022-2-23 Wayne First version
|
||
|
|
*
|
||
|
|
******************************************************************************/
|
||
|
|
|
||
|
|
#include <rtconfig.h>
|
||
|
|
|
||
|
|
#if defined(NU_PKG_USING_FSA506)
|
||
|
|
|
||
|
|
#include <rtdevice.h>
|
||
|
|
#include <lcd_fsa506.h>
|
||
|
|
|
||
|
|
#if defined(NU_PKG_FSA506_WITH_OFFSCREEN_FRAMEBUFFER)
|
||
|
|
#if !defined(NU_PKG_FSA506_LINE_BUFFER_NUMBER)
|
||
|
|
#define NU_PKG_FSA506_LINE_BUFFER_NUMBER YSIZE_PHYS
|
||
|
|
#endif
|
||
|
|
#endif
|
||
|
|
|
||
|
|
#define fsa506_delay_ms(ms) rt_thread_mdelay(ms)
|
||
|
|
static void fsa506_fillscreen(rt_uint16_t color);
|
||
|
|
|
||
|
|
static struct rt_device_graphic_info g_FSA506Info =
|
||
|
|
{
|
||
|
|
.bits_per_pixel = 16,
|
||
|
|
.pixel_format = RTGRAPHIC_PIXEL_FORMAT_RGB565,
|
||
|
|
.framebuffer = RT_NULL,
|
||
|
|
.width = XSIZE_PHYS,
|
||
|
|
.pitch = XSIZE_PHYS * 2,
|
||
|
|
.height = YSIZE_PHYS
|
||
|
|
};
|
||
|
|
|
||
|
|
static rt_err_t fsa506_pin_init(void)
|
||
|
|
{
|
||
|
|
rt_pin_mode(BOARD_USING_FSA506_PIN_DC, PIN_MODE_OUTPUT);
|
||
|
|
rt_pin_mode(BOARD_USING_FSA506_PIN_RESET, PIN_MODE_OUTPUT);
|
||
|
|
rt_pin_mode(BOARD_USING_FSA506_PIN_BACKLIGHT, PIN_MODE_OUTPUT);
|
||
|
|
rt_pin_mode(BOARD_USING_FSA506_PIN_DISPLAY, PIN_MODE_OUTPUT);
|
||
|
|
|
||
|
|
CLR_RS;
|
||
|
|
CLR_RST;
|
||
|
|
SET_BACKLIGHT_OFF;
|
||
|
|
SET_DISP_OFF;
|
||
|
|
|
||
|
|
return RT_EOK;
|
||
|
|
}
|
||
|
|
|
||
|
|
static rt_err_t fsa506_lcd_init(rt_device_t dev)
|
||
|
|
{
|
||
|
|
/* Hardware reset */
|
||
|
|
CLR_RST;
|
||
|
|
fsa506_delay_ms(100); // Delay 100ms
|
||
|
|
|
||
|
|
SET_RST;
|
||
|
|
fsa506_delay_ms(100); // Delay 100ms
|
||
|
|
|
||
|
|
fsa506_write_reg(0x40, 0x12); // Underspece
|
||
|
|
fsa506_write_reg(0x41, 0x05); // Underspece
|
||
|
|
fsa506_write_reg(0x42, 0x06); // Underspece
|
||
|
|
|
||
|
|
/* Set the panel X size */
|
||
|
|
fsa506_write_reg(0x08, (uint8_t)(XSIZE_PHYS >> 8)); //Set the panel X size H[1.0]
|
||
|
|
fsa506_write_reg(0x09, (uint8_t)(XSIZE_PHYS)); //Set the panel X size L[7:0]
|
||
|
|
|
||
|
|
/* Memory write start address */
|
||
|
|
fsa506_write_reg(0x0a, 0x00); //[17:16] bits of memory write start address
|
||
|
|
fsa506_write_reg(0x0b, 0x00); //[15:8] bits of memory write start address
|
||
|
|
fsa506_write_reg(0x0c, 0x00); //[7:0] bits of memory write start address
|
||
|
|
|
||
|
|
/* Clock & format */
|
||
|
|
fsa506_write_reg(0x10, 0x0D); //[0-1] : 20MHz, [2]: Parallel panel, [3]: Normal operation
|
||
|
|
fsa506_write_reg(0x11, 0x05); //[3-5]: RGB, [0-2]BGR
|
||
|
|
|
||
|
|
/* For TFT output timing adjust */
|
||
|
|
fsa506_write_reg(0x12, 0x00); //Hsync start position H-Byte
|
||
|
|
fsa506_write_reg(0x13, 0x00); //Hsync start position L-Byte
|
||
|
|
fsa506_write_reg(0x14, (uint8_t)(41 >> 8)); //Hsync pulse width H-Byte
|
||
|
|
fsa506_write_reg(0x15, (uint8_t)(41)); //Hsync pulse width L-Byte
|
||
|
|
|
||
|
|
fsa506_write_reg(0x16, (uint8_t)(43 >> 8)); //DE pulse start position H-Byte
|
||
|
|
fsa506_write_reg(0x17, (uint8_t)(43)); //DE pulse start position L-Byte
|
||
|
|
fsa506_write_reg(0x18, (uint8_t)(XSIZE_PHYS >> 8)); //DE pulse width H-Byte
|
||
|
|
fsa506_write_reg(0x19, (uint8_t)(XSIZE_PHYS)); //DE pulse width L-Byte
|
||
|
|
fsa506_write_reg(0x1a, (uint8_t)(525 >> 8)); //Hsync total clocks H-Byte
|
||
|
|
fsa506_write_reg(0x1b, (uint8_t)(525)); //Hsync total clocks H-Byte
|
||
|
|
fsa506_write_reg(0x1c, 0x00); //Vsync start position H-Byte
|
||
|
|
fsa506_write_reg(0x1d, 0x00); //Vsync start position L-Byte
|
||
|
|
fsa506_write_reg(0x1e, (uint8_t)(10 >> 8)); //Vsync pulse width H-Byte
|
||
|
|
fsa506_write_reg(0x1f, (uint8_t)(10)); //Vsync pulse width L-Byte
|
||
|
|
fsa506_write_reg(0x20, (uint8_t)(12 >> 8)); //Vertical DE pulse start position H-Byte
|
||
|
|
fsa506_write_reg(0x21, (uint8_t)(12)); //Vertical DE pulse start position L-Byte
|
||
|
|
fsa506_write_reg(0x22, (uint8_t)(YSIZE_PHYS >> 8)); //Vertical Active width H-Byte
|
||
|
|
fsa506_write_reg(0x23, (uint8_t)(YSIZE_PHYS)); //Vertical Active width H-Byte
|
||
|
|
fsa506_write_reg(0x24, (uint8_t)(286 >> 8)); //Vertical total width H-Byte
|
||
|
|
fsa506_write_reg(0x25, (uint8_t)(286)); //Vertical total width L-Byte
|
||
|
|
|
||
|
|
fsa506_write_reg(0x26, 0x00); //Memory read start address
|
||
|
|
fsa506_write_reg(0x27, 0x00); //Memory read start address
|
||
|
|
fsa506_write_reg(0x28, 0x00); //Memory read start address
|
||
|
|
fsa506_write_reg(0x29, 0x01); //[0] Load output timing related setting (H sync., V sync. and DE) to take effect
|
||
|
|
|
||
|
|
//[7:4] Reserved
|
||
|
|
//[3] Output pin X_DCON level control
|
||
|
|
//[2] Output clock inversion 0: Normal 1: Inverse
|
||
|
|
//[1:0] Image rotate
|
||
|
|
// 00: 0? 01: 90? 10: 270?11: 180?
|
||
|
|
fsa506_write_reg(0x2d, (1 << 2) | 0x08);
|
||
|
|
|
||
|
|
/* Set the Horizontal offset */
|
||
|
|
fsa506_write_reg(0x30, 0x00); //_H byte H-Offset[3:0]
|
||
|
|
fsa506_write_reg(0x31, 0x00); //_L byte H-Offset[7:0]
|
||
|
|
fsa506_write_reg(0x32, 0x00); //_H byte V-Offset[3:0]
|
||
|
|
fsa506_write_reg(0x33, 0x00); //_L byte V-Offset[7:0]
|
||
|
|
fsa506_write_reg(0x34, (uint8_t)(XSIZE_PHYS >> 8)); //H byte H-def[3:0]
|
||
|
|
fsa506_write_reg(0x35, (uint8_t)(XSIZE_PHYS)); //_L byte H-def[7:0]
|
||
|
|
fsa506_write_reg(0x36, (uint8_t)((2 * YSIZE_PHYS) >> 8)); //[3:0] MSB of image vertical physical resolution in memory
|
||
|
|
fsa506_write_reg(0x37, (uint8_t)(2 * YSIZE_PHYS)); //[7:0] LSB of image vertical physical resolution in memory
|
||
|
|
|
||
|
|
fsa506_fillscreen(0);
|
||
|
|
|
||
|
|
SET_DISP_ON;
|
||
|
|
|
||
|
|
SET_BACKLIGHT_ON;
|
||
|
|
|
||
|
|
return RT_EOK;
|
||
|
|
}
|
||
|
|
|
||
|
|
#if defined(NU_PKG_FSA506_WITH_OFFSCREEN_FRAMEBUFFER)
|
||
|
|
static void fsa506_fillrect(uint16_t *pixels, struct rt_device_rect_info *pRectInfo)
|
||
|
|
{
|
||
|
|
fsa506_set_column(pRectInfo->x, pRectInfo->x + pRectInfo->width - 1);
|
||
|
|
fsa506_set_page(pRectInfo->y, pRectInfo->y + pRectInfo->height - 1);
|
||
|
|
|
||
|
|
fsa506_send_cmd(0xC1);
|
||
|
|
fsa506_send_pixels(pixels, pRectInfo->height * pRectInfo->width * 2);
|
||
|
|
fsa506_send_cmd_done();
|
||
|
|
}
|
||
|
|
#endif
|
||
|
|
|
||
|
|
static void fsa506_fillscreen(rt_uint16_t color)
|
||
|
|
{
|
||
|
|
#if defined(NU_PKG_FSA506_WITH_OFFSCREEN_FRAMEBUFFER)
|
||
|
|
struct rt_device_rect_info rectinfo;
|
||
|
|
int filled_line_num = 0;
|
||
|
|
|
||
|
|
while (filled_line_num < YSIZE_PHYS)
|
||
|
|
{
|
||
|
|
int pixel_count;
|
||
|
|
rectinfo.x = 0;
|
||
|
|
rectinfo.y = filled_line_num;
|
||
|
|
rectinfo.width = XSIZE_PHYS;
|
||
|
|
rectinfo.height = (NU_PKG_FSA506_LINE_BUFFER_NUMBER < YSIZE_PHYS) ? NU_PKG_FSA506_LINE_BUFFER_NUMBER : YSIZE_PHYS;
|
||
|
|
|
||
|
|
pixel_count = XSIZE_PHYS * NU_PKG_FSA506_LINE_BUFFER_NUMBER;
|
||
|
|
rt_uint16_t *pu16ShadowBuf = (rt_uint16_t *)g_FSA506Info.framebuffer;
|
||
|
|
|
||
|
|
while (pixel_count > 0)
|
||
|
|
{
|
||
|
|
*pu16ShadowBuf++ = color;
|
||
|
|
pixel_count--;
|
||
|
|
}
|
||
|
|
fsa506_fillrect((uint16_t *)g_FSA506Info.framebuffer, &rectinfo);
|
||
|
|
filled_line_num += NU_PKG_FSA506_LINE_BUFFER_NUMBER;
|
||
|
|
}
|
||
|
|
#else
|
||
|
|
fsa506_set_column(0, (XSIZE_PHYS - 1));
|
||
|
|
fsa506_set_page(0, (YSIZE_PHYS - 1));
|
||
|
|
|
||
|
|
fsa506_send_cmd(0xC1);
|
||
|
|
for (int i = 0; i < (XSIZE_PHYS * YSIZE_PHYS); i++)
|
||
|
|
fsa506_send_pixel_data(color);
|
||
|
|
fsa506_send_cmd_done();
|
||
|
|
#endif
|
||
|
|
}
|
||
|
|
|
||
|
|
static void fsa506_lcd_set_pixel(const char *color, int x, int y)
|
||
|
|
{
|
||
|
|
fsa506_set_column(x, x);
|
||
|
|
fsa506_set_page(y, y);
|
||
|
|
|
||
|
|
fsa506_send_cmd(0xC1);
|
||
|
|
fsa506_send_pixel_data(*(uint16_t *)color);
|
||
|
|
fsa506_send_cmd_done();
|
||
|
|
}
|
||
|
|
|
||
|
|
static void fsa506_lcd_draw_hline(const char *pixel, int x1, int x2, int y)
|
||
|
|
{
|
||
|
|
fsa506_set_column(x1, x2);
|
||
|
|
fsa506_set_page(y, y);
|
||
|
|
|
||
|
|
fsa506_send_cmd(0xC1);
|
||
|
|
for (; x1 < x2; x1++)
|
||
|
|
fsa506_send_pixel_data(*(uint16_t *)pixel);
|
||
|
|
fsa506_send_cmd_done();
|
||
|
|
}
|
||
|
|
|
||
|
|
static void fsa506_lcd_draw_vline(const char *pixel, int x, int y1, int y2)
|
||
|
|
{
|
||
|
|
fsa506_set_column(x, x);
|
||
|
|
fsa506_set_page(y1, y2);
|
||
|
|
|
||
|
|
fsa506_send_cmd(0xC1);
|
||
|
|
for (; y1 < y2; y1++)
|
||
|
|
fsa506_send_pixel_data(*(uint16_t *)pixel);
|
||
|
|
fsa506_send_cmd_done();
|
||
|
|
}
|
||
|
|
|
||
|
|
static void fsa506_lcd_blit_line(const char *pixels, int x, int y, rt_size_t size)
|
||
|
|
{
|
||
|
|
rt_uint16_t *ptr = (rt_uint16_t *)pixels;
|
||
|
|
|
||
|
|
fsa506_set_column(x, x + size);
|
||
|
|
fsa506_set_page(y, y);
|
||
|
|
|
||
|
|
fsa506_send_cmd(0xC1);
|
||
|
|
while (size--)
|
||
|
|
fsa506_send_pixel_data(*ptr++);
|
||
|
|
fsa506_send_cmd_done();
|
||
|
|
}
|
||
|
|
|
||
|
|
static rt_err_t fsa506_lcd_open(rt_device_t dev, rt_uint16_t oflag)
|
||
|
|
{
|
||
|
|
return RT_EOK;
|
||
|
|
}
|
||
|
|
|
||
|
|
static rt_err_t fsa506_lcd_close(rt_device_t dev)
|
||
|
|
{
|
||
|
|
return RT_EOK;
|
||
|
|
}
|
||
|
|
|
||
|
|
static rt_err_t fsa506_lcd_control(rt_device_t dev, int cmd, void *args)
|
||
|
|
{
|
||
|
|
switch (cmd)
|
||
|
|
{
|
||
|
|
case RTGRAPHIC_CTRL_GET_INFO:
|
||
|
|
{
|
||
|
|
struct rt_device_graphic_info *info;
|
||
|
|
|
||
|
|
info = (struct rt_device_graphic_info *) args;
|
||
|
|
RT_ASSERT(info != RT_NULL);
|
||
|
|
rt_memcpy(args, (void *)&g_FSA506Info, sizeof(struct rt_device_graphic_info));
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
|
||
|
|
case RTGRAPHIC_CTRL_RECT_UPDATE:
|
||
|
|
{
|
||
|
|
#if defined(NU_PKG_FSA506_WITH_OFFSCREEN_FRAMEBUFFER)
|
||
|
|
struct rt_device_rect_info *psRectInfo = (struct rt_device_rect_info *)args;
|
||
|
|
rt_uint16_t *pixels = (rt_uint16_t *)g_FSA506Info.framebuffer;
|
||
|
|
RT_ASSERT(args);
|
||
|
|
|
||
|
|
fsa506_fillrect(pixels, psRectInfo);
|
||
|
|
#else
|
||
|
|
/* nothong to be done */
|
||
|
|
#endif
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
|
||
|
|
default:
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
|
||
|
|
return RT_EOK;
|
||
|
|
}
|
||
|
|
|
||
|
|
static struct rt_device lcd_device;
|
||
|
|
static struct rt_device_graphic_ops fsa506_ops =
|
||
|
|
{
|
||
|
|
fsa506_lcd_set_pixel,
|
||
|
|
fsa506_lcd_get_pixel,
|
||
|
|
fsa506_lcd_draw_hline,
|
||
|
|
fsa506_lcd_draw_vline,
|
||
|
|
fsa506_lcd_blit_line
|
||
|
|
};
|
||
|
|
|
||
|
|
int rt_hw_lcd_fsa506_init(void)
|
||
|
|
{
|
||
|
|
fsa506_pin_init();
|
||
|
|
|
||
|
|
/* register lcd device */
|
||
|
|
lcd_device.type = RT_Device_Class_Graphic;
|
||
|
|
lcd_device.init = fsa506_lcd_init;
|
||
|
|
lcd_device.open = fsa506_lcd_open;
|
||
|
|
lcd_device.close = fsa506_lcd_close;
|
||
|
|
lcd_device.control = fsa506_lcd_control;
|
||
|
|
lcd_device.read = RT_NULL;
|
||
|
|
lcd_device.write = RT_NULL;
|
||
|
|
|
||
|
|
lcd_device.user_data = &fsa506_ops;
|
||
|
|
|
||
|
|
#if defined(NU_PKG_FSA506_WITH_OFFSCREEN_FRAMEBUFFER)
|
||
|
|
g_FSA506Info.framebuffer = rt_malloc_align((g_FSA506Info.pitch * NU_PKG_FSA506_LINE_BUFFER_NUMBER) + 32, 32);
|
||
|
|
RT_ASSERT(g_FSA506Info.framebuffer != RT_NULL);
|
||
|
|
g_FSA506Info.smem_len = g_FSA506Info.pitch * NU_PKG_FSA506_LINE_BUFFER_NUMBER;
|
||
|
|
#endif
|
||
|
|
|
||
|
|
/* register graphic device driver */
|
||
|
|
rt_device_register(&lcd_device, "lcd", RT_DEVICE_FLAG_RDWR | RT_DEVICE_FLAG_STANDALONE);
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
#ifdef RT_USING_FINSH
|
||
|
|
#define LINE_LEN 32
|
||
|
|
static void lcd_test(int argc, char *argv[])
|
||
|
|
{
|
||
|
|
uint16_t pixels[LINE_LEN];
|
||
|
|
uint16_t color;
|
||
|
|
int x, y, i;
|
||
|
|
x = y = 100;
|
||
|
|
|
||
|
|
fsa506_lcd_init(NULL);
|
||
|
|
|
||
|
|
color = 0x0; //Black, RGB
|
||
|
|
rt_kprintf("Brush 0x%X on screen.\n", color);
|
||
|
|
fsa506_fillscreen(color);
|
||
|
|
fsa506_lcd_get_pixel((char *)&color, x, y);
|
||
|
|
rt_kprintf("lcd get pixel, pixel: 0x%X, x: %d, y: %d\n", color, x, y);
|
||
|
|
|
||
|
|
color = 0xffff; //White, RGB
|
||
|
|
rt_kprintf("Brush 0x%X on screen.\n", color);
|
||
|
|
fsa506_fillscreen(color);
|
||
|
|
fsa506_lcd_get_pixel((char *)&color, x, y);
|
||
|
|
rt_kprintf("lcd get pixel, pixel: 0x%X, x: %d, y: %d\n", color, x, y);
|
||
|
|
|
||
|
|
color = 0x1f; //Blue, RGB
|
||
|
|
rt_kprintf("Brush 0x%X on screen.\n", color);
|
||
|
|
fsa506_fillscreen(color);
|
||
|
|
fsa506_lcd_get_pixel((char *)&color, x, y);
|
||
|
|
rt_kprintf("lcd get pixel, pixel: 0x%X, x: %d, y: %d\n", color, x, y);
|
||
|
|
|
||
|
|
color = 0x07e0; //Green, RGB
|
||
|
|
rt_kprintf("Brush 0x%X on screen.\n", color);
|
||
|
|
fsa506_fillscreen(color);
|
||
|
|
fsa506_lcd_get_pixel((char *)&color, x, y);
|
||
|
|
rt_kprintf("lcd get pixel, pixel: 0x%X, x: %d, y: %d\n", color, x, y);
|
||
|
|
|
||
|
|
color = 0xf800; //Red, RGB
|
||
|
|
rt_kprintf("Brush 0x%X on screen.\n", color);
|
||
|
|
fsa506_fillscreen(color);
|
||
|
|
fsa506_lcd_get_pixel((char *)&color, x, y);
|
||
|
|
rt_kprintf("lcd get pixel, pixel: 0x%X, x: %d, y: %d\n", color, x, y);
|
||
|
|
|
||
|
|
color = 0xffff; //White, RGB
|
||
|
|
rt_kprintf("lcd draw hline, pixel: 0x%X, x1: %d, x2: %d, y: %d\n", color, x, x + 20, y);
|
||
|
|
fsa506_lcd_draw_hline((const char *)&color, x, x + 20, y);
|
||
|
|
|
||
|
|
color = 0xffff; //White, RGB
|
||
|
|
rt_kprintf("lcd draw vline, pixel: 0x%X, x: %d, y: %d\n", color, y, y + 20);
|
||
|
|
fsa506_lcd_draw_vline((const char *)&color, x, y, y + 20);
|
||
|
|
|
||
|
|
for (i = 0; i < LINE_LEN; i++)
|
||
|
|
pixels[i] = 20 + i * 5;
|
||
|
|
|
||
|
|
x = y = 50;
|
||
|
|
rt_kprintf("lcd blit line, start: x: %d, y: %d\n", x, y);
|
||
|
|
fsa506_lcd_blit_line((const char *)&pixels[0], x, y, LINE_LEN);
|
||
|
|
|
||
|
|
x = y = 200;
|
||
|
|
color = 0x07E0; //Green, RGB
|
||
|
|
rt_kprintf("lcd set pixel, pixel: 0x%X, x: %d, y: %d\n", color, x, y);
|
||
|
|
fsa506_lcd_set_pixel((const char *)&color, x, y);
|
||
|
|
color = 0x0;
|
||
|
|
fsa506_lcd_get_pixel((char *)&color, x, y);
|
||
|
|
rt_kprintf("lcd get pixel, pixel: 0x%X, x: %d, y: %d\n", color, x, y);
|
||
|
|
|
||
|
|
x = y = 200;
|
||
|
|
color = 0x1f; //Blue, RGB
|
||
|
|
rt_kprintf("lcd set pixel, pixel: 0x%X, x: %d, y: %d\n", color, x, y);
|
||
|
|
fsa506_lcd_set_pixel((const char *)&color, x, y);
|
||
|
|
color = 0x0;
|
||
|
|
fsa506_lcd_get_pixel((char *)&color, x, y);
|
||
|
|
rt_kprintf("lcd get pixel, pixel: 0x%X, x: %d, y: %d\n", color, x, y);
|
||
|
|
|
||
|
|
x = y = 200;
|
||
|
|
color = 0xf800; //Red, RGB
|
||
|
|
rt_kprintf("lcd set pixel, pixel: 0x%X, x: %d, y: %d\n", color, x, y);
|
||
|
|
fsa506_lcd_set_pixel((const char *)&color, x, y);
|
||
|
|
color = 0x0;
|
||
|
|
fsa506_lcd_get_pixel((char *)&color, x, y);
|
||
|
|
rt_kprintf("lcd get pixel, pixel: 0x%X, x: %d, y: %d\n", color, x, y);
|
||
|
|
}
|
||
|
|
MSH_CMD_EXPORT(lcd_test, test lcd display);
|
||
|
|
#endif
|
||
|
|
|
||
|
|
#endif /* if defined(NU_PKG_USING_FSA506) */
|