intel.c

// Intel HD Graphics (8086:2a42) driver by NDRAEY (c) 2024
// WARNING: Driver is in WIP STAGE
// For SayoriOS ;)
 
#include "drv/pci.h"
#include "io/ports.h"
#include "io/tty.h"
#include "mem/pmm.h"
#include "mem/vmm.h"
#include "gfx/intel.h"
#include "net/endianess.h"
 
 
uint8_t igfx_bus = 0,
        igfx_slot = 0,
        igfx_func = 0;
 
size_t igfx_addr = 0;
 
size_t igfx_width = 0;
size_t igfx_height = 0;
 
#define IGFX_READ(reg) (*(volatile uint32_t*)(igfx_addr + reg))
#define IGFX_WRITE(reg, val) (*(volatile uint32_t*)(igfx_addr + reg) = (uint32_t)val)
 
#define IGFX_READ8(reg) (*(volatile uint8_t*)(igfx_addr + reg))
#define IGFX_WRITE8(reg, val) (*(volatile uint8_t*)(igfx_addr + reg) = (uint8_t)val)
 
 
volatile size_t igfx_edid_buffer[32] = {0};
 
void igfx_gmbus_reset() {
    IGFX_WRITE(IGFX_GMBUS1, 0x80000000);
    IGFX_WRITE(IGFX_GMBUS1, 0);
 
    while(IGFX_READ(IGFX_GMBUS2) & (1 << 9))
        ;
}
 
void igfx_wait() {
    while (!(IGFX_READ(IGFX_GMBUS2) & (1 << 11)))
        ;
}
 
void igfx_init() {
    // TODO: Add 0x5a85 support
    pci_find_device(0x8086, 0x2a42, &igfx_bus, &igfx_slot, &igfx_func);
 
    if(igfx_bus == 0xFF) {
        qemu_err("NO INTEL GFX!");
        tty_printf("NO INTEL GFX!\n");
 
        return;
    } else {
        qemu_ok("INTEL GFX!");
        tty_printf("INTEL GFX!\n");
    }
 
    pci_enable_bus_mastering(igfx_bus, igfx_slot, igfx_func);
 
    igfx_addr = pci_read32(igfx_bus, igfx_slot, igfx_func, PCI_BAR0) & ~0xF;
 
    map_pages(
        get_kernel_page_directory(),
        igfx_addr,
        igfx_addr,
        0x100000,
        PAGE_WRITEABLE | PAGE_CACHE_DISABLE
    );
 
    tty_printf("IGFX: %d.%d.%d AT %x\n", igfx_bus, igfx_slot, igfx_func, igfx_addr);
 
 
    // HERE GOES THE HELL
 
    size_t gmbus1 = (1 << 30) /* Ready */
                  | (1 << 26) /* Index used = 0 */
                  | (1 << 25) /* Cycle ends in WAIT */
                  | (128 << 16) /* EDID is 128 bytes long */
                  | (0x50 << 1) /* IDK why offset is 0x50 */
                  | 1; /* Read direction */
 
    tty_printf("RESETTING\n");
 
    igfx_gmbus_reset();
    
    tty_printf("OK\n");
 
    IGFX_WRITE(IGFX_GMBUS0, 3);
    IGFX_WRITE(IGFX_GMBUS1, gmbus1);
 
    tty_printf("Sent READ to controller!\n");
 
    for(int i = 0; i < 32; i++) {
        igfx_wait();
 
        uint32_t our_dword = IGFX_READ(IGFX_GMBUS3);
 
        igfx_edid_buffer[i] = our_dword;
        // tty_printf("%x %x %x %x ",
        //            (our_dword >> 24) & 0xff,
        //            (our_dword >> 16) & 0xff,
        //            (our_dword >> 8) & 0xff,
        //            our_dword  & 0xff);
    }
 
    tty_printf("\nSTOPPING TRANSACTIONS\n");
 
    IGFX_WRITE(IGFX_GMBUS1, (1 << 30) | (1 << 27));
 
    tty_printf("\nOKAY!\n");
 
 
 
    uint8_t* data = (uint8_t*)igfx_edid_buffer;
 
    igfx_width = ((data[0x3a] >> 4) << 8) | (data[0x38]);
    igfx_height = ((data[0x3d] >> 4) << 8) | (data[0x3b]);
 
    tty_printf("WIDTH: %d; HEIGHT: %d\n", igfx_width, igfx_height);
 
 
    asm volatile("cli");
 
 
    // START
    IGFX_WRITE(0x70080, IGFX_READ(0x70080) & ~0x27);
    IGFX_WRITE(0x70084, 0);
 
    IGFX_WRITE(0x700c0, IGFX_READ(0x700c0) & ~0x27);
    IGFX_WRITE(0x700c4, 0);
 
    IGFX_WRITE(0x70180, IGFX_READ(0x70180) & ~(1 << 31));
    IGFX_WRITE(0x70184, 0);
 
    IGFX_WRITE(0x71180, IGFX_READ(0x71180) & ~(1 << 31));
    IGFX_WRITE(0x71184, 0);
 
    // MIDDLE
 
    IGFX_WRITE(0x70024, IGFX_READ(0x70024) | 0x2);
    IGFX_WRITE(0x71024, IGFX_READ(0x71024) | 0x2);
 
    IGFX_WRITE(0x70008, IGFX_READ(0x70008) & ~(1 << 31)); // disable pipe
    IGFX_WRITE(0x71008, IGFX_READ(0x71008) & ~(1 << 31)); // disable pipe
 
    while(IGFX_READ(0x70008) & (1 << 30)) {}
    while(IGFX_READ(0x71008) & (1 << 30)) {}
 
    size_t xaddr = 0x60000;
 
    if((IGFX_READ(0x61180) & (1 << 30))) {
        xaddr += 0x1000;
    }
    
    uint32_t command = (igfx_width - 1);
    command <<= 16;
    command |= (igfx_height - 1);
 
    // uint32_t command_old = ((command & 0xffff) << 16) | ((command >> 16) & 0xffff);
 
    IGFX_WRITE(xaddr + 0x1C, command);
    // IGFX_WRITE(xaddr + 0x10190, command_old);
 
    uint32_t scanline_w = ((igfx_width + 15) & ~15) << 2;
 
    IGFX_WRITE(xaddr + 0x10188, scanline_w);
    IGFX_WRITE(xaddr + 0x10184, 0);
    IGFX_WRITE(xaddr + 0x1019c, (uint32_t)framebuffer_addr); // addr
    IGFX_WRITE(xaddr + 0x10184, 0);
 
    // END
    IGFX_WRITE(0x61230, IGFX_READ(0x61230) & ~(1 << 31)); // disable panel fitting
    IGFX_WRITE(xaddr + 0x10008, IGFX_READ(xaddr + 0x10008) | (1 << 31)); // enable pipe
    IGFX_WRITE(xaddr + 0x10180, IGFX_READ(xaddr + 0x10180) | (1 << 31)); // enable Display Plane A
 
 
//    unmap_pages_overlapping(get_kernel_page_directory(), (virtual_addr_t)framebuffer_addr, framebuffer_size);
//
//    framebuffer_size = ALIGN((igfx_width + 32) * igfx_height * 4, PAGE_SIZE);
//
//    map_pages(get_kernel_page_directory(),
//              (physical_addr_t)framebuffer_addr,
//              (virtual_addr_t)framebuffer_addr,
//              framebuffer_size,
//              PAGE_WRITEABLE);
//
//  memset(framebuffer_addr, 0xff, framebuffer_size);
//
//    extern uint32_t framebuffer_width;
//    extern uint32_t framebuffer_height;
//
//    framebuffer_width = igfx_width;
//    framebuffer_height = igfx_height;
//    framebuffer_pitch = scanline_w;
//
//    back_framebuffer_addr = krealloc(back_framebuffer_addr, framebuffer_size);
//    memset(back_framebuffer_addr, 0x00, framebuffer_size);
 
    graphics_update(igfx_width, igfx_height, scanline_w);
 
    clean_tty_screen();
 
    tty_printf("Screen now tuned to: %dx%d;  Size: %d; BackFB: %x\n", igfx_width, igfx_height, framebuffer_size, back_framebuffer_addr);
 
    asm volatile("sti");
}