#include "board.h"#include "utils.h"#include "bios.h"#include "flash.h"static struct config_table_struct config_table;static unsigned long get_rom_size(struct system_table_struct *sys_tbl){	unsigned long rom_size = 0;	int i;	for (i = 0; i < 4; i++)		rom_size += sys_tbl->rom_table[i].size;	return rom_size;}
static unsigned long get_dram_size(struct system_table_struct *sys_tbl){	unsigned long dram_size = 0;	int i;	for (i = 0; i < 4; i++)		dram_size += sys_tbl->dram_table[i].size;	return dram_size;}static int get_uart0_cfg(struct system_table_struct *sys_tbl, struct uart_cfg *cfg){	struct sys_uart_cfg *uart = (struct sys_uart_cfg *)&sys_tbl->uart[0];	cfg->flags = uart->flags;	if (uart->port == 0) {		cfg->base = ULCON0;		cfg->irq_rx = INT_UARTRX0;		cfg->irq_tx = INT_UARTTX0;	} else if (uart->port == 1) {		cfg->base = ULCON1;		cfg->irq_rx = INT_UARTRX1;		cfg->irq_tx = INT_UARTTX1;	} else {		cfg->base = -1;		cfg->irq_rx = -1;		cfg->irq_tx = -1;	}	cfg->dma_rx = uart->dma_rx;	cfg->dma_tx = uart->dma_tx;	cfg->mode = uart->mode;	return 0;}
static int get_uart1_cfg(struct system_table_struct *sys_tbl, struct uart_cfg *cfg){	struct sys_uart_cfg *uart = (struct sys_uart_cfg *)&sys_tbl->uart[1];	cfg->flags = uart->flags;	if (uart->port == 0) {		cfg->base = ULCON0;		cfg->irq_rx = INT_UARTRX0;		cfg->irq_tx = INT_UARTTX0;	} else if (uart->port == 1) {		cfg->base = ULCON1;		cfg->irq_rx = INT_UARTRX1;		cfg->irq_tx = INT_UARTTX1;	} else {		cfg->base = -1;		cfg->irq_rx = -1;		cfg->irq_tx = -1;	}	cfg->dma_rx = uart->dma_rx;	cfg->dma_tx = uart->dma_tx;	cfg->mode = uart->mode;	return 0;}
static int get_eth_cfg(struct system_table_struct *sys_tbl, struct eth_cfg *cfg){	struct sys_eth_cfg *eth = (struct sys_eth_cfg *)&sys_tbl->eth;	cfg->flags = eth->flags;	cfg->base = BDMATXCON;	memcpy(cfg->address, eth->address, 6);	return 0;}
static int get_ne2000_cfg(struct system_table_struct *sys_tbl, struct ne2000_cfg *cfg){	struct sys_ne2000_cfg *ne2000 = (struct sys_ne2000_cfg *)&sys_tbl->ne2000;	cfg->flags = ne2000->flags;	cfg->base = sys_tbl->ext_base + ne2000->bank * 0x4000;	memcpy(cfg->address, ne2000->address, 6);	return 0;}
static int get_uart16550_cfg(struct system_table_struct *sys_tbl, struct uart16550_cfg *cfg){	struct sys_uart16550_cfg *uart16550 = (struct sys_uart16550_cfg *)&sys_tbl->uart16550;	cfg->flags = uart16550->flags;	cfg->base = sys_tbl->ext_base + uart16550->bank * 0x4000;	cfg->clock = uart16550->clock;	return 0;}
static int get_pc97338_cfg(struct system_table_struct *sys_tbl, struct pc97338_cfg *cfg){	struct sys_uart16550_cfg *pc97338 = (struct sys_uart16550_cfg *)&sys_tbl->pc97338;	cfg->flags = pc97338->flags;	cfg->base = sys_tbl->ext_base + pc97338->bank * 0x4000;	return 0;}static int reboot(void){	void (*fp)(void);

	fp = (void (*)(void))(config_table.rom_base);
	(*fp)();	return 0;
}static int bios_call_init(struct biosapi_init_struct *init_param){	struct system_table_struct *sys_tbl;	sys_tbl = (struct system_table_struct *)		(init_param->rom_base + init_param->system_table_offset);	memset(&config_table, 0, sizeof(struct config_table_struct));	config_table.vendor_id = sys_tbl->vendor_id;	config_table.device_id = sys_tbl->device_id;	config_table.sub_vendor_id = sys_tbl->sub_vendor_id;	config_table.sub_device_id = sys_tbl->sub_device_id;	config_table.rev = sys_tbl->rev;	config_table.sys_clock = sys_tbl->sys_clock;	config_table.ext_clock = sys_tbl->ext_clock;	config_table.rom_base = init_param->rom_base;	config_table.rom_size = get_rom_size(sys_tbl);	config_table.bios_offset = 0;	config_table.bios_size = sys_tbl->bios_size;	config_table.system_table_offset = init_param->system_table_offset;	config_table.system_table_size = sys_tbl->system_table_size;	config_table.partition_table_offset = sys_tbl->partition_table_offset;	config_table.partition_table_size = sys_tbl->partition_table_size;	config_table.dram_base = init_param->dram_base;	config_table.dram_size = get_dram_size(sys_tbl);	get_uart0_cfg(sys_tbl, &config_table.uart[0]);	get_uart1_cfg(sys_tbl, &config_table.uart[1]);	get_eth_cfg(sys_tbl, &config_table.eth);	get_ne2000_cfg(sys_tbl, &config_table.ne2000);	get_pc97338_cfg(sys_tbl, &config_table.pc97338);	get_uart16550_cfg(sys_tbl, &config_table.uart16550);	config_table.startup_mode = sys_tbl->startup_mode;	config_table.tftp_ipaddr = sys_tbl->tftp_ipaddr;	flash_init();	return 0;}int bios_call_internal(unsigned long id, unsigned long arg)
{	switch (id) {	case BIOSCALL_INIT:		bios_call_init((struct biosapi_init_struct *)arg);		break;	case BIOSCALL_REBOOT:		reboot();		break;	case BIOSCALL_GET_VENDORID:		*(unsigned short *)arg = config_table.vendor_id;		break;	case BIOSCALL_GET_DEVICEID:		*(unsigned short *)arg = config_table.device_id;		break;	case BIOSCALL_GET_SUBVENDORID:		*(unsigned short *)arg = config_table.sub_vendor_id;		break;	case BIOSCALL_GET_SUBDEVICEID:		*(unsigned short *)arg = config_table.sub_device_id;		break;	case BIOSCALL_GET_REV:		*(unsigned long *)arg = config_table.rev;		break;	case BIOSCALL_GET_SYSCLOCK:		*(unsigned long *)arg = config_table.sys_clock;		break;	case BIOSCALL_GET_EXTCLOCK:		*(unsigned long *)arg = config_table.ext_clock;		break;	case BIOSCALL_GET_ROMBASE:		*(unsigned long *)arg = config_table.rom_base;		break;	case BIOSCALL_GET_ROMSIZE:		*(unsigned long *)arg = config_table.rom_size;		break;	case BIOSCALL_GET_DRAMBASE:		*(unsigned long *)arg = config_table.dram_base;		break;	case BIOSCALL_GET_DRAMSIZE:		*(unsigned long *)arg = config_table.dram_size;		break;	case BIOSCALL_GET_BIOSOFFSET:		*(unsigned long *)arg = config_table.bios_offset;		break;	case BIOSCALL_GET_BIOSSIZE:		*(unsigned long *)arg = config_table.bios_size;		break;	case BIOSCALL_GET_SYSTEMTABLEOFFSET:		*(unsigned long *)arg = config_table.system_table_offset;		break;	case BIOSCALL_GET_SYSTEMTABLESIZE:		*(unsigned long *)arg = config_table.system_table_size;		break;	case BIOSCALL_GET_PARTITIONTABLEOFFSET:		*(unsigned long *)arg = config_table.partition_table_offset;		break;	case BIOSCALL_GET_PARTITIONTABLESIZE:		*(unsigned long *)arg = config_table.partition_table_size;		break;	case BIOSCALL_FLASH_ERASE:		flash_erase(((struct flash_erase_struct *)arg)->addr,			((struct flash_erase_struct *)arg)->size);		break;	case BIOSCALL_FLASH_READ:		flash_read(((struct flash_read_struct *)arg)->from,			((struct flash_read_struct *)arg)->len,			&(((struct flash_read_struct *)arg)->retlen),			((struct flash_read_struct *)arg)->buf);		break;	case BIOSCALL_FLASH_WRITE:		flash_write(((struct flash_write_struct *)arg)->to,			((struct flash_write_struct *)arg)->len,			&(((struct flash_write_struct *)arg)->retlen),			((struct flash_write_struct *)arg)->buf);		break;	case BIOSCALL_GET_UART0CFG:		*(struct uart_cfg *)arg = config_table.uart[0];		break;	case BIOSCALL_GET_UART1CFG:		*(struct uart_cfg *)arg = config_table.uart[1];		break;	case BIOSCALL_GET_ETHCFG:		*(struct eth_cfg *)arg = config_table.eth;		break;	case BIOSCALL_GET_NE2000CFG:		*(struct ne2000_cfg *)arg = config_table.ne2000;		break;	case BIOSCALL_GET_PC97338CFG:		*(struct pc97338_cfg *)arg = config_table.pc97338;		break;	case BIOSCALL_GET_UART16550CFG:		*(struct uart16550_cfg *)arg = config_table.uart16550;		break;	case BIOSCALL_GET_STARTUPMODE:		*(unsigned long *)arg = config_table.startup_mode;		break;	case BIOSCALL_GET_TFTPIPADDR:		*(unsigned long *)arg = config_table.tftp_ipaddr;		break;	default:		return -1;	}
	return 0;
}