On the 601, construct the CPU counter value from the RTC[UL] registers.

This commit is contained in:
kleink 2002-03-26 21:50:39 +00:00
parent 12810ed37d
commit 032762e1e9

View File

@ -1,4 +1,4 @@
/* $NetBSD: rnd.h,v 1.1 2000/06/11 16:32:45 tsubai Exp $ */
/* $NetBSD: rnd.h,v 1.2 2002/03/26 21:50:39 kleink Exp $ */
/*-
* Copyright (c) 2000 Tsubai Masanari. All rights reserved.
@ -35,14 +35,34 @@
#ifdef _KERNEL
#include <powerpc/spr.h>
#define cpu_hascounter() 1
static __inline u_int32_t
cpu_counter(void)
{
u_int32_t rv;
u_int32_t rv, rtcu, scratch;
__asm __volatile (
"mfpvr %0 \n"
"srwi %0,%0,16 \n"
"cmpwi %0,%3 \n"
"bne 1f \n" /* branch if 601 */
"lis %0,0x77 \n"
"ori %0,%0,0x3594 \n" /* 7.8125e6 */
"mfspr %2,%4 \n"
"mullw %2,%2,%0 \n"
"mfspr %0,%5 \n"
"srwi %0,%0,7 \n"
"add %1,%2,%0 \n"
"b 2f \n"
"1: \n"
"mftb %1 \n"
"2: \n"
: "=r"(scratch), "=r"(rv), "=r"(rtcu)
: "n"(MPC601), "n"(SPR_RTCU_R), "n"(SPR_RTCL_R));
__asm __volatile ("mftb %0" : "=r"(rv));
return rv;
}