Home | History | Annotate | Line # | Download | only in ic
acpipmtimer.c revision 1.1.16.5
      1  1.1.16.5  yamt /* $NetBSD: acpipmtimer.c,v 1.1.16.5 2008/01/21 09:42:52 yamt Exp $ */
      2  1.1.16.3  yamt 
      3  1.1.16.3  yamt #include <sys/cdefs.h>
      4  1.1.16.5  yamt __KERNEL_RCSID(0, "$NetBSD: acpipmtimer.c,v 1.1.16.5 2008/01/21 09:42:52 yamt Exp $");
      5  1.1.16.2  yamt 
      6  1.1.16.2  yamt #include <sys/types.h>
      7  1.1.16.2  yamt 
      8  1.1.16.2  yamt #include <sys/systm.h>
      9  1.1.16.2  yamt #include <sys/device.h>
     10  1.1.16.2  yamt #include <sys/malloc.h>
     11  1.1.16.4  yamt #include <sys/bus.h>
     12  1.1.16.2  yamt #include <sys/time.h>
     13  1.1.16.2  yamt #include <sys/timetc.h>
     14  1.1.16.2  yamt 
     15  1.1.16.2  yamt #include <dev/ic/acpipmtimer.h>
     16  1.1.16.2  yamt 
     17  1.1.16.2  yamt #define ACPI_PM_TIMER_FREQUENCY 3579545
     18  1.1.16.2  yamt 
     19  1.1.16.2  yamt struct hwtc {
     20  1.1.16.2  yamt 	struct timecounter tc;
     21  1.1.16.2  yamt 	bus_space_tag_t t;
     22  1.1.16.2  yamt 	bus_space_handle_t h;
     23  1.1.16.2  yamt 	bus_size_t off;
     24  1.1.16.2  yamt };
     25  1.1.16.2  yamt 
     26  1.1.16.2  yamt static u_int acpihwtimer_read_safe(struct timecounter *);
     27  1.1.16.2  yamt static u_int acpihwtimer_read_fast(struct timecounter *);
     28  1.1.16.2  yamt 
     29  1.1.16.2  yamt int
     30  1.1.16.2  yamt acpipmtimer_attach(struct device *dev,
     31  1.1.16.2  yamt 		   bus_space_tag_t t, bus_space_handle_t h, bus_size_t off,
     32  1.1.16.2  yamt 		   int flags)
     33  1.1.16.2  yamt {
     34  1.1.16.2  yamt 	struct hwtc *tc;
     35  1.1.16.2  yamt 
     36  1.1.16.2  yamt 	tc = malloc(sizeof(struct hwtc), M_DEVBUF, M_WAITOK|M_ZERO);
     37  1.1.16.2  yamt 	if (!tc)
     38  1.1.16.2  yamt 		return (-1);
     39  1.1.16.2  yamt 
     40  1.1.16.2  yamt 	tc->tc.tc_name = dev->dv_xname;
     41  1.1.16.2  yamt 	tc->tc.tc_frequency = ACPI_PM_TIMER_FREQUENCY;
     42  1.1.16.2  yamt 	if (flags & ACPIPMT_32BIT)
     43  1.1.16.2  yamt 		tc->tc.tc_counter_mask = 0xffffffff;
     44  1.1.16.2  yamt 	else
     45  1.1.16.2  yamt 		tc->tc.tc_counter_mask = 0x00ffffff;
     46  1.1.16.2  yamt 	if (flags & ACPIPMT_BADLATCH) {
     47  1.1.16.2  yamt 		tc->tc.tc_get_timecount = acpihwtimer_read_safe;
     48  1.1.16.2  yamt 		tc->tc.tc_quality = 900;
     49  1.1.16.2  yamt 	} else {
     50  1.1.16.2  yamt 		tc->tc.tc_get_timecount = acpihwtimer_read_fast;
     51  1.1.16.2  yamt 		tc->tc.tc_quality = 1000;
     52  1.1.16.2  yamt 	}
     53  1.1.16.2  yamt 
     54  1.1.16.2  yamt 	tc->t = t;
     55  1.1.16.2  yamt 	tc->h = h;
     56  1.1.16.2  yamt 	tc->off = off;
     57  1.1.16.2  yamt 
     58  1.1.16.2  yamt 	tc->tc.tc_priv = tc;
     59  1.1.16.2  yamt 	tc_init(&tc->tc);
     60  1.1.16.3  yamt 	aprint_normal("%s: %d-bit timer\n", tc->tc.tc_name,
     61  1.1.16.2  yamt 		      (flags & ACPIPMT_32BIT ? 32 : 24));
     62  1.1.16.2  yamt 	return (0);
     63  1.1.16.2  yamt }
     64  1.1.16.2  yamt 
     65  1.1.16.2  yamt #define r(h) bus_space_read_4(h->t, h->h, h->off)
     66  1.1.16.2  yamt 
     67  1.1.16.2  yamt static u_int
     68  1.1.16.2  yamt acpihwtimer_read_safe(struct timecounter *tc)
     69  1.1.16.2  yamt {
     70  1.1.16.2  yamt 	struct hwtc *h = tc->tc_priv;
     71  1.1.16.2  yamt 	uint32_t t1, t2, t3;
     72  1.1.16.2  yamt 
     73  1.1.16.2  yamt 	t2 = r(h);
     74  1.1.16.2  yamt 	t3 = r(h);
     75  1.1.16.2  yamt 	do {
     76  1.1.16.2  yamt 		t1 = t2;
     77  1.1.16.2  yamt 		t2 = t3;
     78  1.1.16.2  yamt 		t3 = r(h);
     79  1.1.16.2  yamt 	} while ((t1 > t2) || (t2 > t3));
     80  1.1.16.2  yamt 	return (t2);
     81  1.1.16.2  yamt }
     82  1.1.16.2  yamt 
     83  1.1.16.2  yamt static u_int
     84  1.1.16.2  yamt acpihwtimer_read_fast(struct timecounter *tc)
     85  1.1.16.2  yamt {
     86  1.1.16.2  yamt 	struct hwtc *h = tc->tc_priv;
     87  1.1.16.2  yamt 
     88  1.1.16.2  yamt 	return r(h);
     89  1.1.16.2  yamt }
     90