Home | History | Annotate | Line # | Download | only in dev
clock.c revision 1.23
      1  1.23        is /*	$NetBSD: clock.c,v 1.23 1996/12/17 11:43:10 is Exp $	*/
      2   1.6       cgd 
      3   1.1    chopps /*
      4   1.1    chopps  * Copyright (c) 1988 University of Utah.
      5   1.1    chopps  * Copyright (c) 1982, 1990 The Regents of the University of California.
      6   1.1    chopps  * All rights reserved.
      7   1.1    chopps  *
      8   1.1    chopps  * This code is derived from software contributed to Berkeley by
      9   1.1    chopps  * the Systems Programming Group of the University of Utah Computer
     10   1.1    chopps  * Science Department.
     11   1.1    chopps  *
     12   1.1    chopps  * Redistribution and use in source and binary forms, with or without
     13   1.1    chopps  * modification, are permitted provided that the following conditions
     14   1.1    chopps  * are met:
     15   1.1    chopps  * 1. Redistributions of source code must retain the above copyright
     16   1.1    chopps  *    notice, this list of conditions and the following disclaimer.
     17   1.1    chopps  * 2. Redistributions in binary form must reproduce the above copyright
     18   1.1    chopps  *    notice, this list of conditions and the following disclaimer in the
     19   1.1    chopps  *    documentation and/or other materials provided with the distribution.
     20   1.1    chopps  * 3. All advertising materials mentioning features or use of this software
     21   1.1    chopps  *    must display the following acknowledgement:
     22   1.1    chopps  *	This product includes software developed by the University of
     23   1.1    chopps  *	California, Berkeley and its contributors.
     24   1.1    chopps  * 4. Neither the name of the University nor the names of its contributors
     25   1.1    chopps  *    may be used to endorse or promote products derived from this software
     26   1.1    chopps  *    without specific prior written permission.
     27   1.1    chopps  *
     28   1.1    chopps  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     29   1.1    chopps  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     30   1.1    chopps  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     31   1.1    chopps  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     32   1.1    chopps  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     33   1.1    chopps  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     34   1.1    chopps  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     35   1.1    chopps  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     36   1.1    chopps  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     37   1.1    chopps  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     38   1.1    chopps  * SUCH DAMAGE.
     39   1.1    chopps  *
     40   1.1    chopps  * from: Utah $Hdr: clock.c 1.18 91/01/21$
     41   1.1    chopps  *
     42   1.1    chopps  *	@(#)clock.c	7.6 (Berkeley) 5/7/91
     43   1.1    chopps  */
     44   1.1    chopps 
     45   1.1    chopps #include <sys/param.h>
     46   1.1    chopps #include <sys/kernel.h>
     47   1.1    chopps #include <sys/device.h>
     48  1.13     veego #include <sys/systm.h>
     49   1.1    chopps #include <machine/psl.h>
     50   1.1    chopps #include <machine/cpu.h>
     51   1.1    chopps #include <amiga/amiga/device.h>
     52   1.1    chopps #include <amiga/amiga/custom.h>
     53   1.1    chopps #include <amiga/amiga/cia.h>
     54  1.14        is #ifdef DRACO
     55  1.14        is #include <amiga/amiga/drcustom.h>
     56  1.14        is #endif
     57   1.1    chopps #include <amiga/dev/rtc.h>
     58   1.8    chopps #include <amiga/dev/zbusvar.h>
     59   1.1    chopps 
     60   1.1    chopps #if defined(PROF) && defined(PROFTIMER)
     61   1.1    chopps #include <sys/PROF.h>
     62   1.1    chopps #endif
     63   1.1    chopps 
     64   1.1    chopps /* the clocks run at NTSC: 715.909kHz or PAL: 709.379kHz.
     65   1.1    chopps    We're using a 100 Hz clock. */
     66   1.1    chopps 
     67   1.1    chopps #define CLK_INTERVAL amiga_clk_interval
     68   1.4    chopps int amiga_clk_interval;
     69   1.4    chopps int eclockfreq;
     70  1.14        is struct CIA *clockcia;
     71   1.4    chopps 
     72   1.1    chopps /*
     73   1.1    chopps  * Machine-dependent clock routines.
     74   1.1    chopps  *
     75   1.1    chopps  * Startrtclock restarts the real-time clock, which provides
     76   1.1    chopps  * hardclock interrupts to kern_clock.c.
     77   1.1    chopps  *
     78   1.1    chopps  * Inittodr initializes the time of day hardware which provides
     79   1.1    chopps  * date functions.
     80   1.1    chopps  *
     81   1.1    chopps  * Resettodr restores the time of day hardware after a time change.
     82   1.1    chopps  *
     83   1.1    chopps  * A note on the real-time clock:
     84   1.1    chopps  * We actually load the clock with CLK_INTERVAL-1 instead of CLK_INTERVAL.
     85   1.1    chopps  * This is because the counter decrements to zero after N+1 enabled clock
     86   1.1    chopps  * periods where N is the value loaded into the counter.
     87   1.1    chopps  */
     88   1.1    chopps 
     89  1.11   thorpej int clockmatch __P((struct device *, void *, void *));
     90   1.1    chopps void clockattach __P((struct device *, struct device *, void *));
     91  1.13     veego void cpu_initclocks __P((void));
     92  1.23        is void calibrate_delay __P((struct device *));
     93   1.1    chopps 
     94  1.11   thorpej struct cfattach clock_ca = {
     95  1.11   thorpej 	sizeof(struct device), clockmatch, clockattach
     96  1.11   thorpej };
     97  1.11   thorpej 
     98  1.11   thorpej struct cfdriver clock_cd = {
     99  1.11   thorpej 	NULL, "clock", DV_DULL, NULL, 0 };
    100   1.1    chopps 
    101   1.1    chopps int
    102  1.11   thorpej clockmatch(pdp, match, auxp)
    103   1.1    chopps 	struct device *pdp;
    104  1.12    mhitch 	void *match, *auxp;
    105   1.1    chopps {
    106  1.18        is 	if (matchname("clock", auxp))
    107   1.1    chopps 		return(1);
    108   1.1    chopps 	return(0);
    109   1.1    chopps }
    110   1.1    chopps 
    111   1.1    chopps /*
    112   1.1    chopps  * Start the real-time clock.
    113   1.1    chopps  */
    114   1.1    chopps void
    115   1.1    chopps clockattach(pdp, dp, auxp)
    116   1.1    chopps 	struct device *pdp, *dp;
    117   1.1    chopps 	void *auxp;
    118   1.1    chopps {
    119  1.18        is 	char *clockchip;
    120   1.1    chopps 	unsigned short interval;
    121  1.18        is #ifdef DRACO
    122  1.18        is 	u_char dracorev;
    123  1.18        is #endif
    124   1.1    chopps 
    125   1.4    chopps 	if (eclockfreq == 0)
    126   1.4    chopps 		eclockfreq = 715909;	/* guess NTSC */
    127   1.4    chopps 
    128   1.4    chopps 	CLK_INTERVAL = (eclockfreq / 100);
    129   1.4    chopps 
    130  1.14        is #ifdef DRACO
    131  1.18        is 	dracorev = is_draco();
    132  1.18        is 	if (dracorev >= 4) {
    133  1.18        is 		CLK_INTERVAL = (eclockfreq / 700);
    134  1.18        is 		clockchip = "QuickLogic";
    135  1.18        is 	} else if (dracorev) {
    136  1.14        is 		clockcia = (struct CIA *)CIAAbase;
    137  1.18        is 		clockchip = "CIA A";
    138  1.14        is 	} else
    139  1.14        is #endif
    140  1.14        is 	{
    141  1.14        is 		clockcia = (struct CIA *)CIABbase;
    142  1.18        is 		clockchip = "CIA B";
    143  1.14        is 	}
    144  1.14        is 
    145  1.23        is 	if (pdp)
    146  1.23        is 		printf(": %s system hz %d hardware hz %d\n", clockchip, hz,
    147  1.20    mhitch #ifdef DRACO
    148  1.18        is 		dracorev >= 4 ? eclockfreq / 7 : eclockfreq);
    149  1.20    mhitch #else
    150  1.20    mhitch 		eclockfreq);
    151  1.20    mhitch #endif
    152  1.18        is 
    153  1.18        is #ifdef DRACO
    154  1.18        is 	if (dracorev >= 4) {
    155  1.18        is 		/*
    156  1.18        is 		 * can't preload anything beforehand, timer is free_running;
    157  1.18        is 		 * but need this for delay calibration.
    158  1.18        is 		 */
    159  1.18        is 
    160  1.18        is 		draco_ioct->io_timerlo = CLK_INTERVAL & 0xff;
    161  1.18        is 		draco_ioct->io_timerhi = CLK_INTERVAL >> 8;
    162   1.4    chopps 
    163  1.23        is 		calibrate_delay(pdp);
    164  1.18        is 
    165  1.18        is 		return;
    166  1.18        is 	}
    167  1.18        is #endif
    168   1.1    chopps 	/*
    169   1.1    chopps 	 * stop timer A
    170   1.1    chopps 	 */
    171  1.14        is 	clockcia->cra = clockcia->cra & 0xc0;
    172  1.14        is 	clockcia->icr = 1 << 0;		/* disable timer A interrupt */
    173  1.14        is 	interval = clockcia->icr;		/* and make sure it's clear */
    174   1.1    chopps 
    175   1.1    chopps 	/*
    176   1.1    chopps 	 * load interval into registers.
    177   1.1    chopps          * the clocks run at NTSC: 715.909kHz or PAL: 709.379kHz
    178   1.1    chopps 	 * supprort for PAL WHEN?!?! XXX
    179   1.1    chopps 	 */
    180   1.1    chopps 	interval = CLK_INTERVAL - 1;
    181   1.1    chopps 
    182   1.1    chopps 	/*
    183   1.1    chopps 	 * order of setting is important !
    184   1.1    chopps 	 */
    185  1.14        is 	clockcia->talo = interval & 0xff;
    186  1.14        is 	clockcia->tahi = interval >> 8;
    187  1.18        is 	/*
    188  1.18        is 	 * start timer A in continuous mode
    189  1.18        is 	 */
    190  1.18        is 	clockcia->cra = (clockcia->cra & 0xc0) | 1;
    191  1.18        is 
    192  1.23        is 	calibrate_delay(pdp);
    193  1.18        is }
    194  1.18        is 
    195  1.18        is /*
    196  1.18        is  * Calibrate delay loop.
    197  1.18        is  * We use two iterations because we don't have enough bits to do a factor of
    198  1.18        is  * 8 with better than 1%.
    199  1.18        is  *
    200  1.18        is  * XXX Note that we MUST stay below 1 tick if using clkread(), even for
    201  1.18        is  * underestimated values of delaydivisor.
    202  1.18        is  *
    203  1.18        is  * XXX the "ns" below is only correct for a shift of 10 bits, and even then
    204  1.18        is  * off by 2.4%
    205  1.18        is  */
    206  1.18        is 
    207  1.23        is void calibrate_delay(pdp)
    208  1.23        is 	struct device *pdp;
    209  1.18        is {
    210  1.18        is 	unsigned long t1, t2;
    211  1.18        is 	extern u_int32_t delaydivisor;
    212  1.18        is 		/* XXX this should be defined elsewhere */
    213  1.18        is 
    214  1.23        is 	if (pdp)
    215  1.23        is 		printf("Calibrating delay loop... ");
    216  1.18        is 
    217  1.18        is 	do {
    218  1.18        is 		t1 = clkread();
    219  1.18        is 		delay(1024);
    220  1.18        is 		t2 = clkread();
    221  1.18        is 	} while (t2 <= t1);
    222  1.18        is 	t2 -= t1;
    223  1.18        is 	delaydivisor = (delaydivisor * t2 + 1023) >> 10;
    224  1.18        is #ifdef DIAGNOSTIC
    225  1.23        is 	if (pdp)
    226  1.23        is 		printf("\ndiff %ld us, new divisor %u ns\n", t2, delaydivisor);
    227  1.18        is 	do {
    228  1.18        is 		t1 = clkread();
    229  1.18        is 		delay(1024);
    230  1.18        is 		t2 = clkread();
    231  1.18        is 	} while (t2 <= t1);
    232  1.18        is 	t2 -= t1;
    233  1.18        is 	delaydivisor = (delaydivisor * t2 + 1023) >> 10;
    234  1.23        is 	if (pdp)
    235  1.23        is 		printf("diff %ld us, new divisor %u ns\n", t2, delaydivisor);
    236  1.18        is #endif
    237  1.18        is 	do {
    238  1.18        is 		t1 = clkread();
    239  1.18        is 		delay(1024);
    240  1.18        is 		t2 = clkread();
    241  1.18        is 	} while (t2 <= t1);
    242  1.18        is 	t2 -= t1;
    243  1.18        is 	delaydivisor = (delaydivisor * t2 + 1023) >> 10;
    244  1.18        is #ifdef DIAGNOSTIC
    245  1.23        is 	if (pdp)
    246  1.23        is 		printf("diff %ld us, new divisor ", t2);
    247  1.18        is #endif
    248  1.23        is 	if (pdp)
    249  1.23        is 		printf("%u ns\n", delaydivisor);
    250   1.1    chopps }
    251   1.1    chopps 
    252   1.1    chopps void
    253   1.1    chopps cpu_initclocks()
    254   1.1    chopps {
    255  1.20    mhitch #ifdef DRACO
    256  1.18        is 	unsigned char dracorev;
    257  1.18        is 	dracorev = is_draco();
    258  1.18        is 	if (dracorev >= 4) {
    259  1.18        is 		draco_ioct->io_timerlo = CLK_INTERVAL & 0xFF;
    260  1.18        is 		draco_ioct->io_timerhi = CLK_INTERVAL >> 8;
    261  1.18        is 		draco_ioct->io_timerrst = 0;	/* any value resets */
    262  1.18        is 		draco_ioct->io_status2 |= DRSTAT2_TMRINTENA;
    263  1.18        is 
    264  1.18        is 		return;
    265  1.18        is 	}
    266  1.18        is #endif
    267   1.1    chopps 	/*
    268   1.1    chopps 	 * enable interrupts for timer A
    269   1.1    chopps 	 */
    270  1.14        is 	clockcia->icr = (1<<7) | (1<<0);
    271   1.1    chopps 
    272   1.1    chopps 	/*
    273   1.1    chopps 	 * start timer A in continuous shot mode
    274   1.1    chopps 	 */
    275  1.14        is 	clockcia->cra = (clockcia->cra & 0xc0) | 1;
    276   1.1    chopps 
    277   1.1    chopps 	/*
    278   1.1    chopps 	 * and globally enable interrupts for ciab
    279   1.1    chopps 	 */
    280  1.14        is #ifdef DRACO
    281  1.18        is 	if (dracorev)		/* we use cia a on DraCo */
    282  1.14        is 		*draco_intena |= DRIRQ_INT2;
    283  1.14        is 	else
    284  1.14        is #endif
    285  1.14        is 		custom.intena = INTF_SETCLR | INTF_EXTER;
    286  1.18        is 
    287   1.1    chopps }
    288   1.1    chopps 
    289  1.13     veego void
    290   1.1    chopps setstatclockrate(hz)
    291   1.1    chopps 	int hz;
    292   1.1    chopps {
    293   1.1    chopps }
    294   1.1    chopps 
    295   1.1    chopps /*
    296   1.1    chopps  * Returns number of usec since last recorded clock "tick"
    297   1.1    chopps  * (i.e. clock interrupt).
    298   1.1    chopps  */
    299  1.13     veego u_long
    300   1.1    chopps clkread()
    301   1.1    chopps {
    302  1.18        is 	u_int interval;
    303   1.1    chopps 	u_char hi, hi2, lo;
    304   1.1    chopps 
    305  1.14        is #ifdef DRACO
    306  1.18        is 	if (is_draco() >= 4) {
    307  1.18        is 		hi2 = draco_ioct->io_chiprev;	/* latch timer */
    308  1.18        is 		hi = draco_ioct->io_timerhi;
    309  1.18        is 		lo = draco_ioct->io_timerlo;
    310  1.18        is 		interval = ((hi<<8) | lo);
    311  1.18        is 		if (interval > CLK_INTERVAL)	/* timer underflow */
    312  1.18        is 			interval = 65536 + CLK_INTERVAL - interval;
    313  1.18        is 		else
    314  1.18        is 			interval = CLK_INTERVAL - interval;
    315   1.1    chopps 
    316  1.18        is 	} else
    317  1.14        is #endif
    318  1.18        is 	{
    319  1.18        is 		hi  = clockcia->tahi;
    320  1.18        is 		lo  = clockcia->talo;
    321  1.18        is 		hi2 = clockcia->tahi;
    322  1.18        is 		if (hi != hi2) {
    323  1.18        is 			lo = clockcia->talo;
    324  1.18        is 			hi = hi2;
    325  1.18        is 		}
    326   1.1    chopps 
    327  1.18        is 		interval = (CLK_INTERVAL - 1) - ((hi<<8) | lo);
    328  1.18        is 
    329   1.1    chopps 		/*
    330  1.18        is 		 * should read ICR and if there's an int pending, adjust
    331  1.18        is 		 * interval. However, since reading ICR clears the interrupt,
    332  1.18        is 		 * we'd lose a hardclock int, and this is not tolerable.
    333   1.1    chopps 		 */
    334   1.1    chopps 	}
    335   1.1    chopps 
    336  1.18        is 	return((interval * tick) / CLK_INTERVAL);
    337   1.1    chopps }
    338   1.1    chopps 
    339   1.1    chopps #if notyet
    340   1.1    chopps 
    341   1.1    chopps /* implement this later. I'd suggest using both timers in CIA-A, they're
    342   1.1    chopps    not yet used. */
    343   1.1    chopps 
    344   1.1    chopps #include "clock.h"
    345   1.1    chopps #if NCLOCK > 0
    346   1.1    chopps /*
    347   1.1    chopps  * /dev/clock: mappable high resolution timer.
    348   1.1    chopps  *
    349   1.1    chopps  * This code implements a 32-bit recycling counter (with a 4 usec period)
    350   1.1    chopps  * using timers 2 & 3 on the 6840 clock chip.  The counter can be mapped
    351   1.1    chopps  * RO into a user's address space to achieve low overhead (no system calls),
    352   1.1    chopps  * high-precision timing.
    353   1.1    chopps  *
    354   1.1    chopps  * Note that timer 3 is also used for the high precision profiling timer
    355   1.1    chopps  * (PROFTIMER code above).  Care should be taken when both uses are
    356   1.1    chopps  * configured as only a token effort is made to avoid conflicting use.
    357   1.1    chopps  */
    358   1.1    chopps #include <sys/proc.h>
    359   1.1    chopps #include <sys/resourcevar.h>
    360   1.1    chopps #include <sys/ioctl.h>
    361   1.1    chopps #include <sys/malloc.h>
    362   1.1    chopps #include <vm/vm.h>
    363   1.1    chopps #include <amiga/amiga/clockioctl.h>
    364   1.1    chopps #include <sys/specdev.h>
    365   1.1    chopps #include <sys/vnode.h>
    366   1.1    chopps #include <sys/mman.h>
    367   1.1    chopps 
    368   1.1    chopps int clockon = 0;		/* non-zero if high-res timer enabled */
    369   1.1    chopps #ifdef PROFTIMER
    370   1.1    chopps int  profprocs = 0;		/* # of procs using profiling timer */
    371   1.1    chopps #endif
    372   1.1    chopps #ifdef DEBUG
    373   1.1    chopps int clockdebug = 0;
    374   1.1    chopps #endif
    375   1.1    chopps 
    376   1.1    chopps /*ARGSUSED*/
    377   1.1    chopps clockopen(dev, flags)
    378   1.1    chopps 	dev_t dev;
    379   1.1    chopps {
    380   1.1    chopps #ifdef PROFTIMER
    381   1.1    chopps #ifdef PROF
    382   1.1    chopps 	/*
    383   1.1    chopps 	 * Kernel profiling enabled, give up.
    384   1.1    chopps 	 */
    385   1.1    chopps 	if (profiling)
    386   1.1    chopps 		return(EBUSY);
    387   1.1    chopps #endif
    388   1.1    chopps 	/*
    389   1.1    chopps 	 * If any user processes are profiling, give up.
    390   1.1    chopps 	 */
    391   1.1    chopps 	if (profprocs)
    392   1.1    chopps 		return(EBUSY);
    393   1.1    chopps #endif
    394   1.1    chopps 	if (!clockon) {
    395   1.1    chopps 		startclock();
    396   1.1    chopps 		clockon++;
    397   1.1    chopps 	}
    398   1.1    chopps 	return(0);
    399   1.1    chopps }
    400   1.1    chopps 
    401   1.1    chopps /*ARGSUSED*/
    402   1.1    chopps clockclose(dev, flags)
    403   1.1    chopps 	dev_t dev;
    404   1.1    chopps {
    405   1.1    chopps 	(void) clockunmmap(dev, (caddr_t)0, curproc);	/* XXX */
    406   1.1    chopps 	stopclock();
    407   1.1    chopps 	clockon = 0;
    408   1.1    chopps 	return(0);
    409   1.1    chopps }
    410   1.1    chopps 
    411   1.1    chopps /*ARGSUSED*/
    412   1.1    chopps clockioctl(dev, cmd, data, flag, p)
    413   1.1    chopps 	dev_t dev;
    414   1.7    chopps 	u_long cmd;
    415   1.1    chopps 	caddr_t data;
    416   1.1    chopps 	struct proc *p;
    417   1.1    chopps {
    418   1.1    chopps 	int error = 0;
    419   1.1    chopps 
    420   1.1    chopps 	switch (cmd) {
    421   1.1    chopps 
    422   1.1    chopps 	case CLOCKMAP:
    423   1.1    chopps 		error = clockmmap(dev, (caddr_t *)data, p);
    424   1.1    chopps 		break;
    425   1.1    chopps 
    426   1.1    chopps 	case CLOCKUNMAP:
    427   1.1    chopps 		error = clockunmmap(dev, *(caddr_t *)data, p);
    428   1.1    chopps 		break;
    429   1.1    chopps 
    430   1.1    chopps 	case CLOCKGETRES:
    431   1.1    chopps 		*(int *)data = CLK_RESOLUTION;
    432   1.1    chopps 		break;
    433   1.1    chopps 
    434   1.1    chopps 	default:
    435   1.1    chopps 		error = EINVAL;
    436   1.1    chopps 		break;
    437   1.1    chopps 	}
    438   1.1    chopps 	return(error);
    439   1.1    chopps }
    440   1.1    chopps 
    441   1.1    chopps /*ARGSUSED*/
    442   1.1    chopps clockmap(dev, off, prot)
    443   1.1    chopps 	dev_t dev;
    444   1.1    chopps {
    445   1.1    chopps 	return((off + (INTIOBASE+CLKBASE+CLKSR-1)) >> PGSHIFT);
    446   1.1    chopps }
    447   1.1    chopps 
    448   1.1    chopps clockmmap(dev, addrp, p)
    449   1.1    chopps 	dev_t dev;
    450   1.1    chopps 	caddr_t *addrp;
    451   1.1    chopps 	struct proc *p;
    452   1.1    chopps {
    453   1.1    chopps 	int error;
    454   1.1    chopps 	struct vnode vn;
    455   1.1    chopps 	struct specinfo si;
    456   1.1    chopps 	int flags;
    457   1.1    chopps 
    458   1.1    chopps 	flags = MAP_FILE|MAP_SHARED;
    459   1.1    chopps 	if (*addrp)
    460   1.1    chopps 		flags |= MAP_FIXED;
    461   1.1    chopps 	else
    462   1.1    chopps 		*addrp = (caddr_t)0x1000000;	/* XXX */
    463   1.1    chopps 	vn.v_type = VCHR;			/* XXX */
    464   1.1    chopps 	vn.v_specinfo = &si;			/* XXX */
    465   1.1    chopps 	vn.v_rdev = dev;			/* XXX */
    466   1.1    chopps 	error = vm_mmap(&p->p_vmspace->vm_map, (vm_offset_t *)addrp,
    467   1.1    chopps 			PAGE_SIZE, VM_PROT_ALL, flags, (caddr_t)&vn, 0);
    468   1.1    chopps 	return(error);
    469   1.1    chopps }
    470   1.1    chopps 
    471   1.1    chopps clockunmmap(dev, addr, p)
    472   1.1    chopps 	dev_t dev;
    473   1.1    chopps 	caddr_t addr;
    474   1.1    chopps 	struct proc *p;
    475   1.1    chopps {
    476   1.1    chopps 	int rv;
    477   1.1    chopps 
    478   1.1    chopps 	if (addr == 0)
    479   1.1    chopps 		return(EINVAL);		/* XXX: how do we deal with this? */
    480   1.1    chopps 	rv = vm_deallocate(p->p_vmspace->vm_map, (vm_offset_t)addr, PAGE_SIZE);
    481   1.1    chopps 	return(rv == KERN_SUCCESS ? 0 : EINVAL);
    482   1.1    chopps }
    483   1.1    chopps 
    484   1.1    chopps startclock()
    485   1.1    chopps {
    486   1.1    chopps 	register struct clkreg *clk = (struct clkreg *)clkstd[0];
    487   1.1    chopps 
    488   1.1    chopps 	clk->clk_msb2 = -1; clk->clk_lsb2 = -1;
    489   1.1    chopps 	clk->clk_msb3 = -1; clk->clk_lsb3 = -1;
    490   1.1    chopps 
    491   1.1    chopps 	clk->clk_cr2 = CLK_CR3;
    492   1.1    chopps 	clk->clk_cr3 = CLK_OENAB|CLK_8BIT;
    493   1.1    chopps 	clk->clk_cr2 = CLK_CR1;
    494   1.1    chopps 	clk->clk_cr1 = CLK_IENAB;
    495   1.1    chopps }
    496   1.1    chopps 
    497   1.1    chopps stopclock()
    498   1.1    chopps {
    499   1.1    chopps 	register struct clkreg *clk = (struct clkreg *)clkstd[0];
    500   1.1    chopps 
    501   1.1    chopps 	clk->clk_cr2 = CLK_CR3;
    502   1.1    chopps 	clk->clk_cr3 = 0;
    503   1.1    chopps 	clk->clk_cr2 = CLK_CR1;
    504   1.1    chopps 	clk->clk_cr1 = CLK_IENAB;
    505   1.1    chopps }
    506   1.1    chopps #endif
    507   1.1    chopps 
    508   1.1    chopps #endif
    509   1.1    chopps 
    510   1.1    chopps 
    511   1.1    chopps #ifdef PROFTIMER
    512   1.1    chopps /*
    513   1.1    chopps  * This code allows the amiga kernel to use one of the extra timers on
    514   1.1    chopps  * the clock chip for profiling, instead of the regular system timer.
    515   1.1    chopps  * The advantage of this is that the profiling timer can be turned up to
    516   1.1    chopps  * a higher interrupt rate, giving finer resolution timing. The profclock
    517   1.1    chopps  * routine is called from the lev6intr in locore, and is a specialized
    518   1.1    chopps  * routine that calls addupc. The overhead then is far less than if
    519   1.1    chopps  * hardclock/softclock was called. Further, the context switch code in
    520   1.1    chopps  * locore has been changed to turn the profile clock on/off when switching
    521   1.1    chopps  * into/out of a process that is profiling (startprofclock/stopprofclock).
    522   1.1    chopps  * This reduces the impact of the profiling clock on other users, and might
    523   1.1    chopps  * possibly increase the accuracy of the profiling.
    524   1.1    chopps  */
    525   1.1    chopps int  profint   = PRF_INTERVAL;	/* Clock ticks between interrupts */
    526   1.1    chopps int  profscale = 0;		/* Scale factor from sys clock to prof clock */
    527   1.1    chopps char profon    = 0;		/* Is profiling clock on? */
    528   1.1    chopps 
    529   1.1    chopps /* profon values - do not change, locore.s assumes these values */
    530   1.1    chopps #define PRF_NONE	0x00
    531   1.1    chopps #define	PRF_USER	0x01
    532   1.1    chopps #define	PRF_KERNEL	0x80
    533   1.1    chopps 
    534   1.1    chopps initprofclock()
    535   1.1    chopps {
    536   1.1    chopps #if NCLOCK > 0
    537   1.1    chopps 	struct proc *p = curproc;		/* XXX */
    538   1.1    chopps 
    539   1.1    chopps 	/*
    540   1.1    chopps 	 * If the high-res timer is running, force profiling off.
    541   1.1    chopps 	 * Unfortunately, this gets reflected back to the user not as
    542   1.1    chopps 	 * an error but as a lack of results.
    543   1.1    chopps 	 */
    544   1.1    chopps 	if (clockon) {
    545   1.1    chopps 		p->p_stats->p_prof.pr_scale = 0;
    546   1.1    chopps 		return;
    547   1.1    chopps 	}
    548   1.1    chopps 	/*
    549   1.1    chopps 	 * Keep track of the number of user processes that are profiling
    550   1.1    chopps 	 * by checking the scale value.
    551   1.1    chopps 	 *
    552   1.1    chopps 	 * XXX: this all assumes that the profiling code is well behaved;
    553   1.1    chopps 	 * i.e. profil() is called once per process with pcscale non-zero
    554   1.1    chopps 	 * to turn it on, and once with pcscale zero to turn it off.
    555   1.1    chopps 	 * Also assumes you don't do any forks or execs.  Oh well, there
    556   1.1    chopps 	 * is always adb...
    557   1.1    chopps 	 */
    558   1.1    chopps 	if (p->p_stats->p_prof.pr_scale)
    559   1.1    chopps 		profprocs++;
    560   1.1    chopps 	else
    561   1.1    chopps 		profprocs--;
    562   1.1    chopps #endif
    563   1.1    chopps 	/*
    564   1.1    chopps 	 * The profile interrupt interval must be an even divisor
    565   1.1    chopps 	 * of the CLK_INTERVAL so that scaling from a system clock
    566   1.1    chopps 	 * tick to a profile clock tick is possible using integer math.
    567   1.1    chopps 	 */
    568   1.1    chopps 	if (profint > CLK_INTERVAL || (CLK_INTERVAL % profint) != 0)
    569   1.1    chopps 		profint = CLK_INTERVAL;
    570   1.1    chopps 	profscale = CLK_INTERVAL / profint;
    571   1.1    chopps }
    572   1.1    chopps 
    573   1.1    chopps startprofclock()
    574   1.1    chopps {
    575   1.1    chopps   unsigned short interval;
    576   1.1    chopps 
    577   1.1    chopps   /* stop timer B */
    578  1.14        is   clockcia->crb = clockcia->crb & 0xc0;
    579   1.1    chopps 
    580   1.1    chopps   /* load interval into registers.
    581   1.1    chopps      the clocks run at NTSC: 715.909kHz or PAL: 709.379kHz */
    582   1.1    chopps 
    583   1.1    chopps   interval = profint - 1;
    584   1.1    chopps 
    585   1.1    chopps   /* order of setting is important ! */
    586  1.14        is   clockcia->tblo = interval & 0xff;
    587  1.14        is   clockcia->tbhi = interval >> 8;
    588   1.1    chopps 
    589   1.1    chopps   /* enable interrupts for timer B */
    590  1.14        is   clockcia->icr = (1<<7) | (1<<1);
    591   1.1    chopps 
    592   1.1    chopps   /* start timer B in continuous shot mode */
    593  1.14        is   clockcia->crb = (clockcia->crb & 0xc0) | 1;
    594   1.1    chopps }
    595   1.1    chopps 
    596   1.1    chopps stopprofclock()
    597   1.1    chopps {
    598   1.1    chopps   /* stop timer B */
    599  1.14        is   clockcia->crb = clockcia->crb & 0xc0;
    600   1.1    chopps }
    601   1.1    chopps 
    602   1.1    chopps #ifdef PROF
    603   1.1    chopps /*
    604   1.1    chopps  * profclock() is expanded in line in lev6intr() unless profiling kernel.
    605   1.1    chopps  * Assumes it is called with clock interrupts blocked.
    606   1.1    chopps  */
    607   1.1    chopps profclock(pc, ps)
    608   1.1    chopps 	caddr_t pc;
    609   1.1    chopps 	int ps;
    610   1.1    chopps {
    611   1.1    chopps 	/*
    612   1.1    chopps 	 * Came from user mode.
    613   1.1    chopps 	 * If this process is being profiled record the tick.
    614   1.1    chopps 	 */
    615   1.1    chopps 	if (USERMODE(ps)) {
    616   1.1    chopps 		if (p->p_stats.p_prof.pr_scale)
    617   1.1    chopps 			addupc(pc, &curproc->p_stats.p_prof, 1);
    618   1.1    chopps 	}
    619   1.1    chopps 	/*
    620   1.1    chopps 	 * Came from kernel (supervisor) mode.
    621   1.1    chopps 	 * If we are profiling the kernel, record the tick.
    622   1.1    chopps 	 */
    623   1.1    chopps 	else if (profiling < 2) {
    624   1.1    chopps 		register int s = pc - s_lowpc;
    625   1.1    chopps 
    626   1.1    chopps 		if (s < s_textsize)
    627   1.1    chopps 			kcount[s / (HISTFRACTION * sizeof (*kcount))]++;
    628   1.1    chopps 	}
    629   1.1    chopps 	/*
    630   1.1    chopps 	 * Kernel profiling was on but has been disabled.
    631   1.1    chopps 	 * Mark as no longer profiling kernel and if all profiling done,
    632   1.1    chopps 	 * disable the clock.
    633   1.1    chopps 	 */
    634   1.1    chopps 	if (profiling && (profon & PRF_KERNEL)) {
    635   1.1    chopps 		profon &= ~PRF_KERNEL;
    636   1.1    chopps 		if (profon == PRF_NONE)
    637   1.1    chopps 			stopprofclock();
    638   1.1    chopps 	}
    639   1.1    chopps }
    640   1.1    chopps #endif
    641   1.1    chopps #endif
    642   1.1    chopps 
    643   1.1    chopps /* this is a hook set by a clock driver for the configured realtime clock,
    644   1.1    chopps    returning plain current unix-time */
    645   1.1    chopps long (*gettod) __P((void));
    646   1.1    chopps int (*settod) __P((long));
    647   1.1    chopps void *clockaddr;
    648   1.1    chopps 
    649   1.1    chopps long a3gettod __P((void));
    650   1.1    chopps long a2gettod __P((void));
    651   1.1    chopps int a3settod __P((long));
    652   1.1    chopps int a2settod __P((long));
    653   1.1    chopps int rtcinit __P((void));
    654   1.1    chopps 
    655   1.1    chopps /*
    656   1.1    chopps  * Initialize the time of day register, based on the time base which is, e.g.
    657   1.1    chopps  * from a filesystem.
    658   1.1    chopps  */
    659  1.13     veego void
    660   1.1    chopps inittodr(base)
    661   1.1    chopps 	time_t base;
    662   1.1    chopps {
    663   1.1    chopps 	u_long timbuf = base;	/* assume no battery clock exists */
    664   1.1    chopps 
    665   1.1    chopps 	if (gettod == NULL && rtcinit() == 0)
    666  1.21  christos 		printf("WARNING: no battery clock\n");
    667   1.1    chopps 	else
    668   1.1    chopps 		timbuf = gettod();
    669   1.1    chopps 
    670   1.1    chopps 	if (timbuf < base) {
    671  1.21  christos 		printf("WARNING: bad date in battery clock\n");
    672   1.1    chopps 		timbuf = base;
    673   1.1    chopps 	}
    674   1.1    chopps 
    675   1.1    chopps 	/* Battery clock does not store usec's, so forget about it. */
    676   1.1    chopps 	time.tv_sec = timbuf;
    677   1.1    chopps }
    678   1.1    chopps 
    679  1.13     veego void
    680   1.1    chopps resettodr()
    681   1.1    chopps {
    682  1.13     veego 	if (settod && settod(time.tv_sec) == 0)
    683  1.21  christos 		printf("Cannot set battery backed clock\n");
    684   1.1    chopps }
    685   1.1    chopps 
    686   1.1    chopps int
    687   1.1    chopps rtcinit()
    688   1.1    chopps {
    689   1.1    chopps 	clockaddr = (void *)ztwomap(0xdc0000);
    690  1.14        is #ifdef DRACO
    691  1.14        is 	if (is_draco()) {
    692  1.14        is 		/* XXX to be done */
    693  1.14        is 		gettod = (void *)0;
    694  1.14        is 		settod = (void *)0;
    695  1.14        is 		return 0;
    696  1.14        is 	} else
    697  1.14        is #endif
    698   1.1    chopps 	if (is_a3000() || is_a4000()) {
    699   1.1    chopps 		if (a3gettod() == 0)
    700   1.1    chopps 			return(0);
    701   1.1    chopps 		gettod = a3gettod;
    702   1.1    chopps 		settod = a3settod;
    703   1.1    chopps 	} else {
    704   1.1    chopps 		if (a2gettod() == 0)
    705   1.1    chopps 			return(0);
    706   1.1    chopps 		gettod = a2gettod;
    707   1.1    chopps 		settod = a2settod;
    708   1.1    chopps 	}
    709   1.1    chopps 	return(1);
    710   1.1    chopps }
    711   1.1    chopps 
    712   1.1    chopps static int month_days[12] = {
    713   1.1    chopps 	31, 28, 31, 30, 31, 30, 31, 31, 30, 31, 30, 31
    714   1.1    chopps };
    715   1.1    chopps 
    716   1.1    chopps long
    717   1.1    chopps a3gettod()
    718   1.1    chopps {
    719   1.1    chopps 	struct rtclock3000 *rt;
    720  1.10    chopps 	int i, year, month, day, wday, hour, min, sec;
    721   1.1    chopps 	u_long tmp;
    722   1.1    chopps 
    723   1.1    chopps 	rt = clockaddr;
    724   1.1    chopps 
    725   1.1    chopps 	/* hold clock */
    726   1.1    chopps 	rt->control1 = A3CONTROL1_HOLD_CLOCK;
    727   1.1    chopps 
    728   1.1    chopps 	/* read it */
    729   1.1    chopps 	sec   = rt->second1 * 10 + rt->second2;
    730   1.1    chopps 	min   = rt->minute1 * 10 + rt->minute2;
    731   1.1    chopps 	hour  = rt->hour1   * 10 + rt->hour2;
    732  1.10    chopps 	wday  = rt->weekday;
    733   1.1    chopps 	day   = rt->day1    * 10 + rt->day2;
    734   1.1    chopps 	month = rt->month1  * 10 + rt->month2;
    735   1.1    chopps 	year  = rt->year1   * 10 + rt->year2   + 1900;
    736   1.1    chopps 
    737   1.1    chopps 	/* let it run again.. */
    738   1.1    chopps 	rt->control1 = A3CONTROL1_FREE_CLOCK;
    739   1.1    chopps 
    740   1.1    chopps 	if (range_test(hour, 0, 23))
    741   1.1    chopps 		return(0);
    742  1.10    chopps 	if (range_test(wday, 0, 6))
    743  1.10    chopps 		return(0);
    744   1.1    chopps 	if (range_test(day, 1, 31))
    745   1.1    chopps 		return(0);
    746   1.1    chopps 	if (range_test(month, 1, 12))
    747   1.1    chopps 		return(0);
    748   1.1    chopps 	if (range_test(year, STARTOFTIME, 2000))
    749   1.1    chopps 		return(0);
    750   1.1    chopps 
    751   1.1    chopps 	tmp = 0;
    752   1.1    chopps 
    753   1.1    chopps 	for (i = STARTOFTIME; i < year; i++)
    754   1.1    chopps 		tmp += days_in_year(i);
    755   1.1    chopps 	if (leapyear(year) && month > FEBRUARY)
    756   1.1    chopps 		tmp++;
    757   1.1    chopps 
    758   1.1    chopps 	for (i = 1; i < month; i++)
    759   1.1    chopps 		tmp += days_in_month(i);
    760   1.1    chopps 
    761   1.1    chopps 	tmp += (day - 1);
    762   1.1    chopps 	tmp = ((tmp * 24 + hour) * 60 + min) * 60 + sec;
    763   1.1    chopps 
    764   1.1    chopps 	return(tmp);
    765   1.1    chopps }
    766   1.1    chopps 
    767   1.1    chopps int
    768   1.1    chopps a3settod(tim)
    769   1.1    chopps 	long tim;
    770   1.1    chopps {
    771   1.1    chopps 	register int i;
    772   1.1    chopps 	register long hms, day;
    773   1.1    chopps 	u_char sec1, sec2;
    774   1.1    chopps 	u_char min1, min2;
    775   1.1    chopps 	u_char hour1, hour2;
    776  1.10    chopps /*	u_char wday; */
    777   1.1    chopps 	u_char day1, day2;
    778   1.1    chopps 	u_char mon1, mon2;
    779   1.1    chopps 	u_char year1, year2;
    780   1.1    chopps 	struct rtclock3000 *rt;
    781   1.1    chopps 
    782   1.1    chopps 	rt = clockaddr;
    783   1.1    chopps 	/*
    784   1.1    chopps 	 * there seem to be problems with the bitfield addressing
    785   1.1    chopps 	 * currently used..
    786   1.1    chopps 	 */
    787  1.10    chopps 
    788  1.10    chopps 	if (! rt)
    789   1.1    chopps 		return 0;
    790   1.1    chopps 
    791   1.1    chopps 	/* prepare values to be written to clock */
    792   1.1    chopps 	day = tim / SECDAY;
    793   1.1    chopps 	hms = tim % SECDAY;
    794   1.1    chopps 
    795   1.1    chopps 	hour2 = hms / 3600;
    796   1.1    chopps 	hour1 = hour2 / 10;
    797   1.1    chopps 	hour2 %= 10;
    798   1.1    chopps 
    799   1.1    chopps 	min2 = (hms % 3600) / 60;
    800   1.1    chopps 	min1 = min2 / 10;
    801   1.1    chopps 	min2 %= 10;
    802   1.1    chopps 
    803   1.1    chopps 
    804   1.1    chopps 	sec2 = (hms % 3600) % 60;
    805   1.1    chopps 	sec1 = sec2 / 10;
    806   1.1    chopps 	sec2 %= 10;
    807   1.1    chopps 
    808   1.1    chopps 	/* Number of years in days */
    809   1.1    chopps 	for (i = STARTOFTIME - 1900; day >= days_in_year(i); i++)
    810   1.1    chopps 		day -= days_in_year(i);
    811   1.1    chopps 	year1 = i / 10;
    812   1.1    chopps 	year2 = i % 10;
    813   1.1    chopps 
    814   1.1    chopps 	/* Number of months in days left */
    815   1.1    chopps 	if (leapyear(i))
    816   1.1    chopps 		days_in_month(FEBRUARY) = 29;
    817   1.1    chopps 	for (i = 1; day >= days_in_month(i); i++)
    818   1.1    chopps 		day -= days_in_month(i);
    819   1.1    chopps 	days_in_month(FEBRUARY) = 28;
    820   1.1    chopps 
    821   1.1    chopps 	mon1 = i / 10;
    822   1.1    chopps 	mon2 = i % 10;
    823   1.1    chopps 
    824   1.1    chopps 	/* Days are what is left over (+1) from all that. */
    825   1.1    chopps 	day ++;
    826   1.1    chopps 	day1 = day / 10;
    827   1.1    chopps 	day2 = day % 10;
    828   1.1    chopps 
    829  1.10    chopps 	rt->control1 = A3CONTROL1_HOLD_CLOCK;
    830   1.1    chopps 	rt->second1 = sec1;
    831   1.1    chopps 	rt->second2 = sec2;
    832   1.1    chopps 	rt->minute1 = min1;
    833   1.1    chopps 	rt->minute2 = min2;
    834   1.1    chopps 	rt->hour1   = hour1;
    835   1.1    chopps 	rt->hour2   = hour2;
    836  1.10    chopps /*	rt->weekday = wday; */
    837   1.1    chopps 	rt->day1    = day1;
    838   1.1    chopps 	rt->day2    = day2;
    839   1.1    chopps 	rt->month1  = mon1;
    840   1.1    chopps 	rt->month2  = mon2;
    841   1.1    chopps 	rt->year1   = year1;
    842   1.1    chopps 	rt->year2   = year2;
    843  1.10    chopps 	rt->control1 = A3CONTROL1_FREE_CLOCK;
    844   1.1    chopps 
    845   1.1    chopps 	return 1;
    846   1.1    chopps }
    847   1.1    chopps 
    848   1.1    chopps long
    849   1.1    chopps a2gettod()
    850   1.1    chopps {
    851   1.1    chopps 	struct rtclock2000 *rt;
    852   1.1    chopps 	int i, year, month, day, hour, min, sec;
    853   1.1    chopps 	u_long tmp;
    854   1.1    chopps 
    855   1.1    chopps 	rt = clockaddr;
    856   1.1    chopps 
    857   1.1    chopps 	/*
    858   1.1    chopps 	 * hold clock
    859   1.1    chopps 	 */
    860   1.1    chopps 	rt->control1 |= A2CONTROL1_HOLD;
    861   1.9    chopps 	i = 0x1000;
    862   1.9    chopps 	while (rt->control1 & A2CONTROL1_BUSY && i--)
    863   1.1    chopps 		;
    864   1.9    chopps 	if (rt->control1 & A2CONTROL1_BUSY)
    865   1.9    chopps 		return (0);	/* Give up and say it's not there */
    866   1.1    chopps 
    867   1.1    chopps 	/*
    868   1.1    chopps 	 * read it
    869   1.1    chopps 	 */
    870   1.1    chopps 	sec = rt->second1 * 10 + rt->second2;
    871   1.1    chopps 	min = rt->minute1 * 10 + rt->minute2;
    872   1.1    chopps 	hour = (rt->hour1 & 3)  * 10 + rt->hour2;
    873   1.1    chopps 	day = rt->day1 * 10 + rt->day2;
    874   1.1    chopps 	month = rt->month1 * 10 + rt->month2;
    875   1.1    chopps 	year = rt->year1 * 10 + rt->year2   + 1900;
    876   1.1    chopps 
    877   1.1    chopps 	if ((rt->control3 & A2CONTROL3_24HMODE) == 0) {
    878   1.1    chopps 		if ((rt->hour1 & A2HOUR1_PM) == 0 && hour == 12)
    879   1.1    chopps 			hour = 0;
    880   1.1    chopps 		else if ((rt->hour1 & A2HOUR1_PM) && hour != 12)
    881   1.1    chopps 			hour += 12;
    882   1.1    chopps 	}
    883   1.1    chopps 
    884   1.1    chopps 	/*
    885   1.1    chopps 	 * release the clock
    886   1.1    chopps 	 */
    887   1.1    chopps 	rt->control1 &= ~A2CONTROL1_HOLD;
    888   1.1    chopps 
    889   1.1    chopps 	if (range_test(hour, 0, 23))
    890   1.1    chopps 		return(0);
    891   1.1    chopps 	if (range_test(day, 1, 31))
    892   1.1    chopps 		return(0);
    893   1.1    chopps 	if (range_test(month, 1, 12))
    894   1.1    chopps 		return(0);
    895   1.1    chopps 	if (range_test(year, STARTOFTIME, 2000))
    896   1.1    chopps 		return(0);
    897   1.1    chopps 
    898   1.1    chopps 	tmp = 0;
    899   1.1    chopps 
    900   1.1    chopps 	for (i = STARTOFTIME; i < year; i++)
    901   1.1    chopps 		tmp += days_in_year(i);
    902   1.1    chopps 	if (leapyear(year) && month > FEBRUARY)
    903   1.1    chopps 		tmp++;
    904   1.1    chopps 
    905   1.1    chopps 	for (i = 1; i < month; i++)
    906   1.1    chopps 		tmp += days_in_month(i);
    907   1.1    chopps 
    908   1.1    chopps 	tmp += (day - 1);
    909   1.1    chopps 	tmp = ((tmp * 24 + hour) * 60 + min) * 60 + sec;
    910   1.1    chopps 
    911   1.1    chopps 	return(tmp);
    912   1.1    chopps }
    913   1.1    chopps 
    914   1.1    chopps /*
    915   1.1    chopps  * there is some question as to whether this works
    916   1.1    chopps  * I guess
    917   1.1    chopps  */
    918   1.1    chopps int
    919   1.1    chopps a2settod(tim)
    920   1.1    chopps 	long tim;
    921   1.1    chopps {
    922   1.1    chopps 
    923   1.1    chopps 	int i;
    924   1.1    chopps 	long hms, day;
    925   1.1    chopps 	u_char sec1, sec2;
    926   1.1    chopps 	u_char min1, min2;
    927   1.1    chopps 	u_char hour1, hour2;
    928   1.1    chopps 	u_char day1, day2;
    929   1.1    chopps 	u_char mon1, mon2;
    930   1.1    chopps 	u_char year1, year2;
    931   1.1    chopps 	struct rtclock2000 *rt;
    932   1.1    chopps 
    933   1.1    chopps 	rt = clockaddr;
    934   1.1    chopps 	/*
    935   1.1    chopps 	 * there seem to be problems with the bitfield addressing
    936   1.1    chopps 	 * currently used..
    937   1.1    chopps 	 *
    938   1.1    chopps 	 * XXX Check out the above where we (hour1 & 3)
    939   1.1    chopps 	 */
    940   1.1    chopps 	if (! rt)
    941   1.1    chopps 		return 0;
    942   1.1    chopps 
    943   1.1    chopps 	/* prepare values to be written to clock */
    944   1.1    chopps 	day = tim / SECDAY;
    945   1.1    chopps 	hms = tim % SECDAY;
    946   1.1    chopps 
    947   1.1    chopps 	hour2 = hms / 3600;
    948   1.1    chopps 	hour1 = hour2 / 10;
    949   1.1    chopps 	hour2 %= 10;
    950   1.1    chopps 
    951   1.1    chopps 	min2 = (hms % 3600) / 60;
    952   1.1    chopps 	min1 = min2 / 10;
    953   1.1    chopps 	min2 %= 10;
    954   1.1    chopps 
    955   1.1    chopps 
    956   1.1    chopps 	sec2 = (hms % 3600) % 60;
    957   1.1    chopps 	sec1 = sec2 / 10;
    958   1.1    chopps 	sec2 %= 10;
    959   1.1    chopps 
    960   1.1    chopps 	/* Number of years in days */
    961   1.1    chopps 	for (i = STARTOFTIME - 1900; day >= days_in_year(i); i++)
    962   1.1    chopps 		day -= days_in_year(i);
    963   1.1    chopps 	year1 = i / 10;
    964   1.1    chopps 	year2 = i % 10;
    965   1.1    chopps 
    966   1.1    chopps 	/* Number of months in days left */
    967   1.1    chopps 	if (leapyear(i))
    968   1.1    chopps 		days_in_month(FEBRUARY) = 29;
    969   1.1    chopps 	for (i = 1; day >= days_in_month(i); i++)
    970   1.1    chopps 		day -= days_in_month(i);
    971   1.1    chopps 	days_in_month(FEBRUARY) = 28;
    972   1.1    chopps 
    973   1.1    chopps 	mon1 = i / 10;
    974   1.1    chopps 	mon2 = i % 10;
    975   1.1    chopps 
    976   1.1    chopps 	/* Days are what is left over (+1) from all that. */
    977   1.1    chopps 	day ++;
    978   1.1    chopps 	day1 = day / 10;
    979   1.1    chopps 	day2 = day % 10;
    980   1.1    chopps 
    981   1.1    chopps 	/*
    982   1.1    chopps 	 * XXXX spin wait as with reading???
    983   1.1    chopps 	 */
    984  1.10    chopps 	rt->control1 |= A2CONTROL1_HOLD;
    985   1.1    chopps 	rt->second1 = sec1;
    986   1.1    chopps 	rt->second2 = sec2;
    987   1.1    chopps 	rt->minute1 = min1;
    988   1.1    chopps 	rt->minute2 = min2;
    989   1.1    chopps 	rt->hour1   = hour1;
    990   1.1    chopps 	rt->hour2   = hour2;
    991   1.1    chopps 	rt->day1    = day1;
    992   1.1    chopps 	rt->day2    = day2;
    993   1.1    chopps 	rt->month1  = mon1;
    994   1.1    chopps 	rt->month2  = mon2;
    995   1.1    chopps 	rt->year1   = year1;
    996   1.1    chopps 	rt->year2   = year2;
    997  1.10    chopps 	rt->control2 &= ~A2CONTROL1_HOLD;
    998   1.1    chopps 
    999  1.22        is 	return 1;
   1000   1.1    chopps }
   1001