/*
 * Copyright (C) 2017 Robin Krahl <robin.krahl@ireas.org>
 * 
 * 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.
 */

#include <garmos/arch.h>
#include <garmos/types.h>

void irqhdl0x00(void);
void irqhdl0x01(void);

uint8_t irqnos[3] = { 0x20, 0x21, 0 };
uint32_t irqhdls[3] = {
	(uint32_t) &irqhdl0x00,
	(uint32_t) &irqhdl0x01,
	0
};

void prtset8(const uint16_t port, const uint8_t val)
{
	asm volatile("outb %0, %1" : : "a" (val), "Nd" (port));
}

void prtset16(const uint16_t port, const uint16_t val)
{
	asm volatile("outw %0, %1" : : "a" (val), "Nd" (port));
}

void prtset32(const uint16_t port, const uint32_t val)
{
	asm volatile("outl %0, %1" : : "a" (val), "Nd" (port));
}

uint8_t prtget8(const uint16_t port)
{
	uint8_t res;

	asm volatile("inb %1, %0" : "=a" (res) : "Nd" (port));

	return res;
}

uint16_t prtget16(const uint16_t port)
{
	uint16_t res;

	asm volatile("inw %1, %0" : "=a" (res) : "Nd" (port));

	return res;
}

uint32_t prtget32(const uint16_t port)
{
	uint32_t res;

	asm volatile("inl %1, %0" : "=a" (res) : "Nd" (port));

	return res;
}

void regset8(const uint32_t reg, const uint8_t val)
{
	volatile uint8_t *p = (volatile uint8_t *) reg;
	*p = val;
}

void regset16(const uint32_t reg, const uint16_t val)
{
	volatile uint16_t *p = (volatile uint16_t *) reg;
	*p = val;
}

void regset32(const uint32_t reg, const uint32_t val)
{
	volatile uint32_t *p = (volatile uint32_t *) reg;
	*p = val;
}

void gdtset(struct gdtp gdtp)
{
	asm volatile("lgdt %0" : : "m" (gdtp));
}

void idtset(struct idtp idtp)
{
	asm volatile("lidt %0" : : "m" (idtp));
}

void idtact(void)
{
	asm("sti");
}