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