Forgot this one. This is basically a copy of the i386 version;

needed because the sim provides this, likely to be nuked later.
This commit is contained in:
fvdl 2001-06-19 02:06:15 +00:00
parent 653103e16a
commit 4880ff208d
1 changed files with 109 additions and 0 deletions

View File

@ -0,0 +1,109 @@
/* $NetBSD: microtime.S,v 1.1 2001/06/19 02:06:15 fvdl Exp $ */
/*-
* Copyright (c) 1993 The Regents of the University of California.
* All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
* 3. All advertising materials mentioning features or use of this software
* must display the following acknowledgement:
* This product includes software developed by the University of
* California, Berkeley and its contributors.
* 4. Neither the name of the University nor the names of its contributors
* may be used to endorse or promote products derived from this software
* without specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
* ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
* SUCH DAMAGE.
*/
#include <machine/asm.h>
#include <dev/isa/isareg.h>
#include <i386/isa/timerreg.h>
#define IRQ_BIT(irq_num) (1 << ((irq_num) & 7))
#define IRQ_BYTE(irq_num) ((irq_num) >> 3)
ENTRY(i8254_microtime)
# clear registers and do whatever we can up front
xorl %edx,%edx
movl $(TIMER_SEL0|TIMER_LATCH),%eax
cli # disable interrupts
# select timer 0 and latch its counter
outb %al,$TIMER_MODE
inb $IO_ICU1,%al # as close to timer latch as possible
movb %al,%ch # %ch is current ICU mask
# Read counter value into [%al %dl], LSB first
inb $TIMER_CNTR0,%al
movb %al,%dl # %dl has LSB
inb $TIMER_CNTR0,%al # %al has MSB
# save state of IIR in ICU, and of ipending, for later perusal
leaq _C_LABEL(ipending)(%rip),%rsi
movb IRQ_BYTE(0)(%rsi),%cl # %cl is interrupt pending
# save the current value of _time
movq _C_LABEL(time)(%rip),%r8 # get time.tv_sec
movq (_C_LABEL(time)+8)(%rip),%r9 # and time.tv_usec
sti # enable interrupts, we're done
# At this point we've collected all the state we need to
# compute the time. First figure out if we've got a pending
# interrupt. If the IRQ0 bit is set in ipending we've taken
# a clock interrupt without incrementing time, so we bump
# time.tv_usec by a tick. Otherwise if the ICU shows a pending
# interrupt for IRQ0 we (or the caller) may have blocked an interrupt
# with the cli. If the counter is not a very small value (3 as
# a heuristic), i.e. in pre-interrupt state, we add a tick to
# time.tv_usec
testb $IRQ_BIT(0),%cl # pending interrupt?
jnz 1f # yes, increment count
testb $IRQ_BIT(0),%ch # hardware interrupt pending?
jz 2f # no, continue
testb %al,%al # MSB zero?
jnz 1f # no, add a tick
cmpb $3,%dl # is this small number?
jbe 2f # yes, continue
1: addq _C_LABEL(isa_timer_tick)(%rip),%r9 # add a tick
# We've corrected for pending interrupts. Now do a table lookup
# based on each of the high and low order counter bytes to increment
# time.tv_usec
2: leaq _C_LABEL(isa_timer_msb_table)(%rip),%rsi
movw (%rsi,%rax,2),%ax
subw (%rsi,%rdx,2),%ax
addq %rax,%r9 # add msb increment
# Normalize the struct timeval. We know the previous increments
# will be less than a second, so we'll only need to adjust accordingly
cmpq $1000000,%r9 # carry in timeval?
jb 3f
subq $1000000,%r9 # adjust usec
incq %r8 # bump sec
3: movq %r8,(%rdi) # tvp->tv_sec = sec
movq %r9,8(%rdi) # tvp->tv_usec = usec
ret