kolibrios/drivers/video/drm/i915/hpet.c

#include <syscall.h>
#include <linux/ktime.h>

typedef unsigned int addr_t;

#define ACPI_NAME_SIZE                  4
#define ACPI_OEM_ID_SIZE                6
#define ACPI_OEM_TABLE_ID_SIZE          8

#define ACPI_RSDP_CHECKSUM_LENGTH       20
#define ACPI_RSDP_XCHECKSUM_LENGTH      36

typedef struct __attribute__((packed))
{
    u32           sig;
    u32           len;
    u8            rev;
    u8            csum;
    char          oem_id[ACPI_OEM_ID_SIZE];
    char          oem_tid[ACPI_OEM_TABLE_ID_SIZE];
    u32           oem_rev;
    u32           creator_id;
    u32           creator_rev;
}acpi_thead_t;

typedef struct __attribute__((packed))
{
    u8 space_id;            /* Address space where struct or register exists */
    u8 bit_width;           /* Size in bits of given register */
    u8 bit_offset;          /* Bit offset within the register */
    u8 access_width;        /* Minimum Access size (ACPI 3.0) */
    u64 address;            /* 64-bit address of struct or register */
}acpi_address_t;


typedef struct __attribute__((packed))
{
        acpi_thead_t header;        /* Common ACPI table header */
        u32 id;                     /* Hardware ID of event timer block */
        acpi_address_t address;     /* Address of event timer block */
        u8 sequence;                /* HPET sequence number */
        u16 minimum_tick;           /* Main counter min tick, periodic mode */
        u8 flags;
}acpi_hpet_t;

typedef struct  __attribute__((packed))
{
    acpi_thead_t  header;
    u32           ptrs[0];
}acpi_rsdt_t;

typedef struct  __attribute__((packed))
{
    acpi_thead_t  header;
    u64           ptrs[0];
}acpi_xsdt_t;

typedef struct __attribute__((packed))
{
    u64           sig;
    u8            csum;
    char          oemid[6];
    u8            rev;
    u32           rsdt_ptr;
    u32           rsdt_len;
    u64           xsdt_ptr;
    u8            xcsum;
    u8            _rsvd_33[3];
}acpi_rsdp_t;

#define OS_BASE                 0x80000000
#define ACPI20_PC99_RSDP_START  (OS_BASE + 0x0e0000)
#define ACPI20_PC99_RSDP_END    (OS_BASE + 0x100000)
#define ACPI20_PC99_RSDP_SIZE   (ACPI20_PC99_RSDP_END - ACPI20_PC99_RSDP_START)

static acpi_thead_t* (*sdt_find)(void *sdt, u32 sig);

static u8 acpi_tb_checksum (u8 *buffer, u32 len)
{
    u8    sum = 0;
    u8    *end = buffer + len;

    while (buffer < end)
    {
        sum = (u8)(sum + *(buffer++));
    }

    return sum;
}

static acpi_rsdp_t* acpi_locate()
{
    addr_t p;

    for (p = ACPI20_PC99_RSDP_START; p < ACPI20_PC99_RSDP_END; p+=16)
    {
        acpi_rsdp_t* r = (acpi_rsdp_t*) p;
        if (r->sig != 0x2052545020445352 )
            continue;

        if (acpi_tb_checksum ((u8*)r, ACPI_RSDP_CHECKSUM_LENGTH) != 0)
            continue;

        if ((r->rev >= 2) &&
        (acpi_tb_checksum ((u8*)r, ACPI_RSDP_XCHECKSUM_LENGTH) != 0))
            continue;

        return r;
    };

    return NULL;
};

acpi_thead_t* rsdt_find(acpi_rsdt_t *rsdt, u32 sig)
{
    acpi_thead_t *head = NULL;
    u32 i;

    for (i = 0; i < ((rsdt->header.len-sizeof(acpi_thead_t))/
                sizeof(rsdt->ptrs[0])); i++)
    {
        u32 ptr = rsdt->ptrs[i];

        acpi_thead_t* t = (acpi_thead_t*)MapIoMem(ptr, 8192, PG_SW);

        if (t->sig == sig)
        {
           head = t;
           break;
        };
        FreeKernelSpace(t);
    }
    return head;
};

acpi_thead_t* xsdt_find(acpi_xsdt_t *xsdt, u32 sig)
{
    acpi_thead_t *head = NULL;
    u32 i;

    for (i = 0; i < ((xsdt->header.len-sizeof(acpi_thead_t))/
                sizeof(xsdt->ptrs[0])); i++)
    {
        u32 ptr = xsdt->ptrs[i];

        acpi_thead_t* t = (acpi_thead_t*)MapIoMem(ptr, 8192, PG_SW);

        if (t->sig == sig)
        {
           head = t;
           break;
        };
        FreeKernelSpace(t);
    }
    return head;
};

static void dump_rsdt(acpi_rsdt_t *rsdt)
{
    int i;

    for (i = 0; i < ((rsdt->header.len-sizeof(acpi_thead_t))/
                sizeof(rsdt->ptrs[0])); i++)
    {
        u32 ptr = rsdt->ptrs[i];
        dbgprintf("%s ptr= %p\n", __FUNCTION__, ptr);

        acpi_thead_t* t = (acpi_thead_t*)MapIoMem(ptr, 8192, PG_SW);
        dbgprintf("%s t= %x\n", __FUNCTION__, t);

        char *p = (char*)&t->sig;
        printf("sig %d: %x %c%c%c%c  base %p\n", i, t->sig,
        p[0],p[1],p[2],p[3],rsdt->ptrs[i]);
        FreeKernelSpace(t);
    };
};

typedef struct
{
    u64 hpet_cap;                       /* capabilities */
    u64 res0;                           /* reserved */
    u64 hpet_config;                    /* configuration */
    u64 res1;                           /* reserved */
    u64 hpet_isr;                       /* interrupt status reg */
    u64 res2[25];                       /* reserved */
    union {                             /* main counter */
            volatile u64 _hpet_mc64;
            u32 _hpet_mc32;
            unsigned long _hpet_mc;
    } _u0;
    u64 res3;                           /* reserved */
    struct hpet_timer {
            u64 hpet_config;            /* configuration/cap */
            union {                     /* timer compare register */
                    u64 _hpet_hc64;
                    u32 _hpet_hc32;
                    unsigned long _hpet_compare;
            } _u1;
            u64 hpet_fsb[2];            /* FSB route */
    } hpet_timers[1];
}hpet_t;

#define HPET_ID                 0x000
#define HPET_PERIOD             0x004
#define HPET_CFG                0x010
#define HPET_STATUS             0x020
#define HPET_COUNTER            0x0f0

#define HPET_ID_NUMBER          0x00001f00
#define HPET_ID_NUMBER_SHIFT    8

#define HPET_CFG_ENABLE         0x001

static void *hpet_virt_address;

inline unsigned int hpet_readl(unsigned int a)
{
    return readl(hpet_virt_address + a);
}

static inline void hpet_writel(unsigned int d, unsigned int a)
{
    writel(d, hpet_virt_address + a);
}

static void hpet_start_counter(void)
{
    unsigned int cfg = hpet_readl(HPET_CFG);
    cfg |= HPET_CFG_ENABLE;
    hpet_writel(cfg, HPET_CFG);
}


u64 read_htime()
{
    u32 eflags;
    u64 val;

    eflags = safe_cli();
    asm volatile(
    "1:\n"
    "mov 0xf4(%%ebx), %%edx\n"
    "mov 0xf0(%%ebx), %%eax\n"
    "mov 0xf4(%%ebx), %%ecx\n"
    "cmpl %%edx, %%ecx\n"
    "jnz 1b\n"
    :"=A"(val)
    :"b" (hpet_virt_address)
    :"ecx");
    safe_sti(eflags);
    return val;
}

static u32 period;

void init_hpet()
{
    void        *sdt  = NULL;

    acpi_rsdp_t *rsdp = acpi_locate();

    if (unlikely(rsdp == NULL))
    {
        printf("No ACPI RSD table\n");
        return ;
    };

    printf("rsd base address %p\n", rsdp);

    if(rsdp->rev > 1)
    {
        sdt = (void*)(u32)rsdp->xsdt_ptr;
        sdt_find = xsdt_find;
    }
    else
    {
        sdt = (void*)rsdp->rsdt_ptr;
        sdt_find = rsdt_find;
    };

    printf("sdt address %p\n", sdt);

    if (sdt == NULL)
    {
        printf("Invalid ACPI RSD table\n");
        return ;
    };

    sdt = MapIoMem(sdt, 128*1024, PG_SW);

    printf("sdt mapped address %x\n", sdt);

    acpi_hpet_t *tbl = (acpi_hpet_t*)sdt_find(sdt, 0x54455048);

    u32 hpet_address = tbl->address.address;

    hpet_virt_address = (void*)MapIoMem(hpet_address,1024, PG_SW|0x18);

    printf("hpet address %x mapped at %x\n", hpet_address, hpet_virt_address);

    u32 timers, l, h;

    l = hpet_readl(HPET_ID);
    h = hpet_readl(HPET_PERIOD);
    period = h / 1000000;

    timers = ((l & HPET_ID_NUMBER) >> HPET_ID_NUMBER_SHIFT) + 1;
    printk(KERN_INFO "hpet: ID: 0x%x, PERIOD: 0x%x\n", l, h);
    l = hpet_readl(HPET_CFG);
    h = hpet_readl(HPET_STATUS);
    printk(KERN_INFO "hpet: CFG: 0x%x, STATUS: 0x%x\n", l, h);
    l = hpet_readl(HPET_COUNTER);
    h = hpet_readl(HPET_COUNTER+4);
    printk(KERN_INFO "hpet: COUNTER_l: 0x%x, COUNTER_h: 0x%x\n", l, h);

    hpet_start_counter();

}