222 lines
		
	
	
		
			4.9 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			222 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));
 | |
| }
 | 
