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