On the 601, construct the CPU counter value from the RTC[UL] registers.
This commit is contained in:
parent
12810ed37d
commit
032762e1e9
@ -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.
|
* Copyright (c) 2000 Tsubai Masanari. All rights reserved.
|
||||||
@ -35,14 +35,34 @@
|
|||||||
|
|
||||||
#ifdef _KERNEL
|
#ifdef _KERNEL
|
||||||
|
|
||||||
|
#include <powerpc/spr.h>
|
||||||
|
|
||||||
#define cpu_hascounter() 1
|
#define cpu_hascounter() 1
|
||||||
|
|
||||||
static __inline u_int32_t
|
static __inline u_int32_t
|
||||||
cpu_counter(void)
|
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;
|
return rv;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
Loading…
Reference in New Issue
Block a user