#define FOOLOS_MODULE_NAME "kernel"
#include "config.h"

#include "lib/logger/log.h"
#include "lib/int/stdint.h"
#include "lib/bool/bool.h"

#include "smp.h"
#include "time.h"

#ifdef FOOLOS_COMPILE_FLOPPY
#include "floppy.h"
#endif


// some multiprocessor shit that should move away TODO
uint32_t c1,c2,c3;
volatile uint8_t proc;
uint32_t cpu_counter[SMP_MAX_PROC];

volatile int16_t mouse_x;
volatile int16_t mouse_y;

void kernel_ap()
{
	proc++;
	uint8_t p=proc;
	while(1)
	{
	    cpu_counter[p]++;

 	    lock_spin(0);
	    if(cpu_counter[p]%1000000==0)log(FOOLOS_MODULE_NAME,FOOLOS_LOG_DEBUG,"cpu[%d] %d",p,cpu_counter[p]);
	    lock_release(0);
	}
}

//
// KERNEL MAIN 

// this is the very heart of our operating system!
//

void kernel_main(uint32_t initial_stack, int mp)
{



    /// TODO
/////// SYMMETRIC MULTIPROCESSING, APS get caought here, move it away ///
    // catch the APs (Application Processors)
    if(mp==1)
    {
	uint32_t ebp=pmmngr_alloc_block()+4095;

	asm volatile("mov %0, %%ebp"::"r"(ebp));
        asm volatile("mov %ebp, %esp");
        asm volatile("jmp kernel_ap");
    }

    proc=c1=c2=c3=0;
    for(int i=0;i<SMP_MAX_PROC;i++)cpu_counter[i]=0;
    
/////////////////// BULLSHIT ABOVE THIS LINE: TODO: CLEANUP

    // 
    // system time
    //
    task_system_clock=0;
    
    //
    // init system log ringbugger
    // 
    log_init();

    // 
    // We want to get output to the screen as fast as possible!
    //
    // Our Fool-Boot-Loader did set up VESA already for us.
    // The desired VESA mode is hardcoded in [boot/mbr.asm].
    //
    // The [vesa_init(...)] function requires:
    //
    //	* the addresses of the vbeinfo struct
    //	* the address of the vbemodeinfo struct (for selected mode).
    //	* Fool Font loaded inside ramimage
    //
    //	The first two paramters are hardcoded in [boot/mbr.asm],
    //	while the last one is set in the Makefile. The font binary
    //	is integrated in the kernel image.
    //
    //  this function returns the physical base address of 
    //  our video memory 
    //
    uint32_t vesa_physbase=vesa_init(0x8300,0x8400,0x80000+0x200);

    // self-log message of logger :P
    log_log();

    //
    // Print initial address of the esp stack pointer
    //
    log(FOOLOS_MODULE_NAME,FOOLOS_LOG_INFO,"initial esp: 0x%08X",initial_stack);

    //
    //  Setup PIC
    //
    log(FOOLOS_MODULE_NAME,FOOLOS_LOG_INFO,"setting up PIC.");
    pic_setup();

    //
    // Configuring the PIT timer.
    //
    timer_init();

    // mouse driver init (before interrupts)
    mouse_init();

    //
    // Setup Interrupts (code segment: 0x08)
    //
    int_init(0x08);

    //
    // Gather Info about other processors. (APs)
    // ACPI or MP
    //
    smp_processors procdata;    

    if(!acpi_find(&procdata))
	if(!mp_find(&procdata))
	    panic(FOOLOS_MODULE_NAME,"ACPI and MP search failed! I do not want to continue!");


    //
    //	Memory Init
    //
    //  after this is set up we can allocate and deallocate blocks
    //  of physical memory :)
    //
    //	we know that here, the bootloader placed the mamory map and
    //	the number of entries.
    //
    mem_init(0x7c00+1,*((uint16_t *)(0x7c00)));

    // init spinlocks
    init_spinlocks();

    // 
    // Start the other Processors (also before paging for some reason!)
    //
    smp_log_procdata(&procdata);
    smp_start_aps(&procdata,0x80000);	// starts at 0x80000 
					// but it will be copied over mbr
	

    //
    // Activate Virtual Memory (paging)
    //
    // paging  (pass the vesa physbase address for identity mapping)
    // TODO: we will work on this later (not needed so urgently yet)
    //
    // vmem_init(vesa_physbase);

    //
    // Scan the PCI Bus
    // 
    // We are interested in the E1000 Network Adapter in particular
    // Its driver will be hopefully implemented one day ;) TODO
    //
    //pci_init();

    //
    // Initialize Floppy Disk if activated in config.h
    // Sadly we won't use it anyway so its uncommented anyway.
    // 
    //#ifdef FOOLOS_COMPILE_FLOPPY
    //floppy_init();
    //#endif

    // 
    // "Shell"
    //
    // Will process input from the keyboard but will be completely
    // redesigned soon. TODO!!
    //
    shell_init();

    //
    // Initialize Multitasking
    //
    // For now this starts three "tasks" which are scheduled 
    // round robin style.
    //
    task_init();


    //
    // Just hang around here, if its reached. 
    // we do our tasks anyway. on the next clock tick.
    //
    //
    //vesa_init_doublebuff();
    while(1)
    {
    }
   
 
}