351 lines
10 KiB
C++
351 lines
10 KiB
C++
/**
|
|
******************************************************************************
|
|
* @file Project/lcd/lcd.c
|
|
* @author FrSky Application Team
|
|
* @Hardware version V0.2
|
|
* @date 11-July-2012
|
|
* @brief This file provides LCD Init and botom drivers.
|
|
* *
|
|
******************************************************************************
|
|
*/
|
|
|
|
#include "../../opentx.h"
|
|
|
|
#define WriteData(x) AspiData(x)
|
|
#define WriteCommand(x) AspiCmd(x)
|
|
|
|
#if defined(REVPLUS)
|
|
#define CONTRAST_OFS 160
|
|
#else
|
|
#define CONTRAST_OFS 5
|
|
#endif
|
|
|
|
//275us
|
|
void Delay(volatile unsigned int ms)
|
|
{
|
|
volatile u8 i;
|
|
while(ms != 0) {
|
|
for(i=0;i<250;i++) {}
|
|
for(i=0;i<75;i++) {}
|
|
ms--;
|
|
}
|
|
}
|
|
|
|
#if defined(REVPLUS)
|
|
static void LCD_Hardware_Init() ;
|
|
|
|
// New hardware SPI driver for LCD
|
|
void initLcdSpi()
|
|
{
|
|
// uint16_t temp ;
|
|
RCC_AHB1PeriphClockCmd(RCC_AHB1Periph_LCD, ENABLE);
|
|
RCC_AHB1PeriphClockCmd(RCC_AHB1Periph_LCD_RST, ENABLE);
|
|
RCC_AHB1PeriphClockCmd(RCC_AHB1Periph_LCD_NCS, ENABLE);
|
|
|
|
RCC->APB1ENR |= RCC_APB1ENR_SPI3EN ; // Enable clock
|
|
// APB1 clock / 2 = 133nS per clock
|
|
SPI3->CR1 = 0 ; // Clear any mode error
|
|
SPI3->CR1 = SPI_CR1_SSM | SPI_CR1_SSI | SPI_CR1_CPOL | SPI_CR1_CPHA ;
|
|
SPI3->CR2 = 0 ;
|
|
SPI3->CR1 |= SPI_CR1_MSTR ; // Make sure in case SSM/SSI needed to be set first
|
|
SPI3->CR1 |= SPI_CR1_SPE ;
|
|
|
|
configure_pins( PIN_LCD_NCS, PIN_OUTPUT | PIN_PORTA | PIN_PUSHPULL | PIN_OS25 | PIN_NO_PULLUP ) ;
|
|
configure_pins( PIN_LCD_RST, PIN_OUTPUT | PIN_PORTD | PIN_PUSHPULL | PIN_OS25 | PIN_NO_PULLUP ) ;
|
|
configure_pins( PIN_LCD_A0, PIN_OUTPUT | PIN_PORTC | PIN_PUSHPULL | PIN_OS50 | PIN_NO_PULLUP ) ;
|
|
configure_pins( PIN_LCD_MOSI|PIN_LCD_CLK, PIN_PORTC | PIN_PUSHPULL | PIN_OS50 | PIN_NO_PULLUP | PIN_PER_6 | PIN_PERIPHERAL ) ;
|
|
}
|
|
|
|
void setupSPIdma()
|
|
{
|
|
RCC->AHB1ENR |= RCC_AHB1ENR_DMA1EN ; // Enable DMA1 clock
|
|
// Chan 0, 8-bit wide, Medium priority, memory increments
|
|
DMA1_Stream7->CR &= ~DMA_SxCR_EN ; // Disable DMA
|
|
DMA1->HIFCR = DMA_HIFCR_CTCIF7 | DMA_HIFCR_CHTIF7 | DMA_HIFCR_CTEIF7 | DMA_HIFCR_CDMEIF7 | DMA_HIFCR_CFEIF7 ; // Write ones to clear bits
|
|
DMA1_Stream7->CR = DMA_SxCR_PL_0 | DMA_SxCR_MINC | DMA_SxCR_DIR_0 ;
|
|
DMA1_Stream7->PAR = (uint32_t) &SPI3->DR ;
|
|
DMA1_Stream7->M0AR = (uint32_t)displayBuf;
|
|
DMA1_Stream7->FCR = 0x05 ; //DMA_SxFCR_DMDIS | DMA_SxFCR_FTH_0 ;
|
|
DMA1_Stream7->NDTR = LCD_W*LCD_H/8*4 ;
|
|
|
|
// NVIC_SetPriority( DMA1_Stream7_IRQn, 2 ) ; // Lower priority interrupt
|
|
// NVIC_EnableIRQ(DMA1_Stream7_IRQn) ;
|
|
}
|
|
|
|
static void LCD_Init()
|
|
{
|
|
WriteCommand(0x2F); //Internal pump control
|
|
Delay(20);
|
|
WriteCommand(0x24); //Temperature compensation
|
|
WriteCommand(0xE9); //set bias=1/10
|
|
WriteCommand(0x81); //Set Vop
|
|
#if defined(BOOT)
|
|
AspiCmd(CONTRAST_OFS+25);
|
|
#else
|
|
AspiCmd(CONTRAST_OFS+g_eeGeneral.contrast);
|
|
#endif
|
|
WriteCommand(0xA2); //set line rate:28KLPS
|
|
WriteCommand(0x28); //set pannel loading
|
|
WriteCommand(0x40); //scroll line LSB
|
|
WriteCommand(0x50); //SCROLL LINE MSB
|
|
WriteCommand(0x89); //ram address control
|
|
WriteCommand(0xC0); //LCD mapping control
|
|
WriteCommand(0x04); //MX=0,MY=1
|
|
WriteCommand(0xD0); //DISPLAY PATTERN = 16-SCALE GRAY
|
|
WriteCommand(0xF1); //SET COM end
|
|
WriteCommand(0x3F); //64
|
|
|
|
WriteCommand(0xF8); //Set Window Program Disable.
|
|
|
|
WriteCommand(0xF5); //starting row address of RAM program window.PAGE1
|
|
WriteCommand(0x00);
|
|
WriteCommand(0xF7); //end row address of RAM program window.PAGE32
|
|
WriteCommand(0x1F);
|
|
WriteCommand(0xF4); //start column address of RAM program window.
|
|
WriteCommand(0x00);
|
|
WriteCommand(0xF6); //end column address of RAM program window.SEG212
|
|
WriteCommand(0xD3);
|
|
}
|
|
#else
|
|
static void LCD_Init()
|
|
{
|
|
AspiCmd(0x2B); //Panel loading set ,Internal VLCD.
|
|
AspiCmd(0x25); //Temperature compensation curve definition: 0x25 = -0.05%/oC
|
|
AspiCmd(0xEA); //set bias=1/10 :Command table NO.27
|
|
AspiCmd(0x81); //Set Vop
|
|
#if defined(BOOT)
|
|
AspiCmd(CONTRAST_OFS+25);
|
|
#else
|
|
AspiCmd(CONTRAST_OFS+g_eeGeneral.contrast);
|
|
#endif
|
|
AspiCmd(0xA6); //inverse display off
|
|
AspiCmd(0xD1); //SET RGB:Command table NO.21 .SET RGB or BGR. D1=RGB
|
|
AspiCmd(0xD5); //set color mode 4K and 12bits :Command table NO.22
|
|
AspiCmd(0xA0); //line rates,25.2 Klps
|
|
AspiCmd(0xC8); //SET N-LINE INVERSION
|
|
AspiCmd(0x1D); //Disable NIV
|
|
AspiCmd(0xF1); //Set CEN
|
|
AspiCmd(0x3F); // 1/64DUTY
|
|
AspiCmd(0x84); //Disable Partial Display
|
|
AspiCmd(0xC4); //MY=1,MX=0
|
|
AspiCmd(0x89); //WA=1,column (CA) increment (+1) first until CA reaches CA boundary, then RA will increment by (+1).
|
|
|
|
AspiCmd(0xF8); //Set Window Program Enable ,inside modle
|
|
AspiCmd(0xF4); //starting column address of RAM program window.
|
|
AspiCmd(0x00);
|
|
AspiCmd(0xF5); //starting row address of RAM program window.
|
|
AspiCmd(0x60);
|
|
AspiCmd(0xF6); //ending column address of RAM program window.
|
|
AspiCmd(0x47);
|
|
AspiCmd(0xF7); //ending row address of RAM program window.
|
|
AspiCmd(0x9F);
|
|
}
|
|
#endif
|
|
|
|
void Set_Address(u8 x, u8 y)
|
|
{
|
|
WriteCommand(x&0x0F); //Set Column Address LSB CA[3:0]
|
|
WriteCommand((x>>4)|0x10); //Set Column Address MSB CA[7:4]
|
|
|
|
WriteCommand((y&0x0F)|0x60); //Set Row Address LSB RA [3:0]
|
|
WriteCommand(((y>>4)&0x0F)|0x70); //Set Row Address MSB RA [7:4]
|
|
}
|
|
|
|
#define LCD_WRITE_BIT(bit) \
|
|
if (bit) \
|
|
LCD_MOSI_HIGH(); \
|
|
else \
|
|
LCD_MOSI_LOW(); \
|
|
LCD_CLK_LOW(); \
|
|
__no_operation(); \
|
|
LCD_CLK_HIGH();
|
|
|
|
#if defined(REVPLUS)
|
|
void lcdRefresh(bool wait)
|
|
{
|
|
Set_Address(0, 0);
|
|
|
|
LCD_NCS_LOW();
|
|
LCD_A0_HIGH();
|
|
|
|
setupSPIdma() ;
|
|
DMA1_Stream7->CR |= DMA_SxCR_EN ; // Enable DMA
|
|
SPI3->CR2 |= SPI_CR2_TXDMAEN ;
|
|
|
|
while ( ( DMA1->HISR & DMA_HISR_TCIF7 ) == 0 ) {
|
|
// wait
|
|
}
|
|
|
|
SPI3->CR2 &= ~SPI_CR2_TXDMAEN ;
|
|
DMA1_Stream7->CR &= ~DMA_SxCR_EN ; // Disable DMA
|
|
|
|
while ( ( SPI3->SR & SPI_SR_TXE ) == 0 ) {
|
|
// wait
|
|
} // Last byte being sent
|
|
|
|
while ( SPI3->SR & SPI_SR_BSY ) {
|
|
// wait
|
|
}
|
|
|
|
LCD_NCS_HIGH();
|
|
}
|
|
#else
|
|
void lcdRefresh()
|
|
{
|
|
for (uint32_t y=0; y<LCD_H; y++) {
|
|
uint8_t *p = &displayBuf[y/2 * LCD_W];
|
|
|
|
Set_Address(0, y);
|
|
AspiCmd(0xAF);
|
|
|
|
LCD_CLK_HIGH();
|
|
LCD_A0_HIGH();
|
|
LCD_NCS_LOW();
|
|
|
|
for (uint32_t x=0; x<LCD_W; x++) {
|
|
uint8_t b = p[x];
|
|
if (y & 1)
|
|
b >>= 4;
|
|
LCD_WRITE_BIT(b & 0x08);
|
|
LCD_WRITE_BIT(b & 0x04);
|
|
LCD_WRITE_BIT(b & 0x02);
|
|
LCD_WRITE_BIT(b & 0x01);
|
|
}
|
|
|
|
LCD_NCS_HIGH();
|
|
LCD_A0_HIGH();
|
|
|
|
WriteData(0);
|
|
}
|
|
}
|
|
#endif
|
|
|
|
/**Init the Backlight GPIO */
|
|
static void LCD_BL_Config()
|
|
{
|
|
RCC_AHB1PeriphClockCmd(RCC_AHB1Periph_GPIOBL, ENABLE);
|
|
GPIO_InitTypeDef GPIO_InitStructure;
|
|
|
|
#if defined(REVPLUS)
|
|
// RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM4, ENABLE);
|
|
GPIO_InitStructure.GPIO_Pin = GPIO_Pin_BL|GPIO_Pin_BLW;
|
|
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF;
|
|
GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
|
|
GPIO_InitStructure.GPIO_OType = GPIO_OType_PP;
|
|
GPIO_InitStructure.GPIO_PuPd = GPIO_PuPd_NOPULL;
|
|
GPIO_Init(GPIOBL, &GPIO_InitStructure);
|
|
GPIO_PinAFConfig(GPIOBL, GPIO_PinSource_BL, Pin_BL_AF);
|
|
GPIO_PinAFConfig(GPIOBL, GPIO_PinSource_BLW, Pin_BL_AF);
|
|
|
|
RCC->APB1ENR |= RCC_APB1ENR_TIM4EN ; // Enable clock
|
|
TIM4->ARR = 100 ;
|
|
TIM4->PSC = (PERI1_FREQUENCY * TIMER_MULT_APB1) / 50000 - 1; // 20us * 100 = 2ms => 500Hz
|
|
TIM4->CCMR1 = TIM_CCMR1_OC2M_1 | TIM_CCMR1_OC2M_2 ; // PWM
|
|
TIM4->CCMR2 = TIM_CCMR2_OC4M_1 | TIM_CCMR2_OC4M_2 ; // PWM
|
|
TIM4->CCER = TIM_CCER_CC4E | TIM_CCER_CC2E ;
|
|
TIM4->CCR2 = 0 ;
|
|
TIM4->CCR4 = 0 ;
|
|
TIM4->EGR = 0 ;
|
|
TIM4->CR1 = TIM_CR1_CEN ; // Counter enable
|
|
#else
|
|
GPIO_InitStructure.GPIO_Pin = GPIO_Pin_BL;
|
|
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF;
|
|
GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
|
|
GPIO_InitStructure.GPIO_OType = GPIO_OType_PP;
|
|
GPIO_InitStructure.GPIO_PuPd = GPIO_PuPd_NOPULL;
|
|
GPIO_Init(GPIOBL, &GPIO_InitStructure);
|
|
GPIO_PinAFConfig(GPIOBL, GPIO_PinSource_BL, Pin_BL_AF);
|
|
|
|
RCC->APB2ENR |= RCC_APB2ENR_TIM10EN ; // Enable clock
|
|
TIM10->ARR = 100 ;
|
|
TIM10->PSC = (PERI2_FREQUENCY * TIMER_MULT_APB2) / 50000 - 1; // 20us * 100 = 2ms => 500Hz
|
|
TIM10->CCMR1 = 0x60 ; // PWM
|
|
TIM10->CCER = 1 ;
|
|
TIM10->CCR1 = 80;
|
|
TIM10->EGR = 0 ;
|
|
TIM10->CR1 = 1 ;
|
|
#endif
|
|
}
|
|
|
|
/** Init the anolog spi gpio
|
|
*/
|
|
static void LCD_Hardware_Init()
|
|
{
|
|
RCC_AHB1PeriphClockCmd(RCC_AHB1Periph_LCD, ENABLE);
|
|
|
|
GPIO_InitTypeDef GPIO_InitStructure;
|
|
|
|
/*!< Configure lcd CLK\ MOSI\ A0pin in output pushpull mode *************/
|
|
GPIO_InitStructure.GPIO_Pin = PIN_LCD_MOSI | PIN_LCD_CLK | PIN_LCD_A0;
|
|
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_OUT;
|
|
GPIO_InitStructure.GPIO_OType = GPIO_OType_PP;
|
|
GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
|
|
GPIO_InitStructure.GPIO_PuPd = GPIO_PuPd_NOPULL;
|
|
GPIO_Init(GPIO_LCD_SPI, &GPIO_InitStructure);
|
|
|
|
LCD_NCS_HIGH();
|
|
|
|
/*!< Configure lcd NCS pin in output pushpull mode ,PULLUP *************/
|
|
GPIO_InitStructure.GPIO_Pin = PIN_LCD_NCS;
|
|
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_OUT;
|
|
GPIO_InitStructure.GPIO_OType = GPIO_OType_PP;
|
|
GPIO_InitStructure.GPIO_Speed = GPIO_Speed_2MHz;
|
|
GPIO_InitStructure.GPIO_PuPd = GPIO_PuPd_UP;
|
|
GPIO_Init(GPIO_LCD_NCS, &GPIO_InitStructure);
|
|
|
|
/*!< Configure lcd RST pin in output pushpull mode ,PULLUP *************/
|
|
GPIO_InitStructure.GPIO_Pin = PIN_LCD_RST;
|
|
GPIO_Init(GPIO_LCD_RST, &GPIO_InitStructure);
|
|
}
|
|
|
|
void LCD_OFF()
|
|
{
|
|
AspiCmd(0xE2);
|
|
Delay(20);
|
|
}
|
|
|
|
void lcdInit()
|
|
{
|
|
LCD_BL_Config();
|
|
LCD_Hardware_Init();
|
|
#if defined(REVPLUS)
|
|
initLcdSpi() ;
|
|
#endif
|
|
|
|
LCD_RST_HIGH();
|
|
Delay(5);
|
|
|
|
LCD_RST_LOW();
|
|
Delay(120); //11ms
|
|
|
|
LCD_RST_HIGH();
|
|
Delay(2500);
|
|
|
|
AspiCmd(0xE2);
|
|
Delay(2500);
|
|
LCD_Init();
|
|
Delay(120);
|
|
|
|
AspiCmd(0xAF); //dc2=1, IC into exit SLEEP MODE, dc3=1 gray=ON, dc4=1 Green Enhanc mode disabled
|
|
}
|
|
|
|
void lcdSetRefVolt(uint8_t val)
|
|
{
|
|
AspiCmd(0x81); //Set Vop
|
|
AspiCmd(val+CONTRAST_OFS); //0--255
|
|
}
|
|
|
|
#if defined(REVPLUS)
|
|
void turnBacklightOn(uint8_t level, uint8_t color)
|
|
{
|
|
TIM4->CCR4 = ((100-level)*(20-color))/20;
|
|
TIM4->CCR2 = ((100-level)*color)/20;
|
|
}
|
|
|
|
void turnBacklightOff(void)
|
|
{
|
|
TIM4->CCR4 = 0;
|
|
TIM4->CCR2 = 0;
|
|
}
|
|
#endif
|