Context Navigation

← Previous Revision
Latest Revision
Next Revision →
Blame
Revision Log

stlcd_st7789h2.c@ 457

Last change on this file since 457 was 457, checked in by coas-nagasima, 4 years ago
ファイルを追加
Property svn:eol-style set to `native` Property svn:mime-type set to `text/x-csrc;charset=UTF-8`
File size: 40.8 KB

Line
1	/*
2	* TOPPERS BASE PLATFORM MIDDLEWARE
3	*
4	* Copyright (C) 2017-2018 by TOPPERS PROJECT
5	* Educational Working Group.
6	*
7	* 上記著作権者は，以下の(1)～(4)の条件を満たす場合に限り，本ソフトウェ
8	* ア（本ソフトウェアを改変したものを含む．以下同じ）を使用・複製・改
9	* 変・再配布（以下，利用と呼ぶ）することを無償で許諾する．
10	* (1) 本ソフトウェアをソースコードの形で利用する場合には，上記の著作
11	* 権表示，この利用条件および下記の無保証規定が，そのままの形でソー
12	* スコード中に含まれていること．
13	* (2) 本ソフトウェアを，ライブラリ形式など，他のソフトウェア開発に使
14	* 用できる形で再配布する場合には，再配布に伴うドキュメント（利用
15	* 者マニュアルなど）に，上記の著作権表示，この利用条件および下記
16	* の無保証規定を掲載すること．
17	* (3) 本ソフトウェアを，機器に組み込むなど，他のソフトウェア開発に使
18	* 用できない形で再配布する場合には，次のいずれかの条件を満たすこ
19	* と．
20	* (a) 再配布に伴うドキュメント（利用者マニュアルなど）に，上記の著
21	* 作権表示，この利用条件および下記の無保証規定を掲載すること．
22	* (b) 再配布の形態を，別に定める方法によって，TOPPERSプロジェクトに
23	* 報告すること．
24	* (4) 本ソフトウェアの利用により直接的または間接的に生じるいかなる損
25	* 害からも，上記著作権者およびTOPPERSプロジェクトを免責すること．
26	* また，本ソフトウェアのユーザまたはエンドユーザからのいかなる理
27	* 由に基づく請求からも，上記著作権者およびTOPPERSプロジェクトを
28	* 免責すること．
29	*
30	* 本ソフトウェアは，無保証で提供されているものである．上記著作権者お
31	* よびTOPPERSプロジェクトは，本ソフトウェアに関して，特定の使用目的
32	* に対する適合性も含めて，いかなる保証も行わない．また，本ソフトウェ
33	* アの利用により直接的または間接的に生じたいかなる損害に関しても，そ
34	* の責任を負わない．
35	*
36	* @(#) $Id$
37	*/
38	/**
39	******************************************************************************
40	* @attention
41	*
42	* <h2><center>© COPYRIGHT(c) 2016 STMicroelectronics</center></h2>
43	*
44	* Redistribution and use in source and binary forms, with or without modification,
45	* are permitted provided that the following conditions are met:
46	* 1. Redistributions of source code must retain the above copyright notice,
47	* this list of conditions and the following disclaimer.
48	* 2. Redistributions in binary form must reproduce the above copyright notice,
49	* this list of conditions and the following disclaimer in the documentation
50	* and/or other materials provided with the distribution.
51	* 3. Neither the name of STMicroelectronics nor the names of its contributors
52	* may be used to endorse or promote products derived from this software
53	* without specific prior written permission.
54	*
55	* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
56	* AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
57	* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
58	* DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
59	* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
60	* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
61	* SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
62	* CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
63	* OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
64	* OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
65	*
66	******************************************************************************
67	*/
68
69	#include "stlcd_st7789h2.h"
70
71	#define sil_orw_mem(a, b) sil_wrw_mem((a), sil_rew_mem(a) \| (b))
72	#define sil_andw_mem(a, b) sil_wrw_mem((a), sil_rew_mem(a) & ~(b))
73	#define sil_modw_mem(a, b, c) sil_wrw_mem((a), (sil_rew_mem(a) & (~b)) \| (c))
74
75
76	#define POLY_X(Z) ((int32_t)((Points + Z)->X))
77	#define POLY_Y(Z) ((int32_t)((Points + Z)->Y))
78	#define ABS(X) ((X) > 0 ? (X) : -(X))
79
80	#define FMC_BANK2_BASE ((uint32_t)(0x60000000 \| 0x04000000))
81	#define GPIO_AF12_FMC ((uint8_t)0xCU) /* FMC Alternate Function mapping */
82
83	#define GIOD_PINMAP (GPIO_PIN_0 \| GPIO_PIN_1 \| GPIO_PIN_4 \| GPIO_PIN_5 \| GPIO_PIN_7 \| GPIO_PIN_8 \|\
84	GPIO_PIN_9 \| GPIO_PIN_10 \| GPIO_PIN_11 \| GPIO_PIN_12 \| GPIO_PIN_14 \| GPIO_PIN_15)
85	#define GIOE_PINMAP (GPIO_PIN_0 \| GPIO_PIN_1 \| GPIO_PIN_7 \| GPIO_PIN_8 \| GPIO_PIN_9 \|GPIO_PIN_10 \|\
86	GPIO_PIN_11 \| GPIO_PIN_12 \|GPIO_PIN_13 \| GPIO_PIN_14 \| GPIO_PIN_15)
87	#define GIOF_PINMAP (GPIO_PIN_0 \| GPIO_PIN_1 \| GPIO_PIN_2 \| GPIO_PIN_3 \| GPIO_PIN_4 \| GPIO_PIN_5 \|\
88	GPIO_PIN_12 \| GPIO_PIN_13 \| GPIO_PIN_14 \| GPIO_PIN_15)
89	#define GIOG_PINMAP (GPIO_PIN_0 \| GPIO_PIN_1 \| GPIO_PIN_2 \| GPIO_PIN_3 \| GPIO_PIN_4 \| GPIO_PIN_5 \| GPIO_PIN_9)
90
91
92	typedef struct {
93	uint8_t red;
94	uint8_t green;
95	uint8_t blue;
96	} ST7789H2_Rgb888;
97
98	#define LCD_IO_WriteData(b, r) do { \
99	sil_wrh_mem((uint16_t *)((b)->fmc_base+2), (r)); \
100	asm ("dsb 0xF":::"memory"); \
101	} while(0)
102
103	#define LCD_IO_WriteReg(b, r) do { \
104	sil_wrh_mem((uint16_t *)((b)->fmc_base), (r)); \
105	asm ("dsb 0xF":::"memory"); \
106	} while(0)
107
108	#define LCD_IO_ReadData(b) (uint16_t)sil_reh_mem((uint16_t *)((b)->fmc_base+2))
109
110
111	/** @defgroup STM32F723E_DISCOVERY_LCD_Private_FunctionPrototypes STM32F723E Discovery Lcd Private Prototypes
112	* @{
113	*/
114
115	static void FillTriangle(LCD_DrawProp_t *pDrawProp, uint16_t x1, uint16_t x2, uint16_t x3, uint16_t y1, uint16_t y2, uint16_t y3);
116
117
118	/**
119	* @brief Initializes LCD low level.
120	* @retval None
121	*/
122	static void LCD_IO_Init(void)
123	{
124	GPIO_Init_t GPIO_Init_Data;
125	uint32_t pin, i;
126	uint32_t tmpr = 0;
127
128	/* Enable FMC clock */
129	sil_orw_mem((uint32_t *)(TADR_RCC_BASE+TOFF_RCC_AHB3ENR), RCC_AHB3ENR_FMCEN);
130
131	/* Enable FSMC clock */
132	sil_orw_mem((uint32_t *)(TADR_RCC_BASE+TOFF_RCC_AHB3ENR), RCC_AHB3ENR_FMCEN);
133	sil_orw_mem((uint32_t *)(TADR_RCC_BASE+TOFF_RCC_AHB3RSTR), RCC_AHB3RSTR_FMCRST);
134	sil_andw_mem((uint32_t *)(TADR_RCC_BASE+TOFF_RCC_AHB3RSTR), RCC_AHB3RSTR_FMCRST);
135
136	/* Enable GPIOs clock */
137	sil_orw_mem((uint32_t *)(TADR_RCC_BASE+TOFF_RCC_AHB1ENR), RCC_AHB1ENR_GPIODEN);
138	sil_orw_mem((uint32_t *)(TADR_RCC_BASE+TOFF_RCC_AHB1ENR), RCC_AHB1ENR_GPIOEEN);
139	sil_orw_mem((uint32_t *)(TADR_RCC_BASE+TOFF_RCC_AHB1ENR), RCC_AHB1ENR_GPIOFEN);
140	sil_orw_mem((uint32_t *)(TADR_RCC_BASE+TOFF_RCC_AHB1ENR), RCC_AHB1ENR_GPIOGEN);
141
142	GPIO_Init_Data.mode = GPIO_MODE_AF;
143	GPIO_Init_Data.pull = GPIO_PULLUP;
144	GPIO_Init_Data.otype = GPIO_OTYPE_PP;
145	GPIO_Init_Data.speed = GPIO_SPEED_HIGH;
146	GPIO_Init_Data.alternate = GPIO_AF12_FMC;
147
148	/* GPIOD configuration */
149	/* LCD_PSRAM_D2, LCD_PSRAM_D3, LCD_PSRAM_NOE, LCD_PSRAM_NWE, PSRAM_NE1, LCD_PSRAM_D13,
150	LCD_PSRAM_D14, LCD_PSRAM_D15, PSRAM_A16, PSRAM_A17, LCD_PSRAM_D0, LCD_PSRAM_D1 */
151	pin = GIOD_PINMAP;
152	for(i = 0 ; i < 16 ; i++){
153	if((pin & (1<<i)) != 0)
154	gpio_setup(TADR_GPIOD_BASE, &GPIO_Init_Data, i);
155	}
156
157	/* GPIOE configuration */
158	/* PSRAM_NBL0, PSRAM_NBL1, LCD_PSRAM_D4, LCD_PSRAM_D5, LCD_PSRAM_D6, LCD_PSRAM_D7,
159	LCD_PSRAM_D8, LCD_PSRAM_D9, LCD_PSRAM_D10, LCD_PSRAM_D11, LCD_PSRAM_D12 */
160	pin = GIOE_PINMAP;
161	for(i = 0 ; i < 16 ; i++){
162	if((pin & (1<<i)) != 0)
163	gpio_setup(TADR_GPIOE_BASE, &GPIO_Init_Data, i);
164	}
165
166	/* GPIOF configuration */
167	/* PSRAM_A0, PSRAM_A1, PSRAM_A2, PSRAM_A3, PSRAM_A4, PSRAM_A5,
168	PSRAM_A6, PSRAM_A7, PSRAM_A8, PSRAM_A9 */
169	pin = GIOF_PINMAP;
170	for(i = 0 ; i < 16 ; i++){
171	if((pin & (1<<i)) != 0)
172	gpio_setup(TADR_GPIOF_BASE, &GPIO_Init_Data, i);
173	}
174
175	/* GPIOG configuration */
176	/* PSRAM_A10, PSRAM_A11, PSRAM_A12, PSRAM_A13, PSRAM_A14, PSRAM_A15, LCD_NE */
177	pin = GIOG_PINMAP;
178	for(i = 0 ; i < 16 ; i++){
179	if((pin & (1<<i)) != 0)
180	gpio_setup(TADR_GPIOG_BASE, &GPIO_Init_Data, i);
181	}
182
183	/* Initialize SRAM control Interface */
184	tmpr = sil_rew_mem((uint32_t *)(TADR_FMC_R_BASE+TOFF_FMC_R_BTCR2));
185
186	/* Clear MBKEN, MUXEN, MTYP, MWID, FACCEN, BURSTEN, WAITPOL, WAITCFG, WREN,
187	WAITEN, EXTMOD, ASYNCWAIT, CBURSTRW and CCLKEN bits */
188	tmpr &= ((uint32_t)~(FMC_BCR1_MBKEN \| FMC_BCR1_MUXEN \| FMC_BCR1_MTYP \| \
189	FMC_BCR1_MWID \| FMC_BCR1_FACCEN \| FMC_BCR1_BURSTEN \| \
190	FMC_BCR1_WAITPOL \| FMC_BCR1_CPSIZE \| FMC_BCR1_WAITCFG \| \
191	FMC_BCR1_WREN \| FMC_BCR1_WAITEN \| FMC_BCR1_EXTMOD \| \
192	FMC_BCR1_ASYNCWAIT \| FMC_BCR1_CBURSTRW \| FMC_BCR1_CCLKEN \| FMC_BCR1_WFDIS));
193
194	/* Set NORSRAM device control parameters */
195	tmpr \|= (uint32_t)(FMC_BCR1_MWID_0 \| FMC_BCR1_WREN \| FMC_BCR1_WFDIS);
196
197	sil_wrw_mem((uint32_t *)(TADR_FMC_R_BASE+TOFF_FMC_R_BTCR2), tmpr);
198
199	/* Configure synchronous mode when Continuous clock is enabled for bank2..4 */
200	sil_orw_mem((uint32_t *)(TADR_FMC_R_BASE+TOFF_FMC_R_BTCR0), FMC_BCR1_WFDIS);
201
202	/* Get the BTCR register value */
203	tmpr = sil_rew_mem((uint32_t *)(TADR_FMC_R_BASE+TOFF_FMC_R_BTCR3));
204
205	/* Clear ADDSET, ADDHLD, DATAST, BUSTURN, CLKDIV, DATLAT and ACCMOD bits */
206	tmpr &= ((uint32_t)~(FMC_BTR1_ADDSET \| FMC_BTR1_ADDHLD \| FMC_BTR1_DATAST \| \
207	FMC_BTR1_BUSTURN \| FMC_BTR1_CLKDIV \| FMC_BTR1_DATLAT \| \
208	FMC_BTR1_ACCMOD));
209
210	/* Set FMC_NORSRAM device timing parameters */
211	tmpr \|= (uint32_t)(9 /* AddressSetupTime */ \|\
212	((2 /* AddressHoldTime */ ) << 4) \|\
213	((6 /* DataSetupTime */ ) << 8) \|\
214	((1 /* BusTurnAroundDuration */ ) << 16) \|\
215	(((2 /* CLKDivision */ )-1) << 20) \|\
216	(((2 /* DataLatency */)-2) << 24));
217
218	sil_wrw_mem((uint32_t *)(TADR_FMC_R_BASE+TOFF_FMC_R_BTCR3), tmpr);
219
220	/* Configure Clock division value (in NORSRAM bank 1) when continuous clock is enabled */
221	if((sil_rew_mem((uint32_t *)(TADR_FMC_R_BASE+TOFF_FMC_R_BTCR1)) & FMC_BCR1_CCLKEN) != 0){
222	tmpr = sil_rew_mem((uint32_t *)(TADR_FMC_R_BASE+TOFF_FMC_R_BTCR1));
223	tmpr &= ~(((uint32_t)0x0F) << 20);
224	tmpr \|= (uint32_t)(((2 /* CLKDivision */ )-1) << 20);
225	sil_wrw_mem((uint32_t *)(TADR_FMC_R_BASE+TOFF_FMC_R_BTCR1), tmpr);
226	}
227
228	/* Initialize SRAM extended mode timing Interface */
229	sil_wrw_mem((uint32_t *)(TADR_FMC_R_BASE+TOFF_FMC_R_BWTR2), 0xFFFFFFFF);
230
231	/* Enable the NORSRAM device */
232	sil_orw_mem((uint32_t *)(TADR_FMC_R_BASE+TOFF_FMC_R_BTCR2), FMC_BCR1_MBKEN);
233	}
234
235
236	/**
237	* @brief Writes to the selected LCD register.
238	* @param Command: command value (or register address as named in st7789h2 doc).
239	* @param Parameters: pointer on parameters value (if command uses one or several parameters).
240	* @param NbParameters: number of command parameters (0 if no parameter)
241	* @retval None
242	*/
243	static void
244	ST7789H2_WriteReg(LCD_Handler_t hlcd, uint8_t Command, uint8_t Parameters, uint8_t NbParameters)
245	{
246	uint8_t i;
247
248	/* Send command */
249	LCD_IO_WriteReg(hlcd, Command);
250
251	/* Send command's parameters if any */
252	for(i = 0 ; i<NbParameters; i++){
253	LCD_IO_WriteData(hlcd, Parameters[i]);
254	}
255	}
256
257	/**
258	* @brief Reads the selected LCD Register.
259	* @param Command: command value (or register address as named in st7789h2 doc).
260	* @retval Register Value.
261	*/
262	static uint8_t
263	ST7789H2_ReadReg(LCD_Handler_t *hlcd, uint8_t Command)
264	{
265	/* Send command */
266	LCD_IO_WriteReg(hlcd, Command);
267
268	/* Read dummy data */
269	LCD_IO_ReadData(hlcd);
270
271	/* Read register value */
272	return (LCD_IO_ReadData(hlcd));
273	}
274
275	/**
276	* @brief Initialize the st7789h2 LCD Component.
277	* @param None
278	* @retval None
279	*/
280	static void
281	ST7789H2_Init(LCD_Handler_t *hlcd)
282	{
283	uint8_t parameter[14];
284
285	/* Initialize st7789h2 low level bus layer ----------------------------------*/
286	/* Sleep In Command */
287	ST7789H2_WriteReg(hlcd, ST7789H2_SLEEP_IN, (uint8_t*)NULL, 0);
288	/* Wait for 10ms */
289	dly_tsk(10);
290
291	/* SW Reset Command */
292	ST7789H2_WriteReg(hlcd, 0x01, (uint8_t*)NULL, 0);
293	/* Wait for 200ms */
294	dly_tsk(200);
295
296	/* Sleep Out Command */
297	ST7789H2_WriteReg(hlcd, ST7789H2_SLEEP_OUT, (uint8_t*)NULL, 0);
298	/* Wait for 120ms */
299	dly_tsk(120);
300
301	/* Normal display for Driver Down side */
302	parameter[0] = 0x00;
303	ST7789H2_WriteReg(hlcd, ST7789H2_NORMAL_DISPLAY, parameter, 1);
304
305	/* Color mode 16bits/pixel */
306	parameter[0] = 0x05;
307	ST7789H2_WriteReg(hlcd, ST7789H2_COLOR_MODE, parameter, 1);
308
309	/* Display inversion On */
310	ST7789H2_WriteReg(hlcd, ST7789H2_DISPLAY_INVERSION, (uint8_t*)NULL, 0);
311
312	/* Set Column address CASET */
313	parameter[0] = 0x00;
314	parameter[1] = 0x00;
315	parameter[2] = 0x00;
316	parameter[3] = 0xEF;
317	ST7789H2_WriteReg(hlcd, ST7789H2_CASET, parameter, 4);
318	/* Set Row address RASET */
319	parameter[0] = 0x00;
320	parameter[1] = 0x00;
321	parameter[2] = 0x00;
322	parameter[3] = 0xEF;
323	ST7789H2_WriteReg(hlcd, ST7789H2_RASET, parameter, 4);
324
325	/--------------- ST7789H2 Frame rate setting -------------------------------/
326	/* PORCH control setting */
327	parameter[0] = 0x0C;
328	parameter[1] = 0x0C;
329	parameter[2] = 0x00;
330	parameter[3] = 0x33;
331	parameter[4] = 0x33;
332	ST7789H2_WriteReg(hlcd, ST7789H2_PORCH_CTRL, parameter, 5);
333
334	/* GATE control setting */
335	parameter[0] = 0x35;
336	ST7789H2_WriteReg(hlcd, ST7789H2_GATE_CTRL, parameter, 1);
337
338	/--------------- ST7789H2 Power setting ------------------------------------/
339	/* VCOM setting */
340	parameter[0] = 0x1F;
341	ST7789H2_WriteReg(hlcd, ST7789H2_VCOM_SET, parameter, 1);
342
343	/* LCM Control setting */
344	parameter[0] = 0x2C;
345	ST7789H2_WriteReg(hlcd, ST7789H2_LCM_CTRL, parameter, 1);
346
347	/* VDV and VRH Command Enable */
348	parameter[0] = 0x01;
349	parameter[1] = 0xC3;
350	ST7789H2_WriteReg(hlcd, ST7789H2_VDV_VRH_EN, parameter, 2);
351
352	/* VDV Set */
353	parameter[0] = 0x20;
354	ST7789H2_WriteReg(hlcd, ST7789H2_VDV_SET, parameter, 1);
355
356	/* Frame Rate Control in normal mode */
357	parameter[0] = 0x0F;
358	ST7789H2_WriteReg(hlcd, ST7789H2_FR_CTRL, parameter, 1);
359
360	/* Power Control */
361	parameter[0] = 0xA4;
362	parameter[1] = 0xA1;
363	ST7789H2_WriteReg(hlcd, ST7789H2_POWER_CTRL, parameter, 1);
364
365	/--------------- ST7789H2 Gamma setting ------------------------------------/
366	/* Positive Voltage Gamma Control */
367	parameter[0] = 0xD0;
368	parameter[1] = 0x08;
369	parameter[2] = 0x11;
370	parameter[3] = 0x08;
371	parameter[4] = 0x0C;
372	parameter[5] = 0x15;
373	parameter[6] = 0x39;
374	parameter[7] = 0x33;
375	parameter[8] = 0x50;
376	parameter[9] = 0x36;
377	parameter[10] = 0x13;
378	parameter[11] = 0x14;
379	parameter[12] = 0x29;
380	parameter[13] = 0x2D;
381	ST7789H2_WriteReg(hlcd, ST7789H2_PV_GAMMA_CTRL, parameter, 14);
382
383	/* Negative Voltage Gamma Control */
384	parameter[0] = 0xD0;
385	parameter[1] = 0x08;
386	parameter[2] = 0x10;
387	parameter[3] = 0x08;
388	parameter[4] = 0x06;
389	parameter[5] = 0x06;
390	parameter[6] = 0x39;
391	parameter[7] = 0x44;
392	parameter[8] = 0x51;
393	parameter[9] = 0x0B;
394	parameter[10] = 0x16;
395	parameter[11] = 0x14;
396	parameter[12] = 0x2F;
397	parameter[13] = 0x31;
398	ST7789H2_WriteReg(hlcd, ST7789H2_NV_GAMMA_CTRL, parameter, 14);
399
400	/* Display ON command */
401	lcd_displayOn(hlcd);
402
403	/* Tearing Effect Line On: Option (00h:VSYNC Interface OFF, 01h:VSYNC Interface ON) */
404	parameter[0] = 0x00;
405	ST7789H2_WriteReg(hlcd, ST7789H2_TEARING_EFFECT, parameter, 1);
406	}
407
408	/**
409	* @brief Set the Display Orientation.
410	* @param orientation: ST7789H2_ORIENTATION_PORTRAIT, ST7789H2_ORIENTATION_LANDSCAPE
411	* or ST7789H2_ORIENTATION_LANDSCAPE_ROT180
412	* @retval None
413	*/
414	static void
415	ST7789H2_SetOrientation(LCD_Handler_t *hlcd, uint32_t orientation)
416	{
417	uint8_t parameter[6];
418
419	if(orientation == ST7789H2_ORIENTATION_LANDSCAPE){
420	parameter[0] = 0x00;
421	}
422	else if(orientation == ST7789H2_ORIENTATION_LANDSCAPE_ROT180){
423	/* Vertical Scrolling Definition */
424	/* TFA describes the Top Fixed Area */
425	parameter[0] = 0x00;
426	parameter[1] = 0x00;
427	/* VSA describes the height of the Vertical Scrolling Area */
428	parameter[2] = 0x01;
429	parameter[3] = 0xF0;
430	/* BFA describes the Bottom Fixed Area */
431	parameter[4] = 0x00;
432	parameter[5] = 0x00;
433	ST7789H2_WriteReg(hlcd, ST7789H2_VSCRDEF, parameter, 6);
434
435	/* Vertical Scroll Start Address of RAM */
436	/* GRAM row nbr (320) - Display row nbr (240) = 80 = 0x50 */
437	parameter[0] = 0x00;
438	parameter[1] = 0x50;
439	ST7789H2_WriteReg(hlcd, ST7789H2_VSCSAD, parameter, 2);
440
441	parameter[0] = 0xC0;
442	}
443	else{
444	parameter[0] = 0x60;
445	}
446	ST7789H2_WriteReg(hlcd, ST7789H2_NORMAL_DISPLAY, parameter, 1);
447	}
448
449	/**
450	* @brief Set Cursor position.
451	* @param Xpos: specifies the X position.
452	* @param Ypos: specifies the Y position.
453	* @retval None
454	*/
455	static void
456	ST7789H2_SetCursor(LCD_Handler_t *hlcd, uint16_t Xpos, uint16_t Ypos)
457	{
458	uint8_t parameter[4];
459	/* CASET: Comumn Addrses Set */
460	parameter[0] = 0x00;
461	parameter[1] = 0x00 + Xpos;
462	parameter[2] = 0x00;
463	parameter[3] = 0xEF + Xpos;
464	ST7789H2_WriteReg(hlcd, ST7789H2_CASET, parameter, 4);
465	/* RASET: Row Addrses Set */
466	parameter[0] = 0x00;
467	parameter[1] = 0x00 + Ypos;
468	parameter[2] = 0x00;
469	parameter[3] = 0xEF + Ypos;
470	ST7789H2_WriteReg(hlcd, ST7789H2_RASET, parameter, 4);
471	}
472
473	/**
474	* @brief Read pixel from LCD RAM in RGB888 format
475	* @param Xpos: specifies the X position.
476	* @param Ypos: specifies the Y position.
477	* @retval Each RGB pixel color components in a structure
478	*/
479	static ST7789H2_Rgb888
480	ST7789H2_ReadPixel_rgb888(LCD_Handler_t *hlcd, uint16_t Xpos, uint16_t Ypos)
481	{
482	ST7789H2_Rgb888 rgb888;
483	uint16_t rgb888_part1, rgb888_part2;
484
485	/* In LCD RAM, pixels are 24 bits packed and read with 16 bits access
486	* Here is the pixels components arrangement in memory :
487	* bits: 15 14 13 12 11 10 09 08 \| 07 06 05 04 03 02 01 00
488	* address 0 : red pixel 0 X X \| green pixel 0 X X
489	* address 1 : blue pixel 0 X X \| red pixel 1 X X
490	* address 2 : green pixel 1 X X \| blue pixel 1 X X
491	*/
492
493	/* Set Cursor */
494	ST7789H2_SetCursor(hlcd, Xpos, Ypos);
495	/* Prepare to read LCD RAM */
496	ST7789H2_WriteReg(hlcd, ST7789H2_READ_RAM, (uint8_t)NULL, 0); / RAM read data command */
497	/* Dummy read */
498	LCD_IO_ReadData(hlcd);
499	/* Read first part of the RGB888 data */
500	rgb888_part1 = LCD_IO_ReadData(hlcd);
501	/* Read first part of the RGB888 data */
502	rgb888_part2 = LCD_IO_ReadData(hlcd);
503
504	/* red component */
505	rgb888.red = (rgb888_part1 & 0xFC00) >> 8;
506	/* green component */
507	rgb888.green = (rgb888_part1 & 0x00FC) >> 0;
508	/* blue component */
509	rgb888.blue = (rgb888_part2 & 0xFC00) >> 8;
510	return rgb888;
511	}
512
513	/**
514	* @brief Displays a single picture line.
515	* @param pdata: picture address.
516	* @param Xpos: Image X position in the LCD
517	* @param Ypos: Image Y position in the LCD
518	* @param Xsize: Image X size in the LCD
519	* @retval None
520	*/
521	static void
522	ST7789H2_DrawRGBHLine(LCD_Handler_t hlcd, uint16_t Xpos, uint16_t Ypos, uint16_t Xsize, uint8_t pdata)
523	{
524	uint32_t i = 0;
525	uint32_t posX;
526	uint16_t rgb565 = (uint16_t)pdata;
527
528	/* Prepare to write to LCD RAM */
529	ST7789H2_WriteReg(hlcd, ST7789H2_WRITE_RAM, (uint8_t)NULL, 0); / RAM write data command */
530
531	for(posX = Xpos ; posX < (Xsize + Xpos) ; posX++){
532	if((posX >= hlcd->winXstart) && (Ypos >= hlcd->winYstart) && /* Check we are in the defined window */
533	(posX <= hlcd->winXend) && (Ypos <= hlcd->winXend)){
534	if(posX != (Xsize + Xpos)){ /* When writing last pixel when size is odd, the third part is not written */
535	LCD_IO_WriteData(hlcd, rgb565[i]);
536	}
537	i++;
538	}
539	}
540	}
541
542	/*
543	* ST7789H2スクリーンの初期化関数
544	*/
545	ER
546	lcd_init(LCD_Handler_t *hlcd, uint32_t orientation)
547	{
548	GPIO_Init_t GPIO_Init_Data;
549	uint16_t id;
550
551	hlcd->_width = ST7789H2_LCD_PIXEL_WIDTH;
552	hlcd->_height = ST7789H2_LCD_PIXEL_HEIGHT;
553	hlcd->winXstart = 0;
554	hlcd->winYstart = 0;
555	hlcd->winXend = hlcd->_width - 1;
556	hlcd->winXend = hlcd->_height - 1;
557
558	/* Initialize LCD special pins GPIOs */
559	sil_orw_mem((uint32_t *)(TADR_RCC_BASE+TOFF_RCC_AHB1ENR), hlcd->rst_clk);
560	sil_orw_mem((uint32_t *)(TADR_RCC_BASE+TOFF_RCC_AHB1ENR), hlcd->te_clk);
561	sil_orw_mem((uint32_t *)(TADR_RCC_BASE+TOFF_RCC_AHB1ENR), hlcd->bl_clk);
562
563	GPIO_Init_Data.mode = GPIO_MODE_OUTPUT; /* LCD_RESET pin has to be manually controlled */
564	GPIO_Init_Data.speed = hlcd->gpio_speed;
565	GPIO_Init_Data.pull = hlcd->rst_pull;
566	GPIO_Init_Data.otype = GPIO_OTYPE_PP;
567	gpio_setup(hlcd->rst_base, &GPIO_Init_Data, hlcd->rst_pin);
568	sil_wrw_mem((uint32_t *)(hlcd->rst_base+TOFF_GPIO_BSRR), (1<<hlcd->rst_pin) << 16);
569
570	/* LCD_TE GPIO configuration */
571	GPIO_Init_Data.mode = GPIO_MODE_INPUT; /* LCD_TE pin has to be manually managed */
572	gpio_setup(hlcd->te_base, &GPIO_Init_Data, hlcd->te_pin);
573
574	/* LCD_BL_CTRL GPIO configuration */
575	GPIO_Init_Data.mode = GPIO_MODE_OUTPUT; /* LCD_BL_CTRL pin has to be manually controlled */
576	GPIO_Init_Data.pull = hlcd->bl_pull;
577	gpio_setup(hlcd->bl_base, &GPIO_Init_Data, hlcd->bl_pin);
578
579	/* Backlight control signal assertion */
580	if(hlcd->bl_active == 0)
581	sil_wrw_mem((uint32_t *)(hlcd->bl_base+TOFF_GPIO_BSRR), (1<<hlcd->bl_pin) << 16);
582	else
583	sil_wrw_mem((uint32_t *)(hlcd->bl_base+TOFF_GPIO_BSRR), (1<<hlcd->bl_pin));
584
585	/* Apply hardware reset according to procedure indicated in FRD154BP2901 documentation */
586	dly_tsk(5); /* Reset signal asserted during 5ms */
587	sil_wrw_mem((uint32_t *)(hlcd->rst_base+TOFF_GPIO_BSRR), (1<<hlcd->rst_pin));
588	dly_tsk(10); /* Reset signal released during 10ms */
589	sil_wrw_mem((uint32_t *)(hlcd->rst_base+TOFF_GPIO_BSRR), (1<<hlcd->rst_pin) << 16);
590	dly_tsk(20); /* Reset signal asserted during 20ms */
591	sil_wrw_mem((uint32_t *)(hlcd->rst_base+TOFF_GPIO_BSRR), (1<<hlcd->rst_pin));
592	dly_tsk(10); /* Reset signal released during 10ms */
593
594	LCD_IO_Init();
595	id = ST7789H2_ReadReg(hlcd, ST7789H2_LCD_ID);
596	if(id == ST7789H2_ID){
597	/* LCD Init */
598	ST7789H2_Init(hlcd);
599
600	if(orientation == LCD_ORIENTATION_PORTRAIT){
601	ST7789H2_SetOrientation(hlcd, LCD_ORIENTATION_PORTRAIT);
602	}
603	else if(orientation == LCD_ORIENTATION_LANDSCAPE_ROT180){
604	ST7789H2_SetOrientation(hlcd, LCD_ORIENTATION_LANDSCAPE_ROT180);
605	}
606	else{
607	/* Default landscape orientation is selected */
608	}
609	return E_OK;
610	}
611	else
612	return E_SYS;
613	}
614
615	/*
616	* ST7789H2スクリーンの終了関数
617	*/
618	ER
619	lcd_deinit(LCD_Handler_t *hlcd)
620	{
621	/* Actually LcdDrv does not provide a DeInit function */
622	return E_OK;
623	}
624
625	/*
626	* ST7789H2スクリーンレイヤ初期化関数
627	*/
628	ER
629	lcd_layerdefaultinit(LCD_Handler_t hlcd, LCD_DrawProp_t pDrawProp, uint16_t LayerIndex, uint32_t FB_Address)
630	{
631	pDrawProp->BackColor = 0xFFFF;
632	pDrawProp->TextColor = 0x0000;
633	pDrawProp->hlcd = hlcd;
634	return E_OK;
635	}
636
637	/*
638	* ST7789H2表示ウィンドウ設定
639	*/
640	void
641	lcd_setAddrWindow(LCD_Handler_t *hlcd, uint16_t Xpos, uint16_t Ypos, uint16_t Width, uint16_t Height)
642	{
643	if(Xpos < hlcd->_width){
644	hlcd->winXstart = Xpos;
645	}
646	else{
647	hlcd->winXstart = 0;
648	}
649
650	if(Ypos < hlcd->_height){
651	hlcd->winYstart = Ypos;
652	}
653	else{
654	hlcd->winYstart = 0;
655	}
656
657	if(Width + Xpos <= hlcd->_width){
658	hlcd->winXend = Width + Xpos - 1;
659	}
660	else{
661	hlcd->winXend = hlcd->_width - 1;
662	}
663
664	if(Height + Ypos <= hlcd->_height){
665	hlcd->winXend = Height + Ypos - 1;
666	}
667	else{
668	hlcd->winXend = hlcd->_height-1;
669	}
670	}
671
672	/*
673	* ST7789H2スクリーンクリア
674	*/
675	void
676	lcd_clear(LCD_Handler_t *hlcd, uint16_t Color)
677	{
678	uint32_t counter = 0;
679	uint32_t y_size = 0;
680
681	y_size = hlcd->_height;
682
683	for(counter = 0; counter < y_size; counter++){
684	lcd_drawFastHLine(hlcd, 0, counter, hlcd->_width, Color);
685	}
686	}
687
688	/*
689	* PIXEL読み出し
690	* param1 hlcd: Pointer to LCD Handler
691	* param2 x: X position
692	* param3 y: Y position
693	*/
694	uint16_t
695	lcd_readPixel(LCD_Handler_t *hlcd, uint16_t Xpos, uint16_t Ypos)
696	{
697	ST7789H2_Rgb888 rgb888;
698	uint8_t r, g, b;
699	uint16_t rgb565;
700
701	/* Set Cursor */
702	ST7789H2_SetCursor(hlcd, Xpos, Ypos);
703
704	/* Read RGB888 data from LCD RAM */
705	rgb888 = ST7789H2_ReadPixel_rgb888(hlcd, Xpos, Ypos);
706
707	/* Convert RGB888 to RGB565 */
708	r = ((rgb888.red & 0xF8) >> 3); /* Extract the red component 5 most significant bits */
709	g = ((rgb888.green & 0xFC) >> 2); /* Extract the green component 6 most significant bits */
710	b = ((rgb888.blue & 0xF8) >> 3); /* Extract the blue component 5 most significant bits */
711
712	rgb565 = ((uint16_t)(r) << 11) + ((uint16_t)(g) << 5) + ((uint16_t)(b) << 0);
713	return (rgb565);
714	}
715
716	/*
717	* PIXEL描画
718	* param1 hlcd: Pointer to LCD Handler
719	* param2 x: X position
720	* param3 y: Y position
721	* param4 color: color value
722	*/
723	void
724	lcd_drawPixel(LCD_Handler_t *hlcd, int16_t Xpos, int16_t Ypos, uint16_t RGB_Code)
725	{
726	ST7789H2_SetCursor(hlcd, Xpos, Ypos);
727
728	/* Prepare to write to LCD RAM */
729	ST7789H2_WriteReg(hlcd, ST7789H2_WRITE_RAM, (uint8_t)NULL, 0); / RAM write data command */
730
731	/* Write RAM data */
732	LCD_IO_WriteData(hlcd, RGB_Code);
733	}
734
735	/*
736	* 垂直方向LINEの高速描画
737	* param1 hlcd: Pointer to LCD Handler
738	* param2 x: start X position
739	* param3 y: start Y position
740	* param4 h: height
741	* param5 color: color value
742	*/
743	void
744	lcd_drawFastHLine(LCD_Handler_t *hlcd, uint16_t Xpos, uint16_t Ypos, uint16_t Length, uint32_t color)
745	{
746	uint16_t counter = 0;
747
748	/* Set Cursor */
749	ST7789H2_SetCursor(hlcd, Xpos, Ypos);
750
751	/* Prepare to write to LCD RAM */
752	ST7789H2_WriteReg(hlcd, ST7789H2_WRITE_RAM, (uint8_t)NULL, 0); / RAM write data command */
753
754	/* Sent a complete line */
755	for(counter = 0; counter < Length; counter++){
756	LCD_IO_WriteData(hlcd, color);
757	}
758	}
759
760	/*
761	* 水平方向LINEの高速描画
762	* param1 hlcd: Pointer to LCD Handler
763	* param2 x: start X position
764	* param3 y: start Y position
765	* param4 w: width
766	* param5 color: color value
767	*/
768	void
769	lcd_drawFastVLine(LCD_Handler_t *hlcd, uint16_t Xpos, uint16_t Ypos, uint16_t Length, uint32_t color)
770	{
771	uint16_t counter = 0;
772
773	/* Set Cursor */
774	ST7789H2_SetCursor(hlcd, Xpos, Ypos);
775
776	/* Prepare to write to LCD RAM */
777	ST7789H2_WriteReg(hlcd, ST7789H2_WRITE_RAM, (uint8_t)NULL, 0); / RAM write data command */
778
779	/* Fill a complete vertical line */
780	for(counter = 0; counter < Length; counter++){
781	lcd_drawPixel(hlcd, Xpos, Ypos + counter, color);
782	}
783	}
784
785	/*
786	* BITMAP描画
787	* param1 hlcd: Pointer to LCD Handler
788	* param2 x0: Bmp X position in the LCD
789	* param3 y0: Bmp Y position in the LCD
790	* param4 pbmp: Pointer to Bmp picture address in the internal Flash
791	*/
792	void
793	lcd_drawBitmap(LCD_Handler_t hlcd, uint16_t Xpos, uint16_t Ypos, uint8_t pbmp)
794	{
795	uint32_t height = 0;
796	uint32_t width = 0;
797	uint32_t index = 0, size = 0;
798	uint32_t posY;
799	uint32_t nb_line = 0;
800	uint16_t Xsize = hlcd->winXend - hlcd->winXstart + 1;
801	uint16_t Ysize = hlcd->winXend - hlcd->winYstart + 1;
802
803	/* Read bitmap width */
804	width = pbmp[18] + (pbmp[19] << 8) + (pbmp[20] << 16) + (pbmp[21] << 24);
805
806	/* Read bitmap height */
807	height = pbmp[22] + (pbmp[23] << 8) + (pbmp[24] << 16) + (pbmp[25] << 24);
808
809	lcd_setAddrWindow(hlcd, Xpos, Ypos, width, height);
810
811	/* Read bitmap size */
812	size = (volatile uint16_t ) (pbmp + 2);
813	size \|= ((volatile uint16_t ) (pbmp + 4)) << 16;
814	/* Get bitmap data address offset */
815	index = (volatile uint16_t ) (pbmp + 10);
816	index \|= ((volatile uint16_t ) (pbmp + 12)) << 16;
817	size = (size - index)/2;
818	pbmp += index;
819
820	for (posY = (Ypos + Ysize); posY > Ypos; posY--){ /* In BMP files the line order is inverted */
821	/* Set Cursor */
822	ST7789H2_SetCursor(hlcd, Xpos, posY - 1);
823
824	/* Draw one line of the picture */
825	ST7789H2_DrawRGBHLine(hlcd, Xpos, posY - 1, Xsize, (pbmp + (nb_line * Xsize * 2)));
826	nb_line++;
827	}
828	lcd_setAddrWindow(hlcd, 0, 0, hlcd->_width, hlcd->_height);
829	}
830
831	/*
832	* バッファコピー
833	* param1 hlcd: Pointer to LCD Handler
834	* param2 Xpos: コピー先X座標
835	* param3 Ypos: コピー先Y座標
836	* param4 Xsize: バッファ幅
837	* param5 Ysize: バッファ高さ
838	* param6 pdata: コピー元バッファポインタ
839	*/
840	void
841	lcd_drawRGBImage(LCD_Handler_t hlcd, uint16_t Xpos, uint16_t Ypos, uint16_t Xsize, uint16_t Ysize, uint8_t pdata)
842	{
843	uint32_t posY;
844	uint32_t nb_line = 0;
845
846	lcd_setAddrWindow(hlcd, Xpos, Ypos, Xsize, Ysize);
847
848	for(posY = Ypos ; posY < (Ypos + Ysize) ; posY++){
849	/* Set Cursor */
850	ST7789H2_SetCursor(hlcd, Xpos, posY);
851
852	/* Draw one line of the picture */
853	ST7789H2_DrawRGBHLine(hlcd, Xpos, posY, Xsize, (pdata + (nb_line * Xsize * 2)));
854	nb_line++;
855	}
856	lcd_setAddrWindow(hlcd, 0, 0, hlcd->_width, hlcd->_height);
857	}
858
859	/*
860	* RECTANGLE塗りつぶし描画
861	* param1 hlcd: Pointer to LCD Handler
862	* param2 x: left X position
863	* param3 y: top Y position
864	* param4 w: width
865	* param5 h: height
866	* param6 color: color value
867	*/
868	void
869	lcd_fillRect(LCD_Handler_t *hlcd, uint16_t Xpos, uint16_t Ypos, uint16_t Width, uint16_t Height, uint32_t color)
870	{
871	do{
872	lcd_drawFastHLine(hlcd, Xpos, Ypos++, Width, color);
873	}
874	while(Height--);
875	}
876
877
878	/*
879	* 線描画
880	* param1 pDrawProp: Pointer to Draw Prop
881	* param2 x1: Point 1 X position
882	* param3 y1: Point 1 Y position
883	* param4 x2: Point 2 X position
884	* param5 y2: Point 2 Y position
885	*/
886	void
887	lcd_drawLine(LCD_DrawProp_t *pDrawProp, uint16_t x1, uint16_t y1, uint16_t x2, uint16_t y2)
888	{
889	int16_t deltax = 0, deltay = 0, x = 0, y = 0, xinc1 = 0, xinc2 = 0,
890	yinc1 = 0, yinc2 = 0, den = 0, num = 0, numadd = 0, numpixels = 0,
891	curpixel = 0;
892
893	deltax = ABS(x2 - x1); /* The difference between the x's */
894	deltay = ABS(y2 - y1); /* The difference between the y's */
895	x = x1; /* Start x off at the first pixel */
896	y = y1; /* Start y off at the first pixel */
897
898	if(x2 >= x1){ /* The x-values are increasing */
899	xinc1 = 1;
900	xinc2 = 1;
901	}
902	else{ /* The x-values are decreasing */
903	xinc1 = -1;
904	xinc2 = -1;
905	}
906
907	if(y2 >= y1){ /* The y-values are increasing */
908	yinc1 = 1;
909	yinc2 = 1;
910	}
911	else{ /* The y-values are decreasing */
912	yinc1 = -1;
913	yinc2 = -1;
914	}
915
916	if(deltax >= deltay){ /* There is at least one x-value for every y-value */
917	xinc1 = 0; /* Don't change the x when numerator >= denominator */
918	yinc2 = 0; /* Don't change the y for every iteration */
919	den = deltax;
920	num = deltax / 2;
921	numadd = deltay;
922	numpixels = deltax; /* There are more x-values than y-values */
923	}
924	else{ /* There is at least one y-value for every x-value */
925	xinc2 = 0; /* Don't change the x for every iteration */
926	yinc1 = 0; /* Don't change the y when numerator >= denominator */
927	den = deltay;
928	num = deltay / 2;
929	numadd = deltax;
930	numpixels = deltay; /* There are more y-values than x-values */
931	}
932
933	for(curpixel = 0; curpixel <= numpixels; curpixel++){
934	lcd_drawPixel(pDrawProp->hlcd, x, y, pDrawProp->TextColor); /* Draw the current pixel */
935	num += numadd; /* Increase the numerator by the top of the fraction */
936	if(num >= den){ /* Check if numerator >= denominator */
937	num -= den; /* Calculate the new numerator value */
938	x += xinc1; /* Change the x as appropriate */
939	y += yinc1; /* Change the y as appropriate */
940	}
941	x += xinc2; /* Change the x as appropriate */
942	y += yinc2; /* Change the y as appropriate */
943	}
944	}
945
946	/*
947	* RECTANGLE描画
948	* param1 pDrawProp: Pointer to Draw Prop
949	* param2 x: left X position
950	* param3 y: top Y position
951	* param4 w: width
952	* param5 h: height
953	*/
954	void
955	lcd_drawRect(LCD_DrawProp_t *pDrawProp, uint16_t Xpos, uint16_t Ypos, uint16_t Width, uint16_t Height)
956	{
957	/* Draw horizontal lines */
958	lcd_drawFastHLine(pDrawProp->hlcd, Xpos, Ypos, Width, pDrawProp->TextColor);
959	lcd_drawFastHLine(pDrawProp->hlcd, Xpos, (Ypos+ Height), Width, pDrawProp->TextColor);
960
961	/* Draw vertical lines */
962	lcd_drawFastVLine(pDrawProp->hlcd, Xpos, Ypos, Height, pDrawProp->TextColor);
963	lcd_drawFastVLine(pDrawProp->hlcd, (Xpos + Width), Ypos, Height, pDrawProp->TextColor);
964	}
965
966	/*
967	* 円描画
968	* param1 pDrawProp: Pointer to Draw Prop
969	* param2 x0: X position
970	* param3 y0: Y position
971	* param4 Radius: Circle radius
972	*/
973	void
974	lcd_DrawCircle(LCD_DrawProp_t *pDrawProp, uint16_t Xpos, uint16_t Ypos, uint16_t Radius)
975	{
976	int32_t decision; /* Decision Variable */
977	uint32_t current_x; /* Current X Value */
978	uint32_t current_y; /* Current Y Value */
979
980	decision = 3 - (Radius << 1);
981	current_x = 0;
982	current_y = Radius;
983
984	while (current_x <= current_y){
985	lcd_drawPixel(pDrawProp->hlcd, (Xpos + current_x), (Ypos - current_y), pDrawProp->TextColor);
986	lcd_drawPixel(pDrawProp->hlcd, (Xpos - current_x), (Ypos - current_y), pDrawProp->TextColor);
987	lcd_drawPixel(pDrawProp->hlcd, (Xpos + current_y), (Ypos - current_x), pDrawProp->TextColor);
988	lcd_drawPixel(pDrawProp->hlcd, (Xpos - current_y), (Ypos - current_x), pDrawProp->TextColor);
989	lcd_drawPixel(pDrawProp->hlcd, (Xpos + current_x), (Ypos + current_y), pDrawProp->TextColor);
990	lcd_drawPixel(pDrawProp->hlcd, (Xpos - current_x), (Ypos + current_y), pDrawProp->TextColor);
991	lcd_drawPixel(pDrawProp->hlcd, (Xpos + current_y), (Ypos + current_x), pDrawProp->TextColor);
992	lcd_drawPixel(pDrawProp->hlcd, (Xpos - current_y), (Ypos + current_x), pDrawProp->TextColor);
993
994	if(decision < 0){
995	decision += (current_x << 2) + 6;
996	}
997	else{
998	decision += ((current_x - current_y) << 2) + 10;
999	current_y--;
1000	}
1001	current_x++;
1002	}
1003	}
1004
1005	/*
1006	* PLOY-LINE描画
1007	* param1 pDrawProp: Pointer to Draw Prop
1008	* param2 Points: Pointer to the points array
1009	* param3 PointCount: Number of points
1010	*/
1011	void
1012	lcd_drawPolygon(LCD_DrawProp_t *pDrawProp, pPoint Points, uint16_t PointCount)
1013	{
1014	int16_t x = 0, y = 0;
1015
1016	if(PointCount < 2)
1017	return;
1018
1019	lcd_drawLine(pDrawProp, Points->X, Points->Y, (Points+PointCount-1)->X, (Points+PointCount-1)->Y);
1020
1021	while(--PointCount){
1022	x = Points->X;
1023	y = Points->Y;
1024	Points++;
1025	lcd_drawLine(pDrawProp, x, y, Points->X, Points->Y);
1026	}
1027	}
1028
1029	/*
1030	* 楕円描画
1031	* param1 pDrawProp: Pointer to Draw Prop
1032	* param2 x0: X position
1033	* param3 y0: Y position
1034	* param4 XRadius: Ellipse X radius
1035	* param5 YRadius: Ellipse Y radius
1036	*/
1037	void
1038	lcd_DrawEllipse(LCD_DrawProp_t *pDrawProp, int Xpos, int Ypos, int XRadius, int YRadius)
1039	{
1040	LCD_Handler_t *hlcd = pDrawProp->hlcd;
1041	int x = 0, y = -YRadius, err = 2-2*XRadius, e2;
1042	float k = 0, rad1 = 0, rad2 = 0;
1043
1044	rad1 = XRadius;
1045	rad2 = YRadius;
1046
1047	k = (float)(rad2/rad1);
1048
1049	do{
1050	lcd_drawPixel(hlcd, (Xpos-(uint16_t)(x/k)), (Ypos+y), pDrawProp->TextColor);
1051	lcd_drawPixel(hlcd, (Xpos+(uint16_t)(x/k)), (Ypos+y), pDrawProp->TextColor);
1052	lcd_drawPixel(hlcd, (Xpos+(uint16_t)(x/k)), (Ypos-y), pDrawProp->TextColor);
1053	lcd_drawPixel(hlcd, (Xpos-(uint16_t)(x/k)), (Ypos-y), pDrawProp->TextColor);
1054
1055	e2 = err;
1056	if(e2 <= x){
1057	err += ++x*2+1;
1058	if(-y == x && e2 <= y)
1059	e2 = 0;
1060	}
1061	if(e2 > y)
1062	err += ++y*2+1;
1063	}while (y <= 0);
1064	}
1065
1066	/*
1067	* 円塗りつぶし描画
1068	* param1 pDrawProp: Pointer to Draw Prop
1069	* param2 x0: X position
1070	* param3 y0: Y position
1071	* param4 Radius: Circle radius
1072	*/
1073	void
1074	lcd_fillCircle(LCD_DrawProp_t *pDrawProp, uint16_t Xpos, uint16_t Ypos, uint16_t Radius)
1075	{
1076	LCD_Handler_t *hlcd = pDrawProp->hlcd;
1077	int32_t decision; /* Decision Variable */
1078	uint32_t current_x; /* Current X Value */
1079	uint32_t current_y; /* Current Y Value */
1080
1081	decision = 3 - (Radius << 1);
1082	current_x = 0;
1083	current_y = Radius;
1084
1085	while(current_x <= current_y){
1086	if(current_y > 0){
1087	lcd_drawFastHLine(hlcd, Xpos - current_y, Ypos + current_x, 2*current_y, pDrawProp->TextColor);
1088	lcd_drawFastHLine(hlcd, Xpos - current_y, Ypos - current_x, 2*current_y, pDrawProp->TextColor);
1089	}
1090
1091	if(current_x > 0){
1092	lcd_drawFastHLine(hlcd, Xpos - current_x, Ypos - current_y, 2*current_x, pDrawProp->TextColor);
1093	lcd_drawFastHLine(hlcd, Xpos - current_x, Ypos + current_y, 2*current_x, pDrawProp->TextColor);
1094	}
1095	if(decision < 0){
1096	decision += (current_x << 2) + 6;
1097	}
1098	else{
1099	decision += ((current_x - current_y) << 2) + 10;
1100	current_y--;
1101	}
1102	current_x++;
1103	}
1104	lcd_DrawCircle(pDrawProp, Xpos, Ypos, Radius);
1105	}
1106
1107	/*
1108	* 楕円塗りつぶし描画
1109	* param1 pDrawProp: Pointer to Draw Prop
1110	* param2 x0: X position
1111	* param3 y0: Y position
1112	* param4 XRadius: Ellipse X radius
1113	* param5 YRadius: Ellipse Y radius
1114	*/
1115	void
1116	lcd_fillEllipse(LCD_DrawProp_t *pDrawProp, int Xpos, int Ypos, int XRadius, int YRadius)
1117	{
1118	LCD_Handler_t *hlcd = pDrawProp->hlcd;
1119	int x = 0, y = -YRadius, err = 2-2*XRadius, e2;
1120	float k = 0, rad1 = 0, rad2 = 0;
1121
1122	rad1 = XRadius;
1123	rad2 = YRadius;
1124	k = (float)(rad2/rad1);
1125
1126	do{
1127	lcd_drawFastHLine(hlcd, (Xpos-(uint16_t)(x/k)), (Ypos+y), (2*(uint16_t)(x/k) + 1), pDrawProp->TextColor);
1128	lcd_drawFastHLine(hlcd, (Xpos-(uint16_t)(x/k)), (Ypos-y), (2*(uint16_t)(x/k) + 1), pDrawProp->TextColor);
1129
1130	e2 = err;
1131	if(e2 <= x){
1132	err += ++x*2+1;
1133	if(-y == x && e2 <= y)
1134	e2 = 0;
1135	}
1136	if(e2 > y)
1137	err += ++y*2+1;
1138	}
1139	while(y <= 0);
1140	}
1141
1142	/*
1143	* PLOY-LINE塗りつぶし描画
1144	* param1 pDrawProp: Pointer to Draw Prop
1145	* param2 Points: Pointer to the points array
1146	* param3 PointCount: Number of points
1147	*/
1148	void
1149	lcd_fillPolygon(LCD_DrawProp_t *pDrawProp, pPoint Points, uint16_t PointCount)
1150	{
1151	int16_t X = 0, Y = 0, X2 = 0, Y2 = 0, X_center = 0, Y_center = 0, X_first = 0, Y_first = 0, pixelX = 0, pixelY = 0, counter = 0;
1152	uint16_t IMAGE_LEFT = 0, IMAGE_RIGHT = 0, IMAGE_TOP = 0, IMAGE_BOTTOM = 0;
1153
1154	IMAGE_LEFT = IMAGE_RIGHT = Points->X;
1155	IMAGE_TOP= IMAGE_BOTTOM = Points->Y;
1156
1157	for(counter = 1; counter < PointCount; counter++){
1158	pixelX = POLY_X(counter);
1159	if(pixelX < IMAGE_LEFT){
1160	IMAGE_LEFT = pixelX;
1161	}
1162	if(pixelX > IMAGE_RIGHT){
1163	IMAGE_RIGHT = pixelX;
1164	}
1165
1166	pixelY = POLY_Y(counter);
1167	if(pixelY < IMAGE_TOP){
1168	IMAGE_TOP = pixelY;
1169	}
1170	if(pixelY > IMAGE_BOTTOM){
1171	IMAGE_BOTTOM = pixelY;
1172	}
1173	}
1174
1175	if(PointCount < 2){
1176	return;
1177	}
1178
1179	X_center = (IMAGE_LEFT + IMAGE_RIGHT)/2;
1180	Y_center = (IMAGE_BOTTOM + IMAGE_TOP)/2;
1181
1182	X_first = Points->X;
1183	Y_first = Points->Y;
1184
1185	while(--PointCount){
1186	X = Points->X;
1187	Y = Points->Y;
1188	Points++;
1189	X2 = Points->X;
1190	Y2 = Points->Y;
1191
1192	FillTriangle(pDrawProp, X, X2, X_center, Y, Y2, Y_center);
1193	FillTriangle(pDrawProp, X, X_center, X2, Y, Y_center, Y2);
1194	FillTriangle(pDrawProp, X_center, X2, X, Y_center, Y2, Y);
1195	}
1196	FillTriangle(pDrawProp, X_first, X2, X_center, Y_first, Y2, Y_center);
1197	FillTriangle(pDrawProp, X_first, X_center, X2, Y_first, Y_center, Y2);
1198	FillTriangle(pDrawProp, X_center, X2, X_first, Y_center, Y2, Y_first);
1199	}
1200
1201	/*
1202	* 表示オン
1203	* param1 hlcd: Pointer to LCD Handler
1204	*/
1205	void
1206	lcd_displayOn(LCD_Handler_t *hlcd)
1207	{
1208	/* Display ON command */
1209	ST7789H2_WriteReg(hlcd, ST7789H2_DISPLAY_ON, (uint8_t*)NULL, 0);
1210
1211	/* Sleep Out command */
1212	ST7789H2_WriteReg(hlcd, ST7789H2_SLEEP_OUT, (uint8_t*)NULL, 0);
1213	}
1214
1215	/*
1216	* 表示オフ
1217	* param1 hlcd: Pointer to LCD Handler
1218	*/
1219	void
1220	lcd_displayOff(LCD_Handler_t *hlcd)
1221	{
1222	uint8_t parameter[1];
1223	parameter[0] = 0xFE;
1224	/* Display OFF command */
1225	ST7789H2_WriteReg(hlcd, ST7789H2_DISPLAY_OFF, parameter, 1);
1226	/* Sleep In Command */
1227	ST7789H2_WriteReg(hlcd, ST7789H2_SLEEP_IN, (uint8_t*)NULL, 0);
1228	/* Wait for 10ms */
1229	dly_tsk(10);
1230	}
1231
1232
1233	/*
1234	* トライアングルフィル
1235	* param1 pDrawProp: Pointer to Draw Prop
1236	* param2 x1: 点1 X座標始点
1237	* param3 y1: 点1 Y座標始点
1238	* param4 x2: 点2 X座標始点
1239	* param5 y2: 点2 Y座標始点
1240	* param6 x3: 点3 X座標始点
1241	* param7 y3: 点3 Y座標始点
1242	*/
1243	static void
1244	FillTriangle(LCD_DrawProp_t *pDrawProp, uint16_t x1, uint16_t x2, uint16_t x3, uint16_t y1, uint16_t y2, uint16_t y3)
1245	{
1246	int16_t deltax = 0, deltay = 0, x = 0, y = 0, xinc1 = 0, xinc2 = 0,
1247	yinc1 = 0, yinc2 = 0, den = 0, num = 0, numadd = 0, numpixels = 0,
1248	curpixel = 0;
1249
1250	deltax = ABS(x2 - x1); /* The difference between the x's */
1251	deltay = ABS(y2 - y1); /* The difference between the y's */
1252	x = x1; /* Start x off at the first pixel */
1253	y = y1; /* Start y off at the first pixel */
1254
1255	if(x2 >= x1){ /* The x-values are increasing */
1256	xinc1 = 1;
1257	xinc2 = 1;
1258	}
1259	else{ /* The x-values are decreasing */
1260	xinc1 = -1;
1261	xinc2 = -1;
1262	}
1263
1264	if(y2 >= y1){ /* The y-values are increasing */
1265	yinc1 = 1;
1266	yinc2 = 1;
1267	}
1268	else{ /* The y-values are decreasing */
1269	yinc1 = -1;
1270	yinc2 = -1;
1271	}
1272
1273	if(deltax >= deltay){ /* There is at least one x-value for every y-value */
1274	xinc1 = 0; /* Don't change the x when numerator >= denominator */
1275	yinc2 = 0; /* Don't change the y for every iteration */
1276	den = deltax;
1277	num = deltax / 2;
1278	numadd = deltay;
1279	numpixels = deltax; /* There are more x-values than y-values */
1280	}
1281	else{ /* There is at least one y-value for every x-value */
1282	xinc2 = 0; /* Don't change the x for every iteration */
1283	yinc1 = 0; /* Don't change the y when numerator >= denominator */
1284	den = deltay;
1285	num = deltay / 2;
1286	numadd = deltax;
1287	numpixels = deltay; /* There are more y-values than x-values */
1288	}
1289
1290	for(curpixel = 0 ; curpixel <= numpixels ; curpixel++){
1291	lcd_drawLine(pDrawProp, x, y, x3, y3);
1292	num += numadd; /* Increase the numerator by the top of the fraction */
1293	if(num >= den){ /* Check if numerator >= denominator */
1294	num -= den; /* Calculate the new numerator value */
1295	x += xinc1; /* Change the x as appropriate */
1296	y += yinc1; /* Change the y as appropriate */
1297	}
1298	x += xinc2; /* Change the x as appropriate */
1299	y += yinc2; /* Change the y as appropriate */
1300	}
1301	}
1302

Note: See TracBrowser for help on using the repository browser.

Context Navigation

source: azure_iot_hub_f767zi/trunk/asp_baseplatform/gdic/stlcd_st7789h2/stlcd_st7789h2.c@ 457

Download in other formats: