Home | History | Annotate | Line # | Download | only in luna68k
machdep.c revision 1.37
      1  1.37       wiz /* $NetBSD: machdep.c,v 1.37 2004/02/13 11:36:14 wiz Exp $ */
      2   1.1  nisimura 
      3   1.1  nisimura /*-
      4   1.1  nisimura  * Copyright (c) 2000 The NetBSD Foundation, Inc.
      5   1.1  nisimura  * All rights reserved.
      6   1.1  nisimura  *
      7   1.1  nisimura  * This code is derived from software contributed to The NetBSD Foundation
      8   1.1  nisimura  * by Tohru Nishimura.
      9   1.1  nisimura  *
     10   1.1  nisimura  * Redistribution and use in source and binary forms, with or without
     11   1.1  nisimura  * modification, are permitted provided that the following conditions
     12   1.1  nisimura  * are met:
     13   1.1  nisimura  * 1. Redistributions of source code must retain the above copyright
     14   1.1  nisimura  *    notice, this list of conditions and the following disclaimer.
     15   1.1  nisimura  * 2. Redistributions in binary form must reproduce the above copyright
     16   1.1  nisimura  *    notice, this list of conditions and the following disclaimer in the
     17   1.1  nisimura  *    documentation and/or other materials provided with the distribution.
     18   1.1  nisimura  * 3. All advertising materials mentioning features or use of this software
     19   1.1  nisimura  *    must display the following acknowledgement:
     20   1.1  nisimura  *	This product includes software developed by the NetBSD
     21   1.1  nisimura  *	Foundation, Inc. and its contributors.
     22   1.1  nisimura  * 4. Neither the name of The NetBSD Foundation nor the names of its
     23   1.1  nisimura  *    contributors may be used to endorse or promote products derived
     24   1.1  nisimura  *    from this software without specific prior written permission.
     25   1.1  nisimura  *
     26   1.1  nisimura  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     27   1.1  nisimura  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     28   1.1  nisimura  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     29   1.1  nisimura  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     30   1.1  nisimura  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     31   1.1  nisimura  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     32   1.1  nisimura  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     33   1.1  nisimura  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     34   1.1  nisimura  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     35   1.1  nisimura  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     36   1.1  nisimura  * POSSIBILITY OF SUCH DAMAGE.
     37   1.1  nisimura  */
     38   1.1  nisimura 
     39   1.1  nisimura #include <sys/cdefs.h>			/* RCS ID & Copyright macro defns */
     40   1.1  nisimura 
     41  1.37       wiz __KERNEL_RCSID(0, "$NetBSD: machdep.c,v 1.37 2004/02/13 11:36:14 wiz Exp $");
     42   1.1  nisimura 
     43   1.1  nisimura #include "opt_ddb.h"
     44  1.16     lukem #include "opt_kgdb.h"
     45  1.31    martin #include "opt_compat_sunos.h"
     46  1.31    martin #include "opt_panicbutton.h"
     47   1.1  nisimura 
     48   1.1  nisimura #include <sys/param.h>
     49   1.1  nisimura #include <sys/systm.h>
     50   1.1  nisimura #include <sys/kernel.h>
     51   1.1  nisimura #include <sys/proc.h>
     52   1.1  nisimura #include <sys/buf.h>
     53   1.1  nisimura #include <sys/reboot.h>
     54   1.1  nisimura #include <sys/conf.h>
     55   1.1  nisimura #include <sys/file.h>
     56   1.1  nisimura #include <sys/device.h>
     57   1.1  nisimura #include <sys/malloc.h>
     58   1.1  nisimura #include <sys/mbuf.h>
     59   1.1  nisimura #include <sys/msgbuf.h>
     60   1.1  nisimura #include <sys/ioctl.h>
     61   1.1  nisimura #include <sys/tty.h>
     62   1.1  nisimura #include <sys/mount.h>
     63   1.1  nisimura #include <sys/user.h>
     64   1.1  nisimura #include <sys/exec.h>
     65   1.1  nisimura #include <sys/core.h>
     66   1.1  nisimura #include <sys/kcore.h>
     67   1.1  nisimura #include <sys/vnode.h>
     68  1.26   thorpej #include <sys/sa.h>
     69   1.1  nisimura #include <sys/syscallargs.h>
     70  1.28     ragge #include <sys/ksyms.h>
     71   1.1  nisimura #ifdef	KGDB
     72   1.1  nisimura #include <sys/kgdb.h>
     73   1.1  nisimura #endif
     74  1.12  jdolecek #include <sys/boot_flag.h>
     75   1.1  nisimura 
     76   1.1  nisimura #include <uvm/uvm_extern.h>
     77   1.1  nisimura 
     78   1.1  nisimura #include <sys/sysctl.h>
     79   1.1  nisimura 
     80   1.1  nisimura #include <machine/cpu.h>
     81   1.1  nisimura #include <machine/reg.h>
     82   1.1  nisimura #include <machine/psl.h>
     83   1.1  nisimura #include <machine/pte.h>
     84   1.1  nisimura #include <machine/kcore.h>	/* XXX should be pulled in by sys/kcore.h */
     85   1.1  nisimura 
     86   1.1  nisimura #include <dev/cons.h>
     87   1.1  nisimura 
     88   1.1  nisimura #if defined(DDB)
     89   1.1  nisimura #include <machine/db_machdep.h>
     90   1.1  nisimura #include <ddb/db_sym.h>
     91   1.1  nisimura #include <ddb/db_extern.h>
     92   1.1  nisimura #endif
     93   1.1  nisimura 
     94  1.28     ragge #include "ksyms.h"
     95  1.28     ragge 
     96   1.1  nisimura /*
     97   1.1  nisimura  * Info for CTL_HW
     98   1.1  nisimura  */
     99   1.1  nisimura char	machine[] = MACHINE;
    100   1.1  nisimura char	cpu_model[60];
    101   1.7   thorpej 
    102   1.7   thorpej /* Our exported CPU info; we can have only one. */
    103   1.7   thorpej struct cpu_info cpu_info_store;
    104   1.1  nisimura 
    105   1.1  nisimura extern char kernel_text[];
    106  1.30   thorpej extern char etext[];
    107   1.1  nisimura 
    108  1.17       chs struct vm_map *exec_map = NULL;
    109  1.17       chs struct vm_map *mb_map = NULL;
    110  1.17       chs struct vm_map *phys_map = NULL;
    111   1.1  nisimura 
    112   1.1  nisimura caddr_t	msgbufaddr;
    113   1.1  nisimura int	maxmem;			/* max memory per process */
    114   1.1  nisimura int	physmem;		/* set by locore */
    115   1.1  nisimura /*
    116   1.1  nisimura  * safepri is a safe priority for sleep to set for a spin-wait
    117   1.1  nisimura  * during autoconfiguration or after a panic.
    118   1.1  nisimura  */
    119   1.1  nisimura int	safepri = PSL_LOWIPL;
    120   1.1  nisimura 
    121   1.1  nisimura void luna68k_init __P((void));
    122   1.1  nisimura void identifycpu __P((void));
    123   1.1  nisimura void dumpsys __P((void));
    124   1.1  nisimura 
    125   1.1  nisimura void straytrap __P((int, u_short));
    126   1.1  nisimura void nmihand __P((struct frame));
    127   1.1  nisimura 
    128   1.1  nisimura int  cpu_dumpsize __P((void));
    129   1.1  nisimura int  cpu_dump __P((int (*)(dev_t, daddr_t, caddr_t, size_t), daddr_t *));
    130   1.1  nisimura void cpu_init_kcore_hdr __P((void));
    131   1.1  nisimura 
    132   1.1  nisimura /*
    133   1.1  nisimura  * Machine-independent crash dump header info.
    134   1.1  nisimura  */
    135   1.1  nisimura cpu_kcore_hdr_t cpu_kcore_hdr;
    136   1.1  nisimura 
    137   1.1  nisimura int	machtype;	/* model: 1 for LUNA-1, 2 for LUNA-2 */
    138   1.1  nisimura int	sysconsole;	/* console: 0 for ttya, 1 for video */
    139   1.1  nisimura 
    140   1.1  nisimura extern struct consdev syscons;
    141   1.1  nisimura extern void omfb_cnattach __P((void));
    142   1.1  nisimura extern void ws_cnattach __P((void));
    143   1.1  nisimura extern void syscnattach __P((int));
    144   1.1  nisimura 
    145   1.1  nisimura /*
    146   1.1  nisimura  * On the 68020/68030, the value of delay_divisor is roughly
    147   1.1  nisimura  * 2048 / cpuspeed (where cpuspeed is in MHz).
    148   1.1  nisimura  *
    149   1.1  nisimura  * On the 68040/68060(?), the value of delay_divisor is roughly
    150   1.1  nisimura  * 759 / cpuspeed (where cpuspeed is in MHz).
    151   1.1  nisimura  * XXX -- is the above formula correct?
    152   1.1  nisimura  */
    153   1.1  nisimura int	cpuspeed = 25;		/* only used for printing later */
    154   1.1  nisimura int	delay_divisor = 300;	/* for delay() loop count */
    155   1.1  nisimura 
    156   1.1  nisimura /*
    157   1.1  nisimura  * Early initialization, before main() is called.
    158   1.1  nisimura  */
    159   1.1  nisimura void
    160   1.1  nisimura luna68k_init()
    161   1.1  nisimura {
    162  1.13  nisimura 	volatile unsigned char *pio0 = (void *)0x49000000;
    163  1.13  nisimura 	int sw1, i;
    164  1.13  nisimura 	char *cp;
    165  1.13  nisimura 	extern char bootarg[64];
    166   1.1  nisimura 
    167   1.1  nisimura 	extern paddr_t avail_start, avail_end;
    168   1.1  nisimura 
    169   1.1  nisimura 	/*
    170   1.1  nisimura 	 * Tell the VM system about available physical memory.  The
    171   1.1  nisimura 	 * luna68k only has one segment.
    172   1.1  nisimura 	 */
    173   1.1  nisimura 	uvm_page_physload(atop(avail_start), atop(avail_end),
    174   1.1  nisimura 	    atop(avail_start), atop(avail_end), VM_FREELIST_DEFAULT);
    175   1.1  nisimura 
    176   1.1  nisimura 	/*
    177   1.1  nisimura 	 * Initialize error message buffer (at end of core).
    178   1.1  nisimura 	 * avail_end was pre-decremented in pmap_bootstrap to compensate.
    179   1.1  nisimura 	 */
    180   1.1  nisimura 	for (i = 0; i < btoc(MSGBUFSIZE); i++)
    181  1.27   thorpej 		pmap_enter(pmap_kernel(), (vaddr_t)msgbufaddr + i * PAGE_SIZE,
    182  1.27   thorpej 		    avail_end + i * PAGE_SIZE, VM_PROT_READ|VM_PROT_WRITE,
    183   1.1  nisimura 		    VM_PROT_READ|VM_PROT_WRITE|PMAP_WIRED);
    184  1.19     chris 	pmap_update(pmap_kernel());
    185   1.1  nisimura 	initmsgbuf(msgbufaddr, m68k_round_page(MSGBUFSIZE));
    186   1.1  nisimura 
    187   1.1  nisimura 
    188   1.1  nisimura 	pio0[3] = 0xb6;
    189   1.1  nisimura 	pio0[2] = 1 << 6;		/* enable parity check */
    190   1.1  nisimura 	pio0[3] = 0xb6;
    191   1.1  nisimura 	sw1 = pio0[0];			/* dipssw1 value */
    192   1.1  nisimura 	sw1 ^= 0xff;
    193   1.1  nisimura 	sysconsole = !(sw1 & 0x2);	/* console selection */
    194   1.1  nisimura 
    195   1.1  nisimura 	boothowto = 0;
    196   1.1  nisimura 	i = 0;
    197   1.1  nisimura 	/*
    198   1.1  nisimura 	 * 'bootarg' has;
    199   1.1  nisimura 	 *   "<args of x command> ENADDR=<addr> HOST=<host> SERVER=<name>"
    200   1.1  nisimura 	 * where <addr> is MAC address of which network loader used (not
    201   1.1  nisimura 	 * necessarily same as one at 0x4101.FFE0), <host> and <name>
    202   1.1  nisimura 	 * are the values of HOST and SERVER environment variables,
    203   1.1  nisimura 	 *
    204   1.1  nisimura 	 * NetBSD/luna68k cares only the first argment; any of "sda".
    205   1.1  nisimura 	 */
    206   1.1  nisimura 	for (cp = bootarg; *cp != ' '; cp++) {
    207  1.12  jdolecek 		BOOT_FLAG(*cp, boothowto);
    208   1.1  nisimura 		if (i++ >= sizeof(bootarg))
    209   1.1  nisimura 			break;
    210   1.1  nisimura 	}
    211   1.2  nisimura #if 0 /* overload 1:sw1, which now means 'go ROM monitor' after poweron */
    212   1.1  nisimura 	if (boothowto == 0)
    213   1.1  nisimura 		boothowto = (sw1 & 0x1) ? RB_SINGLE : 0;
    214   1.2  nisimura #endif
    215  1.13  nisimura }
    216   1.1  nisimura 
    217  1.13  nisimura /*
    218  1.13  nisimura  * Console initialization: called early on from main,
    219  1.13  nisimura  */
    220  1.13  nisimura void
    221  1.13  nisimura consinit()
    222  1.13  nisimura {
    223   1.1  nisimura 	if (sysconsole == 0)
    224   1.1  nisimura 		syscnattach(0);
    225   1.1  nisimura 	else {
    226   1.1  nisimura 		omfb_cnattach();
    227   1.1  nisimura 		ws_cnattach();
    228   1.1  nisimura 	}
    229   1.1  nisimura 
    230  1.28     ragge #if NKSYMS || defined(DDB) || defined(LKM)
    231   1.1  nisimura 	{
    232   1.1  nisimura 		extern int end;
    233   1.1  nisimura 		extern int *esym;
    234   1.1  nisimura 
    235  1.28     ragge 		ksyms_init(*(int *)&end, ((int *)&end) + 1, esym);
    236   1.1  nisimura 	}
    237  1.28     ragge #endif
    238  1.28     ragge #ifdef DDB
    239   1.1  nisimura 	if (boothowto & RB_KDB)
    240   1.1  nisimura 		cpu_Debugger();
    241   1.1  nisimura #endif
    242   1.1  nisimura }
    243   1.1  nisimura 
    244   1.1  nisimura /*
    245   1.1  nisimura  * cpu_startup: allocate memory for variable-sized tables.
    246   1.1  nisimura  */
    247   1.1  nisimura void
    248   1.1  nisimura cpu_startup()
    249   1.1  nisimura {
    250   1.1  nisimura 	vaddr_t minaddr, maxaddr;
    251   1.1  nisimura 	char pbuf[9];
    252   1.1  nisimura 	extern void greeting __P((void));
    253   1.1  nisimura 
    254  1.26   thorpej 	if (fputype != FPU_NONE)
    255  1.26   thorpej 		m68k_make_fpu_idle_frame();
    256  1.26   thorpej 
    257   1.1  nisimura 	/*
    258   1.1  nisimura 	 * Initialize the kernel crash dump header.
    259   1.1  nisimura 	 */
    260   1.1  nisimura 	cpu_init_kcore_hdr();
    261   1.1  nisimura 
    262   1.1  nisimura 	/*
    263   1.1  nisimura 	 * Good {morning,afternoon,evening,night}.
    264   1.1  nisimura 	 */
    265   1.1  nisimura 	printf(version);
    266   1.1  nisimura 	identifycpu();
    267   1.1  nisimura 
    268   1.1  nisimura 	format_bytes(pbuf, sizeof(pbuf), ctob(physmem));
    269   1.1  nisimura 	printf("total memory = %s\n", pbuf);
    270   1.1  nisimura 
    271  1.36        pk 	minaddr = 0;
    272   1.1  nisimura 	/*
    273   1.1  nisimura 	 * Allocate a submap for exec arguments.  This map effectively
    274   1.1  nisimura 	 * limits the number of processes exec'ing at any time.
    275   1.1  nisimura 	 */
    276   1.1  nisimura 	exec_map = uvm_km_suballoc(kernel_map, &minaddr, &maxaddr,
    277   1.1  nisimura 				   16*NCARGS, VM_MAP_PAGEABLE, FALSE, NULL);
    278   1.1  nisimura 
    279   1.1  nisimura 	/*
    280   1.1  nisimura 	 * Allocate a submap for physio
    281   1.1  nisimura 	 */
    282   1.1  nisimura 	phys_map = uvm_km_suballoc(kernel_map, &minaddr, &maxaddr,
    283   1.1  nisimura 				   VM_PHYS_SIZE, 0, FALSE, NULL);
    284   1.1  nisimura 
    285   1.1  nisimura 	/*
    286   1.1  nisimura 	 * Finally, allocate mbuf cluster submap.
    287   1.1  nisimura 	 */
    288   1.1  nisimura 	mb_map = uvm_km_suballoc(kernel_map, &minaddr, &maxaddr,
    289   1.1  nisimura 				 nmbclusters * mclbytes, VM_MAP_INTRSAFE,
    290   1.1  nisimura 				 FALSE, NULL);
    291   1.1  nisimura 
    292   1.1  nisimura 	format_bytes(pbuf, sizeof(pbuf), ptoa(uvmexp.free));
    293   1.1  nisimura 	printf("avail memory = %s\n", pbuf);
    294  1.30   thorpej 
    295  1.30   thorpej 	/*
    296  1.30   thorpej 	 * Tell the VM system that the area before the text segment
    297  1.30   thorpej 	 * is invalid.
    298  1.30   thorpej 	 *
    299  1.30   thorpej 	 * XXX Should just change KERNBASE and VM_MIN_KERNEL_ADDRESS,
    300  1.30   thorpej 	 * XXX but not right now.
    301  1.30   thorpej 	 */
    302  1.30   thorpej 	if (uvm_map_protect(kernel_map, 0, round_page((vaddr_t)&kernel_text),
    303  1.30   thorpej 	    UVM_PROT_NONE, TRUE) != 0)
    304  1.30   thorpej 		panic("can't mark pre-text pages off-limits");
    305  1.30   thorpej 
    306  1.30   thorpej 	/*
    307  1.30   thorpej 	 * Tell the VM system that writing to kernel text isn't allowed.
    308  1.30   thorpej 	 * If we don't, we might end up COW'ing the text segment!
    309  1.30   thorpej 	 */
    310  1.30   thorpej 	if (uvm_map_protect(kernel_map, trunc_page((vaddr_t)&kernel_text),
    311  1.30   thorpej 	    trunc_page((vaddr_t)&etext), UVM_PROT_READ|UVM_PROT_EXEC, TRUE)
    312  1.30   thorpej 	    != 0)
    313  1.30   thorpej 		panic("can't protect kernel text");
    314   1.1  nisimura 
    315   1.1  nisimura 	/*
    316   1.1  nisimura 	 * Say "Hi" to the world
    317   1.1  nisimura 	 */
    318   1.1  nisimura 	greeting();
    319   1.1  nisimura }
    320   1.1  nisimura 
    321   1.1  nisimura /*
    322   1.1  nisimura  * Set registers on exec.
    323   1.1  nisimura  */
    324   1.1  nisimura void
    325  1.26   thorpej setregs(l, pack, stack)
    326  1.26   thorpej 	struct lwp *l;
    327   1.1  nisimura 	struct exec_package *pack;
    328   1.1  nisimura 	u_long stack;
    329   1.1  nisimura {
    330  1.26   thorpej 	struct frame *frame = (struct frame *)l->l_md.md_regs;
    331   1.1  nisimura 	extern int fputype;
    332   1.1  nisimura 
    333   1.1  nisimura 	frame->f_sr = PSL_USERSET;
    334   1.1  nisimura 	frame->f_pc = pack->ep_entry & ~1;
    335   1.1  nisimura 	frame->f_regs[D0] = 0;
    336   1.1  nisimura 	frame->f_regs[D1] = 0;
    337   1.1  nisimura 	frame->f_regs[D2] = 0;
    338   1.1  nisimura 	frame->f_regs[D3] = 0;
    339   1.1  nisimura 	frame->f_regs[D4] = 0;
    340   1.1  nisimura 	frame->f_regs[D5] = 0;
    341   1.1  nisimura 	frame->f_regs[D6] = 0;
    342   1.1  nisimura 	frame->f_regs[D7] = 0;
    343   1.1  nisimura 	frame->f_regs[A0] = 0;
    344   1.1  nisimura 	frame->f_regs[A1] = 0;
    345  1.26   thorpej 	frame->f_regs[A2] = (int)l->l_proc->p_psstr;
    346   1.1  nisimura 	frame->f_regs[A3] = 0;
    347   1.1  nisimura 	frame->f_regs[A4] = 0;
    348   1.1  nisimura 	frame->f_regs[A5] = 0;
    349   1.1  nisimura 	frame->f_regs[A6] = 0;
    350   1.1  nisimura 	frame->f_regs[SP] = stack;
    351   1.1  nisimura 
    352   1.1  nisimura 	/* restore a null state frame */
    353  1.26   thorpej 	l->l_addr->u_pcb.pcb_fpregs.fpf_null = 0;
    354   1.1  nisimura 	if (fputype)
    355  1.26   thorpej 		m68881_restore(&l->l_addr->u_pcb.pcb_fpregs);
    356   1.1  nisimura }
    357   1.1  nisimura 
    358   1.1  nisimura void
    359   1.1  nisimura identifycpu()
    360   1.1  nisimura {
    361   1.1  nisimura 	extern int cputype;
    362   1.1  nisimura 	char *cpu;
    363   1.1  nisimura 
    364   1.1  nisimura 	bzero(cpu_model, sizeof(cpu_model));
    365   1.1  nisimura 	switch (cputype) {
    366   1.1  nisimura 	case CPU_68030:
    367   1.1  nisimura 		cpu = "MC68030 CPU+MMU, MC68882 FPU";
    368   1.1  nisimura 		machtype = LUNA_I;
    369   1.1  nisimura 		cpuspeed = 20; delay_divisor = 102;	/* 20MHz 68030 */
    370   1.1  nisimura 		hz = 60;
    371   1.1  nisimura 		break;
    372  1.13  nisimura #if defined(M68040)
    373   1.1  nisimura 	case CPU_68040:
    374   1.1  nisimura 		cpu = "MC68040 CPU+MMU+FPU, 4k on-chip physical I/D caches";
    375   1.1  nisimura 		machtype = LUNA_II;
    376   1.1  nisimura 		cpuspeed = 25; delay_divisor = 300;	/* 25MHz 68040 */
    377   1.1  nisimura 		break;
    378   1.1  nisimura #endif
    379   1.1  nisimura 	default:
    380   1.1  nisimura 		panic("unknown CPU type");
    381   1.1  nisimura 	}
    382   1.1  nisimura 	strcpy(cpu_model, cpu);
    383   1.1  nisimura 	printf("%s\n", cpu_model);
    384   1.1  nisimura }
    385   1.1  nisimura 
    386   1.1  nisimura /*
    387   1.1  nisimura  * machine dependent system variables.
    388   1.1  nisimura  */
    389  1.35    atatat SYSCTL_SETUP(sysctl_machdep_setup, "sysctl machdep subtree setup")
    390   1.1  nisimura {
    391   1.1  nisimura 
    392  1.35    atatat 	sysctl_createv(SYSCTL_PERMANENT,
    393  1.35    atatat 		       CTLTYPE_NODE, "machdep", NULL,
    394  1.35    atatat 		       NULL, 0, NULL, 0,
    395  1.35    atatat 		       CTL_MACHDEP, CTL_EOL);
    396  1.35    atatat 
    397  1.35    atatat 	sysctl_createv(SYSCTL_PERMANENT,
    398  1.35    atatat 		       CTLTYPE_STRUCT, "console_device", NULL,
    399  1.35    atatat 		       sysctl_consdev, 0, NULL, sizeof(dev_t),
    400  1.35    atatat 		       CTL_MACHDEP, CPU_CONSDEV, CTL_EOL);
    401   1.1  nisimura }
    402   1.1  nisimura 
    403   1.1  nisimura int	waittime = -1;
    404   1.1  nisimura 
    405   1.1  nisimura void
    406   1.1  nisimura cpu_reboot(howto, bootstr)
    407   1.1  nisimura 	volatile int howto; /* XXX to shutup GCC XXX */
    408   1.1  nisimura 	char *bootstr;
    409   1.1  nisimura {
    410   1.1  nisimura 	extern void doboot __P((void));
    411   1.1  nisimura 
    412   1.1  nisimura 	/* take a snap shot before clobbering any registers */
    413  1.26   thorpej 	if (curlwp && curlwp->l_addr)
    414  1.26   thorpej 		savectx(&curlwp->l_addr->u_pcb);
    415   1.1  nisimura 
    416   1.1  nisimura 	/* If system is hold, just halt. */
    417   1.1  nisimura 	if (cold) {
    418   1.1  nisimura 		howto |= RB_HALT;
    419   1.1  nisimura 		goto haltsys;
    420   1.1  nisimura 	}
    421   1.1  nisimura 
    422   1.1  nisimura 	boothowto = howto;
    423   1.1  nisimura 	if ((howto & RB_NOSYNC) == 0 && waittime < 0) {
    424   1.1  nisimura 		waittime = 0;
    425   1.1  nisimura 		vfs_shutdown();
    426   1.1  nisimura 		/*
    427   1.1  nisimura 		 * If we've been adjusting the clock, the todr
    428   1.1  nisimura 		 * will be out of synch; adjust it now.
    429   1.1  nisimura 		 */
    430   1.1  nisimura 		resettodr();
    431   1.1  nisimura 	}
    432   1.1  nisimura 
    433   1.1  nisimura 	/* Disable interrupts. */
    434   1.1  nisimura 	splhigh();
    435   1.1  nisimura 
    436   1.1  nisimura 	/* If rebooting and a dump is requested, do it. */
    437   1.1  nisimura 	if (howto & RB_DUMP)
    438   1.1  nisimura 		dumpsys();
    439   1.1  nisimura 
    440   1.1  nisimura haltsys:
    441   1.1  nisimura 	/* Run any shutdown hooks. */
    442   1.1  nisimura 	doshutdownhooks();
    443   1.1  nisimura 
    444   1.1  nisimura 	/* Finally, halt/reboot the system. */
    445   1.1  nisimura 	if ((howto & RB_POWERDOWN) == RB_POWERDOWN) {
    446   1.1  nisimura 		u_int8_t *pio = (void *)0x4d000000;
    447   1.1  nisimura 
    448   1.1  nisimura 		printf("power is going down.\n");
    449   1.1  nisimura 		DELAY(100000);
    450   1.1  nisimura 		pio[3] = 0x94;
    451   1.1  nisimura 		pio[2] = 0 << 4;
    452   1.1  nisimura 		for (;;) /* NOP */;
    453   1.1  nisimura 	}
    454   1.1  nisimura 	if (howto & RB_HALT) {
    455   1.1  nisimura 		printf("System halted.	Hit any key to reboot.\n\n");
    456   1.1  nisimura 		(void)cngetc();
    457   1.1  nisimura 	}
    458   1.1  nisimura 
    459   1.1  nisimura 	printf("rebooting...\n");
    460   1.1  nisimura 	DELAY(100000);
    461   1.1  nisimura 	doboot();
    462   1.1  nisimura 	/*NOTREACHED*/
    463   1.1  nisimura 	while (1) ;
    464   1.1  nisimura }
    465   1.1  nisimura 
    466   1.1  nisimura /*
    467   1.1  nisimura  * Initialize the kernel crash dump header.
    468   1.1  nisimura  */
    469   1.1  nisimura void
    470   1.1  nisimura cpu_init_kcore_hdr()
    471   1.1  nisimura {
    472   1.1  nisimura 	cpu_kcore_hdr_t *h = &cpu_kcore_hdr;
    473   1.1  nisimura 	struct m68k_kcore_hdr *m = &h->un._m68k;
    474   1.1  nisimura 	extern char end[];
    475   1.1  nisimura 
    476   1.1  nisimura 	bzero(&cpu_kcore_hdr, sizeof(cpu_kcore_hdr));
    477   1.1  nisimura 
    478   1.1  nisimura 	/*
    479   1.1  nisimura 	 * Initialize the `dispatcher' portion of the header.
    480   1.1  nisimura 	 */
    481   1.1  nisimura 	strcpy(h->name, machine);
    482  1.27   thorpej 	h->page_size = PAGE_SIZE;
    483   1.1  nisimura 	h->kernbase = KERNBASE;
    484   1.1  nisimura 
    485   1.1  nisimura 	/*
    486   1.1  nisimura 	 * Fill in information about our MMU configuration.
    487   1.1  nisimura 	 */
    488   1.1  nisimura 	m->mmutype	= mmutype;
    489   1.1  nisimura 	m->sg_v		= SG_V;
    490   1.1  nisimura 	m->sg_frame	= SG_FRAME;
    491   1.1  nisimura 	m->sg_ishift	= SG_ISHIFT;
    492   1.1  nisimura 	m->sg_pmask	= SG_PMASK;
    493   1.1  nisimura 	m->sg40_shift1	= SG4_SHIFT1;
    494   1.1  nisimura 	m->sg40_mask2	= SG4_MASK2;
    495   1.1  nisimura 	m->sg40_shift2	= SG4_SHIFT2;
    496   1.1  nisimura 	m->sg40_mask3	= SG4_MASK3;
    497   1.1  nisimura 	m->sg40_shift3	= SG4_SHIFT3;
    498   1.1  nisimura 	m->sg40_addr1	= SG4_ADDR1;
    499   1.1  nisimura 	m->sg40_addr2	= SG4_ADDR2;
    500   1.1  nisimura 	m->pg_v		= PG_V;
    501   1.1  nisimura 	m->pg_frame	= PG_FRAME;
    502   1.1  nisimura 
    503   1.1  nisimura 	/*
    504   1.1  nisimura 	 * Initialize pointer to kernel segment table.
    505   1.1  nisimura 	 */
    506   1.1  nisimura 	m->sysseg_pa = (u_int32_t)(pmap_kernel()->pm_stpa);
    507   1.1  nisimura 
    508   1.1  nisimura 	/*
    509   1.1  nisimura 	 * Initialize relocation value such that:
    510   1.1  nisimura 	 *
    511   1.1  nisimura 	 *	pa = (va - KERNBASE) + reloc
    512   1.1  nisimura 	 *
    513   1.1  nisimura 	 * Since we're linked and loaded at the same place,
    514   1.1  nisimura 	 * and the kernel is mapped va == pa, this is 0.
    515   1.1  nisimura 	 */
    516   1.1  nisimura 	m->reloc = 0;
    517   1.1  nisimura 
    518   1.1  nisimura 	/*
    519   1.1  nisimura 	 * Define the end of the relocatable range.
    520   1.1  nisimura 	 */
    521   1.1  nisimura 	m->relocend = (u_int32_t)end;
    522   1.1  nisimura 
    523   1.1  nisimura 	/*
    524   1.1  nisimura 	 * The luna68k has one contiguous memory segment.
    525   1.1  nisimura 	 */
    526   1.1  nisimura 	m->ram_segs[0].start = 0 /* lowram */;
    527   1.1  nisimura 	m->ram_segs[0].size  = ctob(physmem);
    528   1.1  nisimura }
    529   1.1  nisimura 
    530   1.1  nisimura /*
    531   1.1  nisimura  * Compute the size of the machine-dependent crash dump header.
    532   1.1  nisimura  * Returns size in disk blocks.
    533   1.1  nisimura  */
    534   1.1  nisimura int
    535   1.1  nisimura cpu_dumpsize()
    536   1.1  nisimura {
    537   1.1  nisimura 	int size;
    538   1.1  nisimura 
    539   1.1  nisimura 	size = ALIGN(sizeof(kcore_seg_t)) + ALIGN(sizeof(cpu_kcore_hdr_t));
    540   1.1  nisimura 	return (btodb(roundup(size, dbtob(1))));
    541   1.1  nisimura }
    542   1.1  nisimura 
    543   1.1  nisimura /*
    544   1.1  nisimura  * Called by dumpsys() to dump the machine-dependent header.
    545   1.1  nisimura  */
    546   1.1  nisimura int
    547   1.1  nisimura cpu_dump(dump, blknop)
    548   1.1  nisimura 	int (*dump) __P((dev_t, daddr_t, caddr_t, size_t));
    549   1.1  nisimura 	daddr_t *blknop;
    550   1.1  nisimura {
    551   1.1  nisimura 	int buf[dbtob(1) / sizeof(int)];
    552   1.1  nisimura 	cpu_kcore_hdr_t *chdr;
    553   1.1  nisimura 	kcore_seg_t *kseg;
    554   1.1  nisimura 	int error;
    555   1.1  nisimura 
    556   1.1  nisimura 	kseg = (kcore_seg_t *)buf;
    557   1.1  nisimura 	chdr = (cpu_kcore_hdr_t *)&buf[ALIGN(sizeof(kcore_seg_t)) /
    558   1.1  nisimura 	    sizeof(int)];
    559   1.1  nisimura 
    560   1.1  nisimura 	/* Create the segment header. */
    561   1.1  nisimura 	CORE_SETMAGIC(*kseg, KCORE_MAGIC, MID_MACHINE, CORE_CPU);
    562   1.1  nisimura 	kseg->c_size = dbtob(1) - ALIGN(sizeof(kcore_seg_t));
    563   1.1  nisimura 
    564   1.1  nisimura 	bcopy(&cpu_kcore_hdr, chdr, sizeof(cpu_kcore_hdr_t));
    565   1.1  nisimura 	error = (*dump)(dumpdev, *blknop, (caddr_t)buf, sizeof(buf));
    566   1.1  nisimura 	*blknop += btodb(sizeof(buf));
    567   1.1  nisimura 	return (error);
    568   1.1  nisimura }
    569   1.1  nisimura 
    570   1.1  nisimura /*
    571   1.1  nisimura  * These variables are needed by /sbin/savecore
    572   1.1  nisimura  */
    573  1.20   tsutsui u_int32_t dumpmag = 0x8fca0101;	/* magic number */
    574   1.1  nisimura int	dumpsize = 0;		/* pages */
    575   1.1  nisimura long	dumplo = 0;		/* blocks */
    576   1.1  nisimura 
    577   1.1  nisimura /*
    578   1.1  nisimura  * This is called by main to set dumplo and dumpsize.
    579  1.27   thorpej  * Dumps always skip the first PAGE_SIZE of disk space
    580   1.1  nisimura  * in case there might be a disk label stored there.
    581   1.1  nisimura  * If there is extra space, put dump at the end to
    582   1.1  nisimura  * reduce the chance that swapping trashes it.
    583   1.1  nisimura  */
    584   1.1  nisimura void
    585   1.1  nisimura cpu_dumpconf()
    586   1.1  nisimura {
    587  1.23   gehenna 	const struct bdevsw *bdev;
    588   1.1  nisimura 	int chdrsize;	/* size of dump header */
    589   1.1  nisimura 	int nblks;	/* size of dump area */
    590   1.1  nisimura 
    591   1.1  nisimura 	if (dumpdev == NODEV)
    592   1.1  nisimura 		return;
    593  1.23   gehenna 	bdev = bdevsw_lookup(dumpdev);
    594  1.23   gehenna 	if (bdev == NULL)
    595   1.1  nisimura 		panic("dumpconf: bad dumpdev=0x%x", dumpdev);
    596  1.23   gehenna 	if (bdev->d_psize == NULL)
    597   1.1  nisimura 		return;
    598  1.23   gehenna 	nblks = (*bdev->d_psize)(dumpdev);
    599   1.1  nisimura 	chdrsize = cpu_dumpsize();
    600   1.1  nisimura 
    601   1.1  nisimura 	dumpsize = btoc(cpu_kcore_hdr.un._m68k.ram_segs[0].size);
    602   1.1  nisimura 
    603   1.1  nisimura 	/*
    604   1.1  nisimura 	 * Check do see if we will fit.  Note we always skip the
    605  1.27   thorpej 	 * first PAGE_SIZE in case there is a disk label there.
    606   1.1  nisimura 	 */
    607   1.1  nisimura 	if (nblks < (ctod(dumpsize) + chdrsize + ctod(1))) {
    608   1.1  nisimura 		dumpsize = 0;
    609   1.1  nisimura 		dumplo = -1;
    610   1.1  nisimura 		return;
    611   1.1  nisimura 	}
    612   1.1  nisimura 
    613   1.1  nisimura 	/*
    614   1.1  nisimura 	 * Put dump at the end of the partition.
    615   1.1  nisimura 	 */
    616   1.1  nisimura 	dumplo = (nblks - 1) - ctod(dumpsize) - chdrsize;
    617   1.1  nisimura }
    618   1.1  nisimura 
    619   1.1  nisimura /*
    620   1.1  nisimura  * Dump physical memory onto the dump device.  Called by cpu_reboot().
    621   1.1  nisimura  */
    622   1.1  nisimura void
    623   1.1  nisimura dumpsys()
    624   1.1  nisimura {
    625  1.23   gehenna 	const struct bdevsw *bdev;
    626   1.1  nisimura 	daddr_t blkno;		/* current block to write */
    627   1.1  nisimura 				/* dump routine */
    628   1.1  nisimura 	int (*dump) __P((dev_t, daddr_t, caddr_t, size_t));
    629   1.1  nisimura 	int pg;			/* page being dumped */
    630   1.1  nisimura 	paddr_t maddr;		/* PA being dumped */
    631   1.1  nisimura 	int error;		/* error code from (*dump)() */
    632   1.1  nisimura 
    633   1.1  nisimura 	/* XXX initialized here because of gcc lossage */
    634   1.1  nisimura 	maddr = 0 /* lowram */;
    635   1.1  nisimura 	pg = 0;
    636   1.1  nisimura 
    637   1.1  nisimura 	/* Make sure dump device is valid. */
    638   1.1  nisimura 	if (dumpdev == NODEV)
    639   1.1  nisimura 		return;
    640  1.23   gehenna 	bdev = bdevsw_lookup(dumpdev);
    641  1.23   gehenna 	if (bdev == NULL)
    642  1.23   gehenna 		return;
    643   1.1  nisimura 	if (dumpsize == 0) {
    644   1.1  nisimura 		cpu_dumpconf();
    645   1.1  nisimura 		if (dumpsize == 0)
    646   1.1  nisimura 			return;
    647   1.1  nisimura 	}
    648   1.1  nisimura 	if (dumplo <= 0) {
    649   1.1  nisimura 		printf("\ndump to dev %u,%u not possible\n", major(dumpdev),
    650   1.1  nisimura 		    minor(dumpdev));
    651   1.1  nisimura 		return;
    652   1.1  nisimura 	}
    653  1.23   gehenna 	dump = bdev->d_dump;
    654   1.1  nisimura 	blkno = dumplo;
    655   1.1  nisimura 
    656   1.1  nisimura 	printf("\ndumping to dev %u,%u offset %ld\n", major(dumpdev),
    657   1.1  nisimura 	    minor(dumpdev), dumplo);
    658   1.1  nisimura 
    659   1.1  nisimura 	printf("dump ");
    660   1.1  nisimura 
    661   1.1  nisimura 	/* Write the dump header. */
    662   1.1  nisimura 	error = cpu_dump(dump, &blkno);
    663   1.1  nisimura 	if (error)
    664   1.1  nisimura 		goto bad;
    665   1.1  nisimura 
    666   1.1  nisimura 	for (pg = 0; pg < dumpsize; pg++) {
    667  1.27   thorpej #define NPGMB	(1024*1024/PAGE_SIZE)
    668   1.1  nisimura 		/* print out how many MBs we have dumped */
    669   1.1  nisimura 		if (pg && (pg % NPGMB) == 0)
    670   1.1  nisimura 			printf("%d ", pg / NPGMB);
    671   1.1  nisimura #undef NPGMB
    672   1.1  nisimura 		pmap_enter(pmap_kernel(), (vaddr_t)vmmap, maddr,
    673   1.1  nisimura 		    VM_PROT_READ, VM_PROT_READ|PMAP_WIRED);
    674   1.1  nisimura 
    675  1.19     chris 		pmap_update(pmap_kernel());
    676  1.27   thorpej 		error = (*dump)(dumpdev, blkno, vmmap, PAGE_SIZE);
    677   1.1  nisimura  bad:
    678   1.1  nisimura 		switch (error) {
    679   1.1  nisimura 		case 0:
    680  1.27   thorpej 			maddr += PAGE_SIZE;
    681  1.27   thorpej 			blkno += btodb(PAGE_SIZE);
    682   1.1  nisimura 			break;
    683   1.1  nisimura 
    684   1.1  nisimura 		case ENXIO:
    685   1.1  nisimura 			printf("device bad\n");
    686   1.1  nisimura 			return;
    687   1.1  nisimura 
    688   1.1  nisimura 		case EFAULT:
    689   1.1  nisimura 			printf("device not ready\n");
    690   1.1  nisimura 			return;
    691   1.1  nisimura 
    692   1.1  nisimura 		case EINVAL:
    693   1.1  nisimura 			printf("area improper\n");
    694   1.1  nisimura 			return;
    695   1.1  nisimura 
    696   1.1  nisimura 		case EIO:
    697   1.1  nisimura 			printf("i/o error\n");
    698   1.1  nisimura 			return;
    699   1.1  nisimura 
    700   1.1  nisimura 		case EINTR:
    701   1.1  nisimura 			printf("aborted from console\n");
    702   1.1  nisimura 			return;
    703   1.1  nisimura 
    704   1.1  nisimura 		default:
    705   1.1  nisimura 			printf("error %d\n", error);
    706   1.1  nisimura 			return;
    707   1.1  nisimura 		}
    708   1.1  nisimura 	}
    709   1.1  nisimura 	printf("succeeded\n");
    710   1.1  nisimura }
    711   1.1  nisimura 
    712   1.1  nisimura void
    713   1.1  nisimura straytrap(pc, evec)
    714   1.1  nisimura 	int pc;
    715   1.1  nisimura 	u_short evec;
    716   1.1  nisimura {
    717   1.1  nisimura 	printf("unexpected trap (vector offset %x) from %x\n",
    718   1.1  nisimura 	       evec & 0xFFF, pc);
    719   1.1  nisimura }
    720   1.1  nisimura 
    721   1.1  nisimura int	*nofault;
    722   1.1  nisimura 
    723   1.1  nisimura int
    724   1.1  nisimura badaddr(addr, nbytes)
    725   1.1  nisimura 	register caddr_t addr;
    726   1.1  nisimura 	int nbytes;
    727   1.1  nisimura {
    728   1.1  nisimura 	register int i;
    729   1.1  nisimura 	label_t faultbuf;
    730   1.1  nisimura 
    731   1.1  nisimura #ifdef lint
    732   1.1  nisimura 	i = *addr; if (i) return (0);
    733   1.1  nisimura #endif
    734   1.1  nisimura 
    735   1.1  nisimura 	nofault = (int *) &faultbuf;
    736   1.1  nisimura 	if (setjmp((label_t *)nofault)) {
    737   1.1  nisimura 		nofault = (int *) 0;
    738   1.1  nisimura 		return(1);
    739   1.1  nisimura 	}
    740   1.1  nisimura 
    741   1.1  nisimura 	switch (nbytes) {
    742   1.1  nisimura 	case 1:
    743   1.1  nisimura 		i = *(volatile char *)addr;
    744   1.1  nisimura 		break;
    745   1.1  nisimura 
    746   1.1  nisimura 	case 2:
    747   1.1  nisimura 		i = *(volatile short *)addr;
    748   1.1  nisimura 		break;
    749   1.1  nisimura 
    750   1.1  nisimura 	case 4:
    751   1.1  nisimura 		i = *(volatile int *)addr;
    752   1.1  nisimura 		break;
    753   1.1  nisimura 
    754   1.1  nisimura 	default:
    755   1.1  nisimura 		panic("badaddr: bad request");
    756   1.1  nisimura 	}
    757   1.1  nisimura 	nofault = (int *) 0;
    758   1.1  nisimura 	return (0);
    759   1.1  nisimura }
    760   1.1  nisimura 
    761   1.1  nisimura void luna68k_abort __P((char *));
    762   1.1  nisimura 
    763   1.1  nisimura static int innmihand;	/* simple mutex */
    764   1.1  nisimura 
    765   1.1  nisimura /*
    766   1.1  nisimura  * Level 7 interrupts are caused by e.g. the ABORT switch.
    767   1.1  nisimura  *
    768   1.1  nisimura  * If we have DDB, then break into DDB on ABORT.  In a production
    769   1.1  nisimura  * environment, bumping the ABORT switch would be bad, so we enable
    770   1.1  nisimura  * panic'ing on ABORT with the kernel option "PANICBUTTON".
    771   1.1  nisimura  */
    772   1.1  nisimura void
    773   1.1  nisimura nmihand(frame)
    774   1.1  nisimura 	struct frame frame;
    775   1.1  nisimura {
    776   1.1  nisimura 	/* Prevent unwanted recursion */
    777   1.1  nisimura 	if (innmihand)
    778   1.1  nisimura 		return;
    779   1.1  nisimura 	innmihand = 1;
    780   1.1  nisimura 
    781   1.1  nisimura 	luna68k_abort("ABORT SWITCH");
    782   1.1  nisimura }
    783   1.1  nisimura 
    784   1.1  nisimura /*
    785   1.1  nisimura  * Common code for handling ABORT signals from buttons, switches,
    786   1.1  nisimura  * serial lines, etc.
    787   1.1  nisimura  */
    788   1.1  nisimura void
    789   1.1  nisimura luna68k_abort(cp)
    790   1.1  nisimura 	char *cp;
    791   1.1  nisimura {
    792   1.1  nisimura #ifdef DDB
    793   1.1  nisimura 	printf("%s\n", cp);
    794   1.1  nisimura 	cpu_Debugger();
    795   1.1  nisimura #else
    796   1.1  nisimura #ifdef PANICBUTTON
    797   1.1  nisimura 	panic(cp);
    798   1.1  nisimura #else
    799   1.1  nisimura 	printf("%s ignored\n", cp);
    800   1.1  nisimura #endif /* PANICBUTTON */
    801   1.1  nisimura #endif /* DDB */
    802   1.1  nisimura }
    803   1.1  nisimura 
    804   1.1  nisimura /*
    805   1.1  nisimura  * cpu_exec_aout_makecmds():
    806  1.37       wiz  *	CPU-dependent a.out format hook for execve().
    807   1.1  nisimura  *
    808   1.1  nisimura  * Determine of the given exec package refers to something which we
    809   1.1  nisimura  * understand and, if so, set up the vmcmds for it.
    810   1.1  nisimura  */
    811   1.1  nisimura int
    812  1.33      fvdl cpu_exec_aout_makecmds(p, epp)
    813  1.33      fvdl 	struct proc *p;
    814   1.1  nisimura 	struct exec_package *epp;
    815   1.1  nisimura {
    816   1.1  nisimura 	int error = ENOEXEC;
    817   1.1  nisimura #ifdef COMPAT_SUNOS
    818   1.1  nisimura 	extern sunos_exec_aout_makecmds
    819   1.1  nisimura 	__P((struct proc *, struct exec_package *));
    820  1.33      fvdl 	if ((error = sunos_exec_aout_makecmds(p, epp)) == 0)
    821   1.1  nisimura 		return 0;
    822   1.1  nisimura #endif
    823   1.1  nisimura 	return error;
    824   1.1  nisimura }
    825   1.1  nisimura 
    826   1.1  nisimura /*
    827   1.1  nisimura  * Return the best possible estimate of the time in the timeval
    828   1.1  nisimura  * to which tvp points.	 Unfortunately, we can't read the hardware registers.
    829   1.1  nisimura  * We guarantee that the time will be greater than the value obtained by a
    830   1.1  nisimura  * previous call.
    831   1.1  nisimura  */
    832   1.1  nisimura void
    833   1.1  nisimura microtime(tvp)
    834   1.1  nisimura 	register struct timeval *tvp;
    835   1.1  nisimura {
    836   1.1  nisimura 	int s = splclock();
    837   1.1  nisimura 	static struct timeval lasttime;
    838   1.1  nisimura 
    839   1.1  nisimura 	*tvp = time;
    840   1.1  nisimura #ifdef notdef
    841   1.1  nisimura 	tvp->tv_usec += clkread();
    842   1.3   msaitoh 	while (tvp->tv_usec >= 1000000) {
    843   1.1  nisimura 		tvp->tv_sec++;
    844   1.1  nisimura 		tvp->tv_usec -= 1000000;
    845   1.1  nisimura 	}
    846   1.1  nisimura #endif
    847   1.1  nisimura 	if (tvp->tv_sec == lasttime.tv_sec &&
    848   1.1  nisimura 	    tvp->tv_usec <= lasttime.tv_usec &&
    849   1.3   msaitoh 	    (tvp->tv_usec = lasttime.tv_usec + 1) >= 1000000) {
    850   1.1  nisimura 		tvp->tv_sec++;
    851   1.1  nisimura 		tvp->tv_usec -= 1000000;
    852   1.1  nisimura 	}
    853   1.1  nisimura 	lasttime = *tvp;
    854   1.1  nisimura 	splx(s);
    855   1.1  nisimura }
    856   1.1  nisimura 
    857   1.2  nisimura #if 1
    858   1.1  nisimura 
    859   1.1  nisimura struct consdev *cn_tab = &syscons;
    860   1.1  nisimura 
    861   1.1  nisimura #else
    862   1.1  nisimura 
    863   1.1  nisimura /*
    864   1.1  nisimura  * romcons is useful until m68k TC register is initialized.
    865   1.1  nisimura  */
    866   1.1  nisimura int  romcngetc __P((dev_t));
    867   1.1  nisimura void romcnputc __P((dev_t, int));
    868   1.1  nisimura 
    869   1.1  nisimura struct consdev romcons = {
    870   1.1  nisimura 	NULL,
    871   1.1  nisimura 	NULL,
    872   1.1  nisimura 	romcngetc,
    873   1.1  nisimura 	romcnputc,
    874   1.1  nisimura 	nullcnpollc,
    875   1.1  nisimura 	makedev(7, 0), /* XXX */
    876   1.1  nisimura 	CN_DEAD,
    877   1.1  nisimura };
    878   1.1  nisimura struct consdev *cn_tab = &romcons;
    879   1.1  nisimura 
    880   1.2  nisimura #define __		((int **)0x41000000)
    881   1.2  nisimura #define GETC()		(*(int (*)())__[6])()
    882   1.2  nisimura #define PUTC(x)		(*(void (*)())__[7])(x)
    883   1.2  nisimura 
    884   1.2  nisimura #define ROMPUTC(x) \
    885   1.2  nisimura ({					\
    886   1.2  nisimura 	register _r;			\
    887   1.2  nisimura 	asm volatile ("			\
    888  1.18       chs 		movc	%%vbr,%0	; \
    889  1.18       chs 		movel	%0,%%sp@-	; \
    890   1.2  nisimura 		clrl	%0		; \
    891  1.18       chs 		movc	%0,%%vbr"	\
    892   1.2  nisimura 		: "=r" (_r));		\
    893   1.2  nisimura 	PUTC(x);			\
    894   1.2  nisimura 	asm volatile ("			\
    895  1.18       chs 		movel	%%sp@+,%0	; \
    896  1.18       chs 		movc	%0,%%vbr"	\
    897   1.2  nisimura 		: "=r" (_r));		\
    898   1.2  nisimura })
    899   1.2  nisimura 
    900   1.2  nisimura #define ROMGETC() \
    901   1.2  nisimura ({					\
    902   1.2  nisimura 	register _r, _c;		\
    903   1.2  nisimura 	asm volatile ("			\
    904  1.18       chs 		movc	%%vbr,%0	; \
    905  1.18       chs 		movel	%0,%%sp@-	; \
    906   1.2  nisimura 		clrl	%0		; \
    907  1.18       chs 		movc	%0,%%vbr"	\
    908   1.2  nisimura 		: "=r" (_r));		\
    909   1.2  nisimura 	_c = GETC();			\
    910   1.2  nisimura 	asm volatile ("			\
    911  1.18       chs 		movel	%%sp@+,%0	; \
    912  1.18       chs 		movc	%0,%%vbr"	\
    913   1.2  nisimura 		: "=r" (_r));		\
    914   1.2  nisimura 	_c;				\
    915   1.2  nisimura })
    916   1.1  nisimura 
    917   1.1  nisimura void
    918   1.1  nisimura romcnputc(dev, c)
    919   1.1  nisimura 	dev_t dev;
    920   1.1  nisimura 	int c;
    921   1.1  nisimura {
    922   1.2  nisimura 	int s;
    923   1.2  nisimura 
    924   1.2  nisimura 	s = splhigh();
    925   1.1  nisimura 	ROMPUTC(c);
    926   1.2  nisimura 	splx(s);
    927   1.1  nisimura }
    928   1.1  nisimura 
    929   1.1  nisimura int
    930   1.1  nisimura romcngetc(dev)
    931   1.1  nisimura 	dev_t dev;
    932   1.1  nisimura {
    933   1.2  nisimura 	int s, c;
    934   1.1  nisimura 
    935   1.1  nisimura 	do {
    936   1.2  nisimura 		s = splhigh();
    937   1.1  nisimura 		c = ROMGETC();
    938   1.2  nisimura 		splx(s);
    939   1.1  nisimura 	} while (c == -1);
    940   1.1  nisimura 	return c;
    941   1.1  nisimura }
    942   1.1  nisimura #endif
    943