mtgos-kernel/kernel/hw/3ds11/picafb/picafb.cpp
2017-05-20 20:04:22 +00:00

102 lines
4.1 KiB
C++

#include "picafb.hpp"
#include <config.h>
#ifdef ENABLE_SCREENINIT
#include "../mcu/mcu.hpp"
#endif
#define GL_RGBA8_OES 0
#define GL_RGB8_OES 1
#define GL_RGB565_OES 2
#define GL_RGB5_A1_OES 3
#define GL_RGBA4_OES 4
PICAfb::PICAfb() : Framebuffer(50, 15) {
#ifdef ENABLE_SCREENINIT
MCU::enableTopLCD();
MCU::enableBottomLCD();
*((uint32_t *)0x10141200) = 0x1007F; // Enable Backlights and GPU IO region
*((uint32_t *)0x10202014) = 1;
*((uint32_t *)0x1020200C) &= 0xFFFEFFFE;
*((uint32_t *)0x10202240) = 0x3F; // Top screen brightness
*((uint32_t *)0x10202A40) = 0x3F; // Bottom screen brightness
*((uint32_t *)0x10202244) = 0x1023E;
*((uint32_t *)0x10202A44) = 0x1023E;
// TODO this code is ugly and copied right out of the arm9loaderhax git
// find out what 90% of this does
// Top screen
*(volatile uint32_t *)0x10400400 = 0x000001c2;
*(volatile uint32_t *)0x10400404 = 0x000000d1;
*(volatile uint32_t *)0x10400408 = 0x000001c1;
*(volatile uint32_t *)0x1040040c = 0x000001c1;
*(volatile uint32_t *)0x10400410 = 0x00000000;
*(volatile uint32_t *)0x10400414 = 0x000000cf;
*(volatile uint32_t *)0x10400418 = 0x000000d1;
*(volatile uint32_t *)0x1040041c = 0x01c501c1;
*(volatile uint32_t *)0x10400420 = 0x00010000;
*(volatile uint32_t *)0x10400424 = 0x0000019d;
*(volatile uint32_t *)0x10400428 = 0x00000002;
*(volatile uint32_t *)0x1040042c = 0x00000192;
*(volatile uint32_t *)0x10400430 = 0x00000192;
*(volatile uint32_t *)0x10400434 = 0x00000192;
*(volatile uint32_t *)0x10400438 = 0x00000001;
*(volatile uint32_t *)0x1040043c = 0x00000002;
*(volatile uint32_t *)0x10400440 = 0x01960192;
*(volatile uint32_t *)0x10400444 = 0x00000000;
*(volatile uint32_t *)0x10400448 = 0x00000000;
*(volatile uint32_t *)0x1040045C = 0x00f00190;
*(volatile uint32_t *)0x10400460 = 0x01c100d1;
*(volatile uint32_t *)0x10400464 = 0x01920002;
*(volatile uint32_t *)0x10400468 = 0x18300000;
*(volatile uint32_t *)0x10400470 = 0x80341;
*(volatile uint32_t *)0x10400474 = 0x00010501;
*(volatile uint32_t *)0x10400478 = 0;
*(volatile uint32_t *)0x10400490 = 0x000002D0;
*(volatile uint32_t *)0x1040049C = 0x00000000;
// Disco register
for (uint32_t i = 0; i < 256; i++) *(volatile uint32_t *)0x10400484 = 0x10101 * i;
// Bottom screen
*(volatile uint32_t *)0x10400500 = 0x000001c2;
*(volatile uint32_t *)0x10400504 = 0x000000d1;
*(volatile uint32_t *)0x10400508 = 0x000001c1;
*(volatile uint32_t *)0x1040050c = 0x000001c1;
*(volatile uint32_t *)0x10400510 = 0x000000cd;
*(volatile uint32_t *)0x10400514 = 0x000000cf;
*(volatile uint32_t *)0x10400518 = 0x000000d1;
*(volatile uint32_t *)0x1040051c = 0x01c501c1;
*(volatile uint32_t *)0x10400520 = 0x00010000;
*(volatile uint32_t *)0x10400524 = 0x0000019d;
*(volatile uint32_t *)0x10400528 = 0x00000052;
*(volatile uint32_t *)0x1040052c = 0x00000192;
*(volatile uint32_t *)0x10400530 = 0x00000192;
*(volatile uint32_t *)0x10400534 = 0x0000004f;
*(volatile uint32_t *)0x10400538 = 0x00000050;
*(volatile uint32_t *)0x1040053c = 0x00000052;
*(volatile uint32_t *)0x10400540 = 0x01980194;
*(volatile uint32_t *)0x10400544 = 0x00000000;
*(volatile uint32_t *)0x10400548 = 0x00000011;
*(volatile uint32_t *)0x1040055C = 0x00f00140;
*(volatile uint32_t *)0x10400560 = 0x01c100d1;
*(volatile uint32_t *)0x10400564 = 0x01920052;
*(volatile uint32_t *)0x10400568 = 0x18300000 + 0x46500;
*(volatile uint32_t *)0x10400570 = 0x80301;
*(volatile uint32_t *)0x10400574 = 0x00010501;
*(volatile uint32_t *)0x10400578 = 0;
*(volatile uint32_t *)0x10400590 = 0x000002D0;
*(volatile uint32_t *)0x1040059C = 0x00000000;
// Disco register
for (uint32_t i = 0; i < 256; i++) *(volatile uint32_t *)0x10400584 = 0x10101 * i;
#endif
}
PICAfb::~PICAfb() {}
auto PICAfb::plotPixel(int x, int y, int col) -> void {
unsigned char *lfb = (unsigned char *)0x18300000;
y=240-y-1;
int off = (x * 240 + y) * 3;
for (int i = 0; i < 3; i++) {
lfb[off++] = col;
col >>= 8;
}
}