f5389ecf19
FPU.
221 lines
4.9 KiB
C
221 lines
4.9 KiB
C
/* system dependent functions for use inside the whole kernel. */
|
|
|
|
#include "../../kernel.h"
|
|
|
|
#include <unistd.h>
|
|
#include <ibm/cmos.h>
|
|
#include <ibm/bios.h>
|
|
#include <minix/portio.h>
|
|
#include <minix/u64.h>
|
|
|
|
#include "proto.h"
|
|
#include "../../proc.h"
|
|
|
|
#define CR0_EM 0x0004 /* set to enable trap on any FP instruction */
|
|
|
|
FORWARD _PROTOTYPE( void ser_debug, (int c));
|
|
FORWARD _PROTOTYPE( void ser_dump_stats, (void));
|
|
|
|
PUBLIC void arch_shutdown(int how)
|
|
{
|
|
/* Mask all interrupts, including the clock. */
|
|
outb( INT_CTLMASK, ~0);
|
|
|
|
if(how != RBT_RESET) {
|
|
/* return to boot monitor */
|
|
|
|
outb( INT_CTLMASK, 0);
|
|
outb( INT2_CTLMASK, 0);
|
|
|
|
/* Return to the boot monitor. Set
|
|
* the program if not already done.
|
|
*/
|
|
if (how != RBT_MONITOR)
|
|
phys_copy(vir2phys(""), kinfo.params_base, 1);
|
|
level0(monitor);
|
|
} else {
|
|
/* Reset the system by forcing a processor shutdown. First stop
|
|
* the BIOS memory test by setting a soft reset flag.
|
|
*/
|
|
u16_t magic = STOP_MEM_CHECK;
|
|
phys_copy(vir2phys(&magic), SOFT_RESET_FLAG_ADDR,
|
|
SOFT_RESET_FLAG_SIZE);
|
|
level0(reset);
|
|
}
|
|
}
|
|
|
|
PUBLIC void system_init(void)
|
|
{
|
|
prot_init();
|
|
|
|
#if 0
|
|
/* Set CR0_EM until we get FP context switching */
|
|
write_cr0(read_cr0() | CR0_EM);
|
|
#endif
|
|
}
|
|
|
|
#define COM1_BASE 0x3F8
|
|
#define COM1_THR (COM1_BASE + 0)
|
|
#define COM1_RBR (COM1_BASE + 0)
|
|
#define COM1_LSR (COM1_BASE + 5)
|
|
#define LSR_DR 0x01
|
|
#define LSR_THRE 0x20
|
|
|
|
PUBLIC void ser_putc(char c)
|
|
{
|
|
int i;
|
|
int lsr, thr;
|
|
|
|
lsr= COM1_LSR;
|
|
thr= COM1_THR;
|
|
for (i= 0; i<100000; i++)
|
|
{
|
|
if (inb( lsr) & LSR_THRE)
|
|
break;
|
|
}
|
|
outb( thr, c);
|
|
}
|
|
|
|
/*===========================================================================*
|
|
* do_ser_debug *
|
|
*===========================================================================*/
|
|
PUBLIC void do_ser_debug()
|
|
{
|
|
u8_t c, lsr;
|
|
|
|
lsr= inb(COM1_LSR);
|
|
if (!(lsr & LSR_DR))
|
|
return;
|
|
c = inb(COM1_RBR);
|
|
ser_debug(c);
|
|
}
|
|
|
|
PRIVATE void ser_debug(int c)
|
|
{
|
|
do_serial_debug++;
|
|
kprintf("ser_debug: %d\n", c);
|
|
switch(c)
|
|
{
|
|
case '1':
|
|
ser_dump_proc();
|
|
break;
|
|
case '2':
|
|
ser_dump_stats();
|
|
break;
|
|
}
|
|
do_serial_debug--;
|
|
}
|
|
|
|
PUBLIC void ser_dump_proc()
|
|
{
|
|
struct proc *pp;
|
|
|
|
for (pp= BEG_PROC_ADDR; pp < END_PROC_ADDR; pp++)
|
|
{
|
|
if (pp->p_rts_flags & SLOT_FREE)
|
|
continue;
|
|
kprintf(
|
|
"%d: 0x%02x %s e %d src %d dst %d prio %d/%d time %d/%d EIP 0x%x\n",
|
|
proc_nr(pp),
|
|
pp->p_rts_flags, pp->p_name,
|
|
pp->p_endpoint, pp->p_getfrom_e, pp->p_sendto_e,
|
|
pp->p_priority, pp->p_max_priority,
|
|
pp->p_user_time, pp->p_sys_time,
|
|
pp->p_reg.pc);
|
|
stacktrace(pp);
|
|
}
|
|
}
|
|
|
|
PRIVATE void ser_dump_stats()
|
|
{
|
|
kprintf("ipc_stats:\n");
|
|
kprintf("deadproc: %d\n", ipc_stats.deadproc);
|
|
kprintf("bad_endpoint: %d\n", ipc_stats.bad_endpoint);
|
|
kprintf("dst_not_allowed: %d\n", ipc_stats.dst_not_allowed);
|
|
kprintf("bad_call: %d\n", ipc_stats.bad_call);
|
|
kprintf("call_not_allowed: %d\n", ipc_stats.call_not_allowed);
|
|
kprintf("bad_buffer: %d\n", ipc_stats.bad_buffer);
|
|
kprintf("deadlock: %d\n", ipc_stats.deadlock);
|
|
kprintf("not_ready: %d\n", ipc_stats.not_ready);
|
|
kprintf("src_died: %d\n", ipc_stats.src_died);
|
|
kprintf("dst_died: %d\n", ipc_stats.dst_died);
|
|
kprintf("no_priv: %d\n", ipc_stats.no_priv);
|
|
kprintf("bad_size: %d\n", ipc_stats.bad_size);
|
|
kprintf("bad_senda: %d\n", ipc_stats.bad_senda);
|
|
if (ex64hi(ipc_stats.total))
|
|
{
|
|
kprintf("total: %x:%08x\n", ex64hi(ipc_stats.total),
|
|
ex64lo(ipc_stats.total));
|
|
}
|
|
else
|
|
kprintf("total: %u\n", ex64lo(ipc_stats.total));
|
|
|
|
kprintf("sys_stats:\n");
|
|
kprintf("bad_req: %d\n", sys_stats.bad_req);
|
|
kprintf("not_allowed: %d\n", sys_stats.not_allowed);
|
|
if (ex64hi(sys_stats.total))
|
|
{
|
|
kprintf("total: %x:%08x\n", ex64hi(sys_stats.total),
|
|
ex64lo(sys_stats.total));
|
|
}
|
|
else
|
|
kprintf("total: %u\n", ex64lo(sys_stats.total));
|
|
}
|
|
|
|
#if SPROFILE
|
|
|
|
PUBLIC int arch_init_profile_clock(u32_t freq)
|
|
{
|
|
int r;
|
|
/* Set CMOS timer frequency. */
|
|
outb(RTC_INDEX, RTC_REG_A);
|
|
outb(RTC_IO, RTC_A_DV_OK | freq);
|
|
/* Enable CMOS timer interrupts. */
|
|
outb(RTC_INDEX, RTC_REG_B);
|
|
r = inb(RTC_IO);
|
|
outb(RTC_INDEX, RTC_REG_B);
|
|
outb(RTC_IO, r | RTC_B_PIE);
|
|
/* Mandatory read of CMOS register to enable timer interrupts. */
|
|
outb(RTC_INDEX, RTC_REG_C);
|
|
inb(RTC_IO);
|
|
|
|
return CMOS_CLOCK_IRQ;
|
|
}
|
|
|
|
PUBLIC void arch_stop_profile_clock(void)
|
|
{
|
|
int r;
|
|
/* Disable CMOS timer interrupts. */
|
|
outb(RTC_INDEX, RTC_REG_B);
|
|
r = inb(RTC_IO);
|
|
outb(RTC_INDEX, RTC_REG_B);
|
|
outb(RTC_IO, r & ~RTC_B_PIE);
|
|
}
|
|
|
|
PUBLIC void arch_ack_profile_clock(void)
|
|
{
|
|
/* Mandatory read of CMOS register to re-enable timer interrupts. */
|
|
outb(RTC_INDEX, RTC_REG_C);
|
|
inb(RTC_IO);
|
|
}
|
|
|
|
#endif
|
|
|
|
#define COLOR_BASE 0xB8000L
|
|
|
|
PUBLIC void cons_setc(int pos, int c)
|
|
{
|
|
char ch;
|
|
|
|
ch= c;
|
|
phys_copy(vir2phys((vir_bytes)&ch), COLOR_BASE+(20*80+pos)*2, 1);
|
|
}
|
|
|
|
PUBLIC void cons_seth(int pos, int n)
|
|
{
|
|
n &= 0xf;
|
|
if (n < 10)
|
|
cons_setc(pos, '0'+n);
|
|
else
|
|
cons_setc(pos, 'A'+(n-10));
|
|
}
|