2023-10-14 17:49:00 +08:00

536 lines
16 KiB
C

/*
* This file is part of open_agb_firm
* Copyright (C) 2021 derrek, profi200
*
* This program is free software: you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation, either version 3 of the License, or
* (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program. If not, see <http://www.gnu.org/licenses/>.
*/
#include <string.h>
#include <stdatomic.h>
#include "types.h"
#include "fb_assert.h"
#include "drivers/gfx.h"
#include "arm11/drivers/cfg11.h"
#include "arm11/drivers/pdn.h"
#include "arm11/drivers/lcd.h"
#include "arm11/drivers/gx.h"
#include "arm11/drivers/gpu_regs.h"
#include "mem_map.h"
#include "mmio.h"
#include "arm11/drivers/i2c.h"
#include "arm11/drivers/mcu.h"
#include "arm11/debug.h"
#include "arm11/drivers/interrupt.h"
#include "arm11/drivers/timer.h"
#include "arm.h"
#include "util.h"
#include "arm11/allocator/vram.h"
#include "kevent.h"
#define MCU_LCD_IRQ_MASK (MCU_IRQ_TOP_BL_ON | MCU_IRQ_TOP_BL_OFF | \
MCU_IRQ_BOT_BL_ON | MCU_IRQ_BOT_BL_OFF | \
MCU_IRQ_LCD_POWER_ON | MCU_IRQ_LCD_POWER_OFF)
static struct
{
u32 swap; // Currently active framebuffer.
void *framebufs[2][4]; // For each screen A1, A2, B1, B2
KHandle events[6];
u8 doubleBuf[2]; // Top, bottom, 1 = enable.
u8 lcdPower; // 1 = on. Bit 4 top light, bit 2 bottom light, bit 0 LCDs.
u16 lcdLights[2]; // LCD backlight brightness. Top, bottom.
u32 formats[2]; // Top, bottom
u16 strides[2]; // Top, bottom
} g_gfxState = {0};
static u8 fmt2PixSize(GfxFbFmt fmt);
static void setupFramebufs(GfxFbFmt fmtTop, GfxFbFmt fmtBot);
static void deallocFramebufs(void);
static void setupDislayController(u8 lcd);
void GFX_init(GfxFbFmt fmtTop, GfxFbFmt fmtBot)
{
g_gfxState.lcdPower = 0x15; // All on.
setupFramebufs(fmtTop, fmtBot);
g_gfxState.doubleBuf[0] = 1;
g_gfxState.doubleBuf[1] = 1;
// FIXME: Temporary workaround for screen init compatibility (Luma/fb3DS 1.2).
TIMER_sleepMs(50);
(void)MCU_getIrqs(MCU_LCD_IRQ_MASK); // Discard any screen init events.
getCfg11Regs()->gpuprot = GPUPROT_NO_PROT;
// Reset the whole GX block.
Pdn *const pdn = getPdnRegs();
pdn->gpu_cnt = PDN_GPU_CNT_CLK_EN;
wait_cycles(12);
pdn->gpu_cnt = PDN_GPU_CNT_CLK_EN | PDN_GPU_CNT_NORST_ALL;
REG_GX_GPU_CLK = 0x100; // P3D
REG_GX_PSC_VRAM = 0; // All VRAM banks enabled.
// These 3 reg writes are normally done way later in the
// init but we will be fine doing it early.
REG_GX_PSC_FILL0_CNT = 0;
REG_GX_PSC_FILL1_CNT = 0;
REG_GX_PPF_CNT = 0;
// PDC/framebuffer setup. This must be done before LCD init.
setupDislayController(0);
setupDislayController(1);
REG_LCD_PDC0_SWAP = 0; // Select framebuf 0.
REG_LCD_PDC1_SWAP = 0; // Select framebuf 0.
REG_LCD_PDC0_CNT = PDC_CNT_OUT_E | PDC_CNT_I_MASK_ERR | PDC_CNT_I_MASK_H | PDC_CNT_E; // Start
REG_LCD_PDC1_CNT = PDC_CNT_OUT_E | PDC_CNT_I_MASK_ALL | PDC_CNT_E; // Start
// LCD reg setup.
REG_LCD_ABL0_FILL = 1u<<24; // Force blackscreen.
REG_LCD_ABL1_FILL = 1u<<24; // Force blackscreen.
REG_LCD_PARALLAX_CNT = 0;
REG_LCD_PARALLAX_PWM = 0xA390A39;
REG_LCD_RST = 0; // Reset LCD drivers. Unknown for how long this must be low.
// GSP seems to rely on boot11/previous FIRM having set it to 0 already.
REG_LCD_UNK00C = 0x10001; // Stops H-/V-sync control signals?
// Create IRQ events.
// PSC0, PSC1, PDC0, PDC1, PPF, P3D
for(u8 i = 0; i < 6; i++)
{
KHandle tmp = createEvent(false);
bindInterruptToEvent(tmp, IRQ_PSC0 + i, 14);
g_gfxState.events[i] = tmp;
}
// Clear entire VRAM.
GX_memoryFill((u32*)VRAM_BANK0, 1u<<9, VRAM_SIZE / 2, 0,
(u32*)VRAM_BANK1, 1u<<9, VRAM_SIZE / 2, 0);
// Backlight and other stuff.
REG_LCD_ABL0_LIGHT = 0;
REG_LCD_ABL0_CNT = 0;
REG_LCD_ABL0_LIGHT_PWM = 0;
REG_LCD_ABL1_LIGHT = 0;
REG_LCD_ABL1_CNT = 0;
REG_LCD_ABL1_LIGHT_PWM = 0;
// Timing critical part start.
// This must be done within 4 frames.
REG_LCD_RST = 1; // Take LCD drivers out of reset.
// At this point the output must be forced black or
// the LCD drivers will not sync. Already done above.
REG_LCD_UNK00C = 0; // Starts H-/V-sync control signals?
TIMER_sleepMs(10); // Wait for power supply (which?) to stabilize and LCD drivers to finish resetting.
LCDI2C_init(); // Initialize LCD drivers.
MCU_setLcdPower(2u); // Power on LCDs (MCU --> PMIC).
// Timing critical part end.
// Wait 50 us for LCD sync. The MCU event wait will cover this.
if(MCU_waitIrqs(MCU_LCD_IRQ_MASK) != MCU_IRQ_LCD_POWER_ON) panic();
// The transfer engine is (sometimes) borked on screen init.
// Doing a dummy texture copy fixes it.
// TODO: Proper fix.
//GX_textureCopy((u32*)RENDERBUF_TOP, 0, (u32*)RENDERBUF_BOT, 0, 16);
LCDI2C_waitBacklightsOn();
REG_LCD_ABL0_LIGHT_PWM = 0x1023E; // TODO: Figure out how this works.
REG_LCD_ABL0_LIGHT = 1;
REG_LCD_ABL1_LIGHT_PWM = 0x1023E; // TODO: Figure out how this works.
REG_LCD_ABL1_LIGHT = 1;
MCU_setLcdPower(0x28u); // Power on backlights.
if(MCU_waitIrqs(MCU_LCD_IRQ_MASK) != (MCU_IRQ_TOP_BL_ON | MCU_IRQ_BOT_BL_ON)) panic();
// Make sure the fills finished.
GFX_waitForPSC0();
GFX_waitForPSC1();
REG_LCD_ABL0_FILL = 0;
REG_LCD_ABL1_FILL = 0;
// GPU stuff.
REG_GX_GPU_CLK = 0x70100;
*((vu32*)0x10400050) = 0x22221200;
*((vu32*)0x10400054) = 0xFF2;
REG_GX_P3D(GPUREG_IRQ_ACK) = 0;
REG_GX_P3D(GPUREG_IRQ_CMP) = 0x12345678;
REG_GX_P3D(GPUREG_IRQ_MASK) = 0xFFFFFFF0;
REG_GX_P3D(GPUREG_IRQ_AUTOSTOP) = 1;
// This reg needs to be set to 1 (configuration)
// before running the first cmd list.
REG_GX_P3D(GPUREG_START_DRAW_FUNC0) = 1;
}
void GFX_deinit(void)
{
// Power off backlights if on.
const u8 power = g_gfxState.lcdPower;
if(power & ~1u)
{
MCU_setLcdPower(power & ~1u);
if(MCU_waitIrqs(MCU_LCD_IRQ_MASK) != (u32)(power & ~1u)<<24) panic();
}
GFX_setBrightness(0, 0);
REG_LCD_ABL0_LIGHT_PWM = 0;
REG_LCD_ABL1_LIGHT_PWM = 0;
// Make sure the LCDs are completely black.
REG_LCD_ABL0_FILL = 1u<<24; // Force blackscreen.
REG_LCD_ABL1_FILL = 1u<<24; // Force blackscreen.
GFX_waitForVBlank0();
GFX_waitForVBlank0();
// Reset the LCD drivers.
// And stop the H-/V-sync control signals?
REG_LCD_RST = 0;
REG_LCD_UNK00C = 0x10001;
// Power off LCDs if on.
if(power & 1u)
{
MCU_setLcdPower(1u);
if(MCU_waitIrqs(MCU_LCD_IRQ_MASK) != MCU_IRQ_LCD_POWER_OFF) panic();
}
// TODO: Wait until PDC is not reading any data from mem.
REG_LCD_PDC0_CNT = PDC_CNT_I_MASK_ALL; // Stop
REG_LCD_PDC0_SWAP = PDC_SWAP_RST_FIFO | PDC_SWAP_I_ALL; // Reset FIFO and clear IRQs.
REG_LCD_PDC1_CNT = PDC_CNT_I_MASK_ALL; // Start
REG_LCD_PDC1_SWAP = PDC_SWAP_RST_FIFO | PDC_SWAP_I_ALL; // Reset FIFO and clear IRQs.
REG_GX_PSC_VRAM = 0xF00;
REG_GX_GPU_CLK = 0;
getPdnRegs()->gpu_cnt = PDN_GPU_CNT_CLK_EN | PDN_GPU_CNT_NORST_REGS;
deallocFramebufs();
// PSC0, PSC1, PDC0, PDC1, PPF, P3D
for(u8 i = 0; i < 6; i++)
{
unbindInterruptEvent(IRQ_PSC0 + i);
deleteEvent(g_gfxState.events[i]);
g_gfxState.events[i] = 0;
}
}
void GFX_setFramebufFmt(GfxFbFmt fmtTop, GfxFbFmt fmtBot)
{
REG_LCD_ABL0_FILL = 1u<<24; // Force blackscreen
REG_LCD_ABL1_FILL = 1u<<24; // Force blackscreen
if(fmtTop < (g_gfxState.formats[0] & 7u) || fmtBot < (g_gfxState.formats[1] & 7u))
{
deallocFramebufs();
setupFramebufs(fmtTop, fmtBot);
}
// Update PDC regs.
REG_LCD_PDC0_FB_A1 = (u32)g_gfxState.framebufs[0][0];
REG_LCD_PDC0_FB_A2 = (u32)g_gfxState.framebufs[0][1];
REG_LCD_PDC0_FB_B1 = (u32)g_gfxState.framebufs[0][2];
REG_LCD_PDC0_FB_B2 = (u32)g_gfxState.framebufs[0][3];
REG_LCD_PDC0_STRIDE = g_gfxState.strides[0];
REG_LCD_PDC0_FMT = g_gfxState.formats[0];
REG_LCD_PDC1_FB_A1 = (u32)g_gfxState.framebufs[1][0];
REG_LCD_PDC1_FB_A2 = (u32)g_gfxState.framebufs[1][1];
REG_LCD_PDC1_FB_B1 = (u32)g_gfxState.framebufs[1][2];
REG_LCD_PDC1_FB_B2 = (u32)g_gfxState.framebufs[1][3];
REG_LCD_PDC1_STRIDE = g_gfxState.strides[1];
REG_LCD_PDC1_FMT = g_gfxState.formats[1];
REG_LCD_ABL0_FILL = 0;
REG_LCD_ABL1_FILL = 0;
}
static u8 fmt2PixSize(GfxFbFmt fmt)
{
u8 size;
switch(fmt)
{
case GFX_RGBA8:
size = 4;
break;
case GFX_BGR8:
size = 3;
break;
default: // 2 = RGB565, 3 = RGB5A1, 4 = RGBA4
size = 2;
}
return size;
}
static void setupFramebufs(GfxFbFmt fmtTop, GfxFbFmt fmtBot)
{
const u8 topPixSize = fmt2PixSize(fmtTop);
const u8 botPixSize = fmt2PixSize(fmtBot);
g_gfxState.strides[0] = 240u * topPixSize; // No gap.
g_gfxState.strides[1] = 240u * botPixSize; // No gap.
const u32 topSize = 400u * 240 * topPixSize;
const u32 botSize = 320u * 240 * botPixSize;
g_gfxState.framebufs[0][0] = vramAlloc(topSize); // Top A1 (3D left eye)
void *botPtr = vramAlloc(botSize);
g_gfxState.framebufs[1][0] = botPtr; // Bottom A1
g_gfxState.framebufs[1][2] = botPtr; // Bottom B1 (unused)
g_gfxState.framebufs[0][2] = vramAlloc(topSize); // Top B1 (3D right eye)
g_gfxState.framebufs[0][1] = vramAlloc(topSize); // Top A2 (3D left eye)
botPtr = vramAlloc(botSize);
g_gfxState.framebufs[1][1] = botPtr; // Bottom A2
g_gfxState.framebufs[1][3] = botPtr; // Bottom B2 (unused)
g_gfxState.framebufs[0][3] = vramAlloc(topSize); // Top B2 (3D right eye)
g_gfxState.formats[0] = 0u<<16 | 3u<<8 | 1u<<6 | 0u<<4 | fmtTop;
g_gfxState.formats[1] = 0u<<16 | 3u<<8 | 0u<<6 | 0u<<4 | fmtBot;
}
static void deallocFramebufs(void)
{
vramFree(g_gfxState.framebufs[0][3]);
vramFree(g_gfxState.framebufs[1][1]);
vramFree(g_gfxState.framebufs[0][1]);
vramFree(g_gfxState.framebufs[0][2]);
vramFree(g_gfxState.framebufs[1][0]);
vramFree(g_gfxState.framebufs[0][0]);
}
static void setupDislayController(u8 lcd)
{
if(lcd > 1) return;
static const u32 displayCfgs[2][24] =
{
{
// PDC0 regs 0-0x4C.
450, 209, 449, 449, 0, 207, 209, 453<<16 | 449,
1<<16 | 0, 413, 2, 402, 402, 402, 1, 2,
406<<16 | 402, 0, 0<<4 | 0, 0<<16 | 0xFF<<8 | 0,
// PDC0 regs 0x5C-0x64.
400<<16 | 240, // Width and height.
449<<16 | 209,
402<<16 | 2,
// PDC0 reg 0x9C.
0<<16 | 0
},
{
// PDC1 regs 0-0x4C.
450, 209, 449, 449, 205, 207, 209, 453<<16 | 449,
1<<16 | 0, 413, 82, 402, 402, 79, 80, 82,
408<<16 | 404, 0, 1<<4 | 1, 0<<16 | 0<<8 | 0xFF,
// PDC1 regs 0x5C-0x64.
320<<16 | 240, // Width and height.
449<<16 | 209,
402<<16 | 82,
// PDC1 reg 0x9C.
0<<16 | 0
}
};
const u32 *const cfg = displayCfgs[lcd];
vu32 *const regs = (vu32*)(GX_REGS_BASE + 0x400 + (0x100u * lcd));
iomemcpy(regs, cfg, 0x50); // PDC regs 0-0x4C.
iomemcpy(regs + 23, &cfg[20], 0xC); // PDC regs 0x5C-0x64.
regs[36] = g_gfxState.strides[lcd]; // PDC reg 0x90 stride.
regs[39] = cfg[23]; // PDC reg 0x9C.
// PDC regs 0x68, 0x6C, 0x94, 0x98 and 0x70.
regs[26] = (u32)g_gfxState.framebufs[lcd][0]; // Framebuffer A first address.
regs[27] = (u32)g_gfxState.framebufs[lcd][1]; // Framebuffer A second address.
regs[37] = (u32)g_gfxState.framebufs[lcd][2]; // Framebuffer B first address.
regs[38] = (u32)g_gfxState.framebufs[lcd][3]; // Framebuffer B second address.
regs[28] = g_gfxState.formats[lcd]; // Format
regs[32] = 0; // Gamma table index 0.
for(u32 i = 0; i < 256; i++) regs[33] = 0x10101u * i;
}
void GFX_powerOnBacklights(GfxBlight mask)
{
fb_assert((mask & ~GFX_BLIGHT_BOTH) == 0u);
g_gfxState.lcdPower |= mask;
mask <<= 1;
MCU_setLcdPower(mask); // Power on backlights.
if(MCU_waitIrqs(MCU_LCD_IRQ_MASK) != (u32)mask<<24) panic();
}
void GFX_powerOffBacklights(GfxBlight mask)
{
fb_assert((mask & ~GFX_BLIGHT_BOTH) == 0u);
g_gfxState.lcdPower &= ~mask;
MCU_setLcdPower(mask); // Power off backlights.
if(MCU_waitIrqs(MCU_LCD_IRQ_MASK) != (u32)mask<<24) panic();
}
void GFX_setBrightness(u16 top, u16 bot)
{
top &= 0x3ff;
bot &= 0x3ff;
g_gfxState.lcdLights[0] = top;
g_gfxState.lcdLights[1] = bot;
REG_LCD_ABL0_LIGHT = top;
REG_LCD_ABL1_LIGHT = bot;
}
void GFX_setForceBlack(bool top, bool bot)
{
REG_LCD_ABL0_FILL = (u32)top<<24; // Force blackscreen
REG_LCD_ABL1_FILL = (u32)bot<<24; // Force blackscreen
}
void GFX_setDoubleBuffering(u8 screen, bool dBuf)
{
g_gfxState.doubleBuf[screen] = dBuf;
if(!dBuf)
{
if(screen == SCREEN_TOP) REG_LCD_PDC0_SWAP = 0;
else REG_LCD_PDC1_SWAP = 0;
}
}
void* GFX_getFramebuffer(u8 screen)
{
const u32 idx = (g_gfxState.swap ^ 1u) & g_gfxState.doubleBuf[screen];
return g_gfxState.framebufs[screen][idx];
}
void GFX_swapFramebufs(void)
{
u32 swap = g_gfxState.swap;
swap ^= 1u;
g_gfxState.swap = swap;
swap |= PDC_SWAP_I_ALL; // Acknowledge IRQs.
if(g_gfxState.doubleBuf[0]) REG_LCD_PDC0_SWAP = swap;
if(g_gfxState.doubleBuf[1]) REG_LCD_PDC1_SWAP = swap;
}
void GFX_waitForEvent(GfxEvent event, bool discard)
{
KHandle kevent = g_gfxState.events[event];
if(discard) clearEvent(kevent);
waitForEvent(kevent);
clearEvent(kevent);
}
void GX_memoryFill(u32 *buf0a, u32 buf0v, u32 buf0Sz, u32 val0, u32 *buf1a, u32 buf1v, u32 buf1Sz, u32 val1)
{
if(buf0a)
{
REG_GX_PSC_FILL0_S_ADDR = (u32)buf0a>>3;
REG_GX_PSC_FILL0_E_ADDR = ((u32)buf0a + buf0Sz)>>3;
REG_GX_PSC_FILL0_VAL = val0;
REG_GX_PSC_FILL0_CNT = buf0v | 1u; // Pattern + start
}
if(buf1a)
{
REG_GX_PSC_FILL1_S_ADDR = (u32)buf1a>>3;
REG_GX_PSC_FILL1_E_ADDR = ((u32)buf1a + buf1Sz)>>3;
REG_GX_PSC_FILL1_VAL = val1;
REG_GX_PSC_FILL1_CNT = buf1v | 1u; // Pattern + start
}
}
// Example: GX_displayTransfer(in, 160u<<16 | 240u, out, 160u<<16 | 240u, 2u<<12 | 2u<<8);
// Copy and unswizzle GBA sized frame in RGB565.
void GX_displayTransfer(const u32 *const in, u32 indim, u32 *out, u32 outdim, u32 flags)
{
if(!in || !out) return;
REG_GX_PPF_IN_ADDR = (u32)in>>3;
REG_GX_PPF_OUT_ADDR = (u32)out>>3;
REG_GX_PPF_DT_INDIM = indim;
REG_GX_PPF_DT_OUTDIM = outdim;
REG_GX_PPF_FlAGS = flags;
REG_GX_PPF_UNK14 = 0;
REG_GX_PPF_CNT = 1;
}
// Example: GX_textureCopy(in, (240 * 2)<<12 | (240 * 2)>>4, out, (240 * 2)<<12 | (240 * 2)>>4, 240 * 400);
// Copies every second line of a 240x400 framebuffer.
void GX_textureCopy(const u32 *const in, u32 indim, u32 *out, u32 outdim, u32 size)
{
if(!in || !out) return;
REG_GX_PPF_IN_ADDR = (u32)in>>3;
REG_GX_PPF_OUT_ADDR = (u32)out>>3;
REG_GX_PPF_FlAGS = 1u<<3;
REG_GX_PPF_LEN = size;
REG_GX_PPF_TC_INDIM = indim;
REG_GX_PPF_TC_OUTDIM = outdim;
REG_GX_PPF_CNT = 1;
}
void GX_processCommandList(u32 size, const u32 *const cmdList)
{
REG_GX_P3D(GPUREG_IRQ_ACK) = 0; // Acknowledge last P3D.
while(REG_GX_PSC_STAT & 1u<<31) wait_cycles(0x30);
REG_GX_P3D(GPUREG_CMDBUF_SIZE0) = size>>3;
REG_GX_P3D(GPUREG_CMDBUF_ADDR0) = (u32)cmdList>>3;
REG_GX_P3D(GPUREG_CMDBUF_JUMP0) = 1;
}
// TODO: Sleep mode stuff needs some work.
/*void GFX_enterLowPowerState(void)
{
REG_LCD_ABL0_FILL = 1u<<24; // Force blackscreen
REG_LCD_ABL1_FILL = 1u<<24; // Force blackscreen
GFX_waitForEvent(GFX_EVENT_PDC0, true);
// Stop PDCs.
REG_LCD_PDC0_CNT = 0x700; // Stop
REG_LCD_PDC1_CNT = 0x700; // Stop
REG_LCD_PDC0_SWAP = 0x70100;
REG_LCD_PDC1_SWAP = 0x70100;
REG_GX_PSC_VRAM = 0xF00;
getPdnRegs()->gpu_cnt = PDN_GPU_CNT_NORST_ALL;
}
void GFX_returnFromLowPowerState(void)
{
getPdnRegs()->gpu_cnt = PDN_GPU_CNT_CLK_EN | PDN_GPU_CNT_NORST_ALL;
REG_GX_PSC_VRAM = 0;
//REG_GX_GPU_CLK = 0x70100;
REG_GX_PSC_FILL0_CNT = 0;
REG_GX_PSC_FILL1_CNT = 0;
// *((vu32*)0x10400050) = 0x22221200;
// *((vu32*)0x10400054) = 0xFF2;
setupDislayController(0);
setupDislayController(1);
const u32 swap = 0x70100 | g_gfxState.swap;
REG_LCD_PDC0_SWAP = swap;
REG_LCD_PDC1_SWAP = swap;
REG_LCD_PDC0_CNT = 0x10501; // Start
REG_LCD_PDC1_CNT = 0x10501; // Start
REG_LCD_ABL0_FILL = 0;
REG_LCD_ABL1_FILL = 0;
}*/