Home | History | Annotate | Line # | Download | only in acpi
acpi_timer.c revision 1.9.4.1 
      1  1.9.4.1       mjf /* $NetBSD: acpi_timer.c,v 1.9.4.1 2008/02/18 21:05:36 mjf Exp $ */
      2      1.4   xtraeme 
      3      1.4   xtraeme #include <sys/cdefs.h>
      4  1.9.4.1       mjf __KERNEL_RCSID(0, "$NetBSD: acpi_timer.c,v 1.9.4.1 2008/02/18 21:05:36 mjf Exp $");
      5      1.1  drochner 
      6      1.1  drochner #include <sys/types.h>
      7      1.1  drochner #include <sys/systm.h>
      8      1.1  drochner #include <sys/time.h>
      9      1.1  drochner #include <sys/timetc.h>
     10      1.1  drochner #include <dev/acpi/acpica.h>
     11  1.9.4.1       mjf #include <dev/acpi/acpi_timer.h>
     12      1.1  drochner 
     13      1.2  drochner static int acpitimer_test(void);
     14      1.2  drochner static uint32_t acpitimer_delta(uint32_t, uint32_t);
     15      1.2  drochner static u_int acpitimer_read_safe(struct timecounter *);
     16      1.2  drochner static u_int acpitimer_read_fast(struct timecounter *);
     17      1.1  drochner 
     18      1.1  drochner static struct timecounter acpi_timecounter = {
     19      1.2  drochner 	acpitimer_read_safe,
     20      1.1  drochner 	0,
     21      1.1  drochner 	0x00ffffff,
     22      1.1  drochner 	PM_TIMER_FREQUENCY,
     23      1.2  drochner 	"ACPI-Safe",
     24      1.6  christos 	900,
     25      1.6  christos 	NULL,
     26      1.6  christos 	NULL,
     27      1.1  drochner };
     28      1.1  drochner 
     29      1.1  drochner int
     30      1.1  drochner acpitimer_init()
     31      1.1  drochner {
     32      1.1  drochner 	uint32_t bits;
     33      1.2  drochner 	int i, j;
     34      1.1  drochner 	ACPI_STATUS res;
     35      1.1  drochner 
     36      1.1  drochner 	res = AcpiGetTimerResolution(&bits);
     37      1.1  drochner 	if (res != AE_OK)
     38      1.1  drochner 		return (-1);
     39      1.1  drochner 
     40      1.1  drochner 	if (bits == 32)
     41      1.1  drochner 		acpi_timecounter.tc_counter_mask = 0xffffffff;
     42      1.2  drochner 
     43      1.2  drochner 	j = 0;
     44      1.2  drochner 	for (i = 0; i < 10; i++)
     45      1.2  drochner 		j += acpitimer_test();
     46      1.3   xtraeme 
     47      1.2  drochner 	if (j >= 10) {
     48      1.2  drochner 		acpi_timecounter.tc_name = "ACPI-Fast";
     49      1.2  drochner 		acpi_timecounter.tc_get_timecount = acpitimer_read_fast;
     50      1.2  drochner 		acpi_timecounter.tc_quality = 1000;
     51      1.2  drochner 	}
     52      1.2  drochner 
     53      1.1  drochner 	tc_init(&acpi_timecounter);
     54      1.2  drochner 	aprint_normal("%s %d-bit timer\n", acpi_timecounter.tc_name, bits);
     55      1.1  drochner 
     56      1.2  drochner 	return (0);
     57      1.2  drochner }
     58      1.1  drochner 
     59      1.2  drochner static u_int
     60      1.8  christos acpitimer_read_fast(struct timecounter *tc)
     61      1.2  drochner {
     62      1.2  drochner 	uint32_t t;
     63      1.2  drochner 
     64      1.2  drochner 	AcpiGetTimer(&t);
     65      1.2  drochner 	return (t);
     66      1.1  drochner }
     67      1.1  drochner 
     68      1.1  drochner /*
     69      1.1  drochner  * Some chipsets (PIIX4 variants) do not latch correctly; there
     70      1.1  drochner  * is a chance that a transition is hit.
     71      1.1  drochner  */
     72      1.1  drochner static u_int
     73      1.8  christos acpitimer_read_safe(struct timecounter *tc)
     74      1.1  drochner {
     75      1.1  drochner 	uint32_t t1, t2, t3;
     76      1.1  drochner 
     77      1.1  drochner 	AcpiGetTimer(&t2);
     78      1.1  drochner 	AcpiGetTimer(&t3);
     79      1.1  drochner 	do {
     80      1.1  drochner 		t1 = t2;
     81      1.1  drochner 		t2 = t3;
     82      1.1  drochner 		AcpiGetTimer(&t3);
     83      1.1  drochner 	} while ((t1 > t2) || (t2 > t3));
     84      1.1  drochner 	return (t2);
     85      1.1  drochner }
     86      1.1  drochner 
     87      1.2  drochner static uint32_t
     88      1.2  drochner acpitimer_delta(uint32_t end, uint32_t start)
     89      1.2  drochner {
     90      1.2  drochner 	uint32_t delta;
     91      1.2  drochner 	u_int mask = acpi_timecounter.tc_counter_mask;
     92      1.2  drochner 
     93      1.2  drochner 	if (end >= start)
     94      1.2  drochner 		delta = end - start;
     95      1.2  drochner 	else
     96      1.2  drochner 		delta = ((mask - start) + end + 1) & mask;
     97      1.2  drochner 
     98      1.2  drochner 	return (delta);
     99      1.2  drochner }
    100      1.2  drochner 
    101      1.2  drochner #define N 2000
    102      1.2  drochner static int
    103      1.2  drochner acpitimer_test()
    104      1.2  drochner {
    105      1.2  drochner 	uint32_t last, this, delta;
    106      1.2  drochner 	int minl, maxl, n;
    107      1.2  drochner 
    108      1.2  drochner 	minl = 10000000;
    109      1.2  drochner 	maxl = 0;
    110      1.2  drochner 
    111      1.9        ad 	x86_disable_intr();
    112      1.2  drochner 	AcpiGetTimer(&last);
    113      1.2  drochner 	for (n = 0; n < N; n++) {
    114      1.2  drochner 		AcpiGetTimer(&this);
    115      1.2  drochner 		delta = acpitimer_delta(this, last);
    116      1.2  drochner 		if (delta > maxl)
    117      1.2  drochner 			maxl = delta;
    118      1.2  drochner 		else if (delta < minl)
    119      1.2  drochner 			minl = delta;
    120      1.2  drochner 		last = this;
    121      1.2  drochner 	}
    122      1.9        ad 	x86_enable_intr();
    123      1.2  drochner 
    124      1.2  drochner 	if (maxl - minl > 2 )
    125      1.2  drochner 		n = 0;
    126      1.2  drochner 	else if (minl < 0 || maxl == 0)
    127      1.2  drochner 		n = 0;
    128      1.2  drochner 	else
    129      1.2  drochner 		n = 1;
    130      1.2  drochner 
    131      1.2  drochner 	return (n);
    132      1.2  drochner }
    133