mirror of
https://github.com/Atmosphere-NX/Atmosphere.git
synced 2024-11-06 12:11:43 +00:00
249 lines
7.4 KiB
C
249 lines
7.4 KiB
C
#include <string.h>
|
|
|
|
#include "di.h"
|
|
#include "timers.h"
|
|
#include "i2c.h"
|
|
#include "pmc.h"
|
|
#include "max77620.h"
|
|
#include "gpio.h"
|
|
#include "pinmux.h"
|
|
#include "car.h"
|
|
|
|
#include "di.inl"
|
|
|
|
static uint32_t _display_ver = 0;
|
|
|
|
static void exec_cfg(uint32_t *base, const cfg_op_t *ops, uint32_t num_ops)
|
|
{
|
|
for (uint32_t i = 0; i < num_ops; i++)
|
|
base[ops[i].off] = ops[i].val;
|
|
}
|
|
|
|
static void _display_dsi_wait(uint32_t timeout, uint32_t off, uint32_t mask)
|
|
{
|
|
uint32_t end = get_time_us() + timeout;
|
|
while ((get_time_us() < end) && (MAKE_DSI_REG(off) & mask)) {
|
|
/* Wait. */
|
|
}
|
|
udelay(5);
|
|
}
|
|
|
|
void display_init()
|
|
{
|
|
volatile tegra_car_t *car = car_get_regs();
|
|
volatile tegra_pmc_t *pmc = pmc_get_regs();
|
|
volatile tegra_pinmux_t *pinmux = pinmux_get_regs();
|
|
|
|
/* Power on. */
|
|
uint8_t val = 0xD0;
|
|
i2c_send(I2C_5, MAX77620_PWR_I2C_ADDR, MAX77620_REG_LDO0_CFG, &val, 1);
|
|
val = 0x09;
|
|
i2c_send(I2C_5, MAX77620_PWR_I2C_ADDR, MAX77620_REG_GPIO7, &val, 1);
|
|
|
|
/* Enable MIPI CAL, DSI, DISP1, HOST1X, UART_FST_MIPI_CAL, DSIA LP clocks. */
|
|
car->rst_dev_h_clr = 0x1010000;
|
|
car->clk_enb_h_set = 0x1010000;
|
|
car->rst_dev_l_clr = 0x18000000;
|
|
car->clk_enb_l_set = 0x18000000;
|
|
car->clk_enb_x_set = 0x20000;
|
|
car->clk_source_uart_fst_mipi_cal = 0xA;
|
|
car->clk_enb_w_set = 0x80000;
|
|
car->clk_source_dsia_lp = 0xA;
|
|
|
|
/* DPD idle. */
|
|
pmc->io_dpd_req = 0x40000000;
|
|
pmc->io_dpd2_req = 0x40000000;
|
|
|
|
/* Configure pins. */
|
|
pinmux->nfc_en &= ~PINMUX_TRISTATE;
|
|
pinmux->nfc_int &= ~PINMUX_TRISTATE;
|
|
pinmux->lcd_bl_pwm &= ~PINMUX_TRISTATE;
|
|
pinmux->lcd_bl_en &= ~PINMUX_TRISTATE;
|
|
pinmux->lcd_rst &= ~PINMUX_TRISTATE;
|
|
|
|
/* Configure Backlight +-5V GPIOs. */
|
|
gpio_configure_mode(GPIO_LCD_BL_P5V, GPIO_MODE_GPIO);
|
|
gpio_configure_mode(GPIO_LCD_BL_N5V, GPIO_MODE_GPIO);
|
|
gpio_configure_direction(GPIO_LCD_BL_P5V, GPIO_DIRECTION_OUTPUT);
|
|
gpio_configure_direction(GPIO_LCD_BL_N5V, GPIO_DIRECTION_OUTPUT);
|
|
|
|
/* Enable Backlight +5V. */
|
|
gpio_write(GPIO_LCD_BL_P5V, GPIO_LEVEL_HIGH);
|
|
|
|
udelay(10000);
|
|
|
|
/* Enable Backlight -5V. */
|
|
gpio_write(GPIO_LCD_BL_N5V, GPIO_LEVEL_HIGH);
|
|
|
|
udelay(10000);
|
|
|
|
/* Configure Backlight PWM, EN and RST GPIOs. */
|
|
gpio_configure_mode(GPIO_LCD_BL_PWM, GPIO_MODE_GPIO);
|
|
gpio_configure_mode(GPIO_LCD_BL_EN, GPIO_MODE_GPIO);
|
|
gpio_configure_mode(GPIO_LCD_BL_RST, GPIO_MODE_GPIO);
|
|
gpio_configure_direction(GPIO_LCD_BL_PWM, GPIO_DIRECTION_OUTPUT);
|
|
gpio_configure_direction(GPIO_LCD_BL_EN, GPIO_DIRECTION_OUTPUT);
|
|
gpio_configure_direction(GPIO_LCD_BL_RST, GPIO_DIRECTION_OUTPUT);
|
|
|
|
/* Enable Backlight EN. */
|
|
gpio_write(GPIO_LCD_BL_EN, GPIO_LEVEL_HIGH);
|
|
|
|
/* Configure display interface and display. */
|
|
MAKE_MIPI_CAL_REG(0x60) = 0;
|
|
|
|
exec_cfg((uint32_t *)CAR_BASE, _display_config_1, 4);
|
|
exec_cfg((uint32_t *)DI_BASE, _display_config_2, 94);
|
|
exec_cfg((uint32_t *)DSI_BASE, _display_config_3, 60);
|
|
|
|
udelay(10000);
|
|
|
|
/* Enable Backlight RST. */
|
|
gpio_write(GPIO_LCD_BL_RST, GPIO_LEVEL_HIGH);
|
|
|
|
udelay(60000);
|
|
|
|
MAKE_DSI_REG(DSI_BTA_TIMING) = 0x50204;
|
|
MAKE_DSI_REG(DSI_WR_DATA) = 0x337;
|
|
MAKE_DSI_REG(DSI_TRIGGER) = DSI_TRIGGER_HOST;
|
|
_display_dsi_wait(250000, DSI_TRIGGER, (DSI_TRIGGER_HOST | DSI_TRIGGER_VIDEO));
|
|
|
|
MAKE_DSI_REG(DSI_WR_DATA) = 0x406;
|
|
MAKE_DSI_REG(DSI_TRIGGER) = DSI_TRIGGER_HOST;
|
|
_display_dsi_wait(250000, DSI_TRIGGER, (DSI_TRIGGER_HOST | DSI_TRIGGER_VIDEO));
|
|
|
|
MAKE_DSI_REG(DSI_HOST_CONTROL) = (DSI_HOST_CONTROL_TX_TRIG_HOST | DSI_HOST_CONTROL_IMM_BTA | DSI_HOST_CONTROL_CS | DSI_HOST_CONTROL_ECC);
|
|
_display_dsi_wait(150000, DSI_HOST_CONTROL, DSI_HOST_CONTROL_IMM_BTA);
|
|
|
|
udelay(5000);
|
|
|
|
_display_ver = MAKE_DSI_REG(DSI_RD_DATA);
|
|
|
|
if (_display_ver == 0x10)
|
|
exec_cfg((uint32_t *)DSI_BASE, _display_config_4, 43);
|
|
|
|
MAKE_DSI_REG(DSI_WR_DATA) = 0x1105;
|
|
MAKE_DSI_REG(DSI_TRIGGER) = DSI_TRIGGER_HOST;
|
|
|
|
udelay(180000);
|
|
|
|
MAKE_DSI_REG(DSI_WR_DATA) = 0x2905;
|
|
MAKE_DSI_REG(DSI_TRIGGER) = DSI_TRIGGER_HOST;
|
|
|
|
udelay(20000);
|
|
|
|
exec_cfg((uint32_t *)DSI_BASE, _display_config_5, 21);
|
|
exec_cfg((uint32_t *)CAR_BASE, _display_config_6, 3);
|
|
|
|
MAKE_DI_REG(DC_DISP_DISP_CLOCK_CONTROL) = 4;
|
|
exec_cfg((uint32_t *)DSI_BASE, _display_config_7, 10);
|
|
|
|
udelay(10000);
|
|
|
|
exec_cfg((uint32_t *)MIPI_CAL_BASE, _display_config_8, 6);
|
|
exec_cfg((uint32_t *)DSI_BASE, _display_config_9, 4);
|
|
exec_cfg((uint32_t *)MIPI_CAL_BASE, _display_config_10, 16);
|
|
|
|
udelay(10000);
|
|
|
|
exec_cfg((uint32_t *)DI_BASE, _display_config_11, 113);
|
|
}
|
|
|
|
void display_backlight(bool enable)
|
|
{
|
|
/* Enable Backlight PWM. */
|
|
gpio_write(GPIO_LCD_BL_PWM, enable ? GPIO_LEVEL_HIGH : GPIO_LEVEL_LOW);
|
|
}
|
|
|
|
void display_end()
|
|
{
|
|
volatile tegra_car_t *car = car_get_regs();
|
|
volatile tegra_pinmux_t *pinmux = pinmux_get_regs();
|
|
|
|
/* Disable Backlight. */
|
|
display_backlight(false);
|
|
|
|
MAKE_DSI_REG(DSI_VIDEO_MODE_CONTROL) = 1;
|
|
MAKE_DSI_REG(DSI_WR_DATA) = 0x2805;
|
|
|
|
MAKE_DI_REG(DC_CMD_STATE_ACCESS) = (READ_MUX | WRITE_MUX);
|
|
MAKE_DSI_REG(DSI_VIDEO_MODE_CONTROL) = 0;
|
|
|
|
exec_cfg((uint32_t *)DI_BASE, _display_config_12, 17);
|
|
exec_cfg((uint32_t *)DSI_BASE, _display_config_13, 16);
|
|
|
|
udelay(10000);
|
|
|
|
if (_display_ver == 0x10)
|
|
exec_cfg((uint32_t *)DSI_BASE, _display_config_14, 22);
|
|
|
|
MAKE_DSI_REG(DSI_WR_DATA) = 0x1005;
|
|
MAKE_DSI_REG(DSI_TRIGGER) = DSI_TRIGGER_HOST;
|
|
|
|
udelay(50000);
|
|
|
|
/* Disable Backlight RST. */
|
|
gpio_write(GPIO_LCD_BL_RST, GPIO_LEVEL_LOW);
|
|
|
|
udelay(10000);
|
|
|
|
/* Disable Backlight -5V. */
|
|
gpio_write(GPIO_LCD_BL_N5V, GPIO_LEVEL_LOW);
|
|
|
|
udelay(10000);
|
|
|
|
/* Disable Backlight +5V. */
|
|
gpio_write(GPIO_LCD_BL_P5V, GPIO_LEVEL_LOW);
|
|
|
|
udelay(10000);
|
|
|
|
/* Disable clocks. */
|
|
car->rst_dev_h_set = 0x1010000;
|
|
car->clk_enb_h_clr = 0x1010000;
|
|
car->rst_dev_l_set = 0x18000000;
|
|
car->clk_enb_l_clr = 0x18000000;
|
|
|
|
MAKE_DSI_REG(DSI_PAD_CONTROL_0) = (DSI_PAD_CONTROL_VS1_PULLDN_CLK | DSI_PAD_CONTROL_VS1_PULLDN(0xF) | DSI_PAD_CONTROL_VS1_PDIO_CLK | DSI_PAD_CONTROL_VS1_PDIO(0xF));
|
|
MAKE_DSI_REG(DSI_POWER_CONTROL) = 0;
|
|
|
|
/* Backlight PWM. */
|
|
gpio_configure_mode(GPIO_LCD_BL_PWM, GPIO_MODE_SFIO);
|
|
|
|
pinmux->lcd_bl_pwm = ((pinmux->lcd_bl_pwm & ~PINMUX_TRISTATE) | PINMUX_TRISTATE);
|
|
pinmux->lcd_bl_pwm = (((pinmux->lcd_bl_pwm >> 2) << 2) | 1);
|
|
}
|
|
|
|
void display_color_screen(uint32_t color)
|
|
{
|
|
exec_cfg((uint32_t *)DI_BASE, cfg_display_one_color, 8);
|
|
|
|
/* Configure display to show single color. */
|
|
MAKE_DI_REG(DC_WIN_AD_WIN_OPTIONS) = 0;
|
|
MAKE_DI_REG(DC_WIN_BD_WIN_OPTIONS) = 0;
|
|
MAKE_DI_REG(DC_WIN_CD_WIN_OPTIONS) = 0;
|
|
MAKE_DI_REG(DC_DISP_BLEND_BACKGROUND_COLOR) = color;
|
|
MAKE_DI_REG(DC_CMD_STATE_CONTROL) = ((MAKE_DI_REG(DC_CMD_STATE_CONTROL) & 0xFFFFFFFE) | GENERAL_ACT_REQ);
|
|
|
|
udelay(35000);
|
|
|
|
display_backlight(true);
|
|
}
|
|
|
|
uint32_t *display_init_framebuffer(void *address)
|
|
{
|
|
static cfg_op_t conf[sizeof(cfg_display_framebuffer)/sizeof(cfg_op_t)] = {0};
|
|
if (conf[0].val == 0) {
|
|
for (uint32_t i = 0; i < sizeof(cfg_display_framebuffer)/sizeof(cfg_op_t); i++) {
|
|
conf[i] = cfg_display_framebuffer[i];
|
|
}
|
|
}
|
|
|
|
uint32_t *lfb_addr = (uint32_t *)address;
|
|
conf[19].val = (uint32_t)address;
|
|
|
|
/* This configures the framebuffer @ address with a resolution of 1280x720 (line stride 768). */
|
|
exec_cfg((uint32_t *)DI_BASE, conf, 32);
|
|
|
|
udelay(35000);
|
|
|
|
return lfb_addr;
|
|
}
|