Added set_error() API to have a single point of entry for setting for errno and errstr.
[akaros.git] / kern / drivers / timers / hpet.c
1 #include <string.h>
2 #include <stdio.h>
3 #include <assert.h>
4 #include <endian.h>
5 #include <pmap.h>
6 #include <acpi.h>
7
8 #include "hpet.h"
9
10 /* The HPET likes 64bit mmreg reads and writes.  If the arch doesn't support
11  * them, then things are a little trickier.  Probably just replace these with
12  * mm64 ops, and quit supporting 32 bit. */
13 static inline void hpet_w64(uintptr_t reg, uint64_t val)
14 {
15         *((volatile uint64_t*)reg) = val;
16 }
17
18 static inline uint64_t hpet_r64(uintptr_t reg)
19 {
20         return *((volatile uint64_t*)reg);
21 }
22
23 struct Atable *acpihpet(uint8_t * p, int len)
24 {
25         /* Do we want to keep this table around?  if so, we can use newtable, which
26          * allocs an Atable and puts it on a global stailq.  then we return that
27          * pointer, not as an addr, but as a signal to parse code about whether or
28          * not it is safe to unmap (which we don't do anymore). */
29         struct Atable *hpet = new_acpi_table(p);
30         unsigned long hp_addr;
31         uint32_t evt_blk_id;
32         int nr_timers;
33
34         assert(hpet);
35         printk("HPET table detected at %p, for %d bytes\n", p, len);
36
37         evt_blk_id = l32get(p + 36);
38         printd("EV BID 0x%08x\n", evt_blk_id);
39
40         hp_addr = (unsigned long)KADDR_NOCHECK(l64get(p + 44));
41
42         printd("cap/ip %p\n", hpet_r64(hp_addr + 0x00));
43         printd("config %p\n", hpet_r64(hp_addr + 0x10));
44         printd("irqsts %p\n", hpet_r64(hp_addr + 0x20));
45
46         nr_timers = ((hpet_r64(hp_addr) >> 8) & 0xf) + 1;
47         for (int i = 0; i < nr_timers; i++)
48                 printd("Timer %d, config reg %p\n", i,
49                        hpet_r64(hp_addr + 0x100 + 0x20 * i));
50         /* 0x10, general config register.  bottom two bits are legacy mode and
51          * global enable.  turning them both off.  need to do read-modify-writes to
52          * HPET registers with reserved fields.*/
53         hpet_w64(hp_addr + 0x10, hpet_r64(hp_addr + 0x10) & ~0x3);
54         printk("Disabled the HPET timer\n");
55         return hpet;
56 }
57
58 void cmos_dumping_ground()
59 {
60         uint8_t cmos_b;
61
62         /* this stuff tries to turn off various cmos / RTC timer bits.  keeping
63          * around if we need to disable the RTC alarm.  note that the HPET replaces
64          * the RTC periodic function (where available), and in those cases the RTC
65          * alarm function is implemented with SMM. */
66         outb(0x70, 0xb);
67         cmos_b = inb(0x71);
68         printk("cmos b 0x%02x\n", cmos_b);
69
70         cmos_b &= ~((1 << 5) | (1 << 6));
71         outb(0x70, 0xb);
72         outb(0x71, cmos_b);
73
74         outb(0x70, 0xb);
75         cmos_b = inb(0x71);
76         printk("cmos b 0x%02x\n", cmos_b);
77 }