Subversion Repositories HelenOS

Rev

Rev 1787 | Rev 2018 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 1787 Rev 1956
Line 47... Line 47...
47 
#include <arch/pm.h>
 47 
#include <arch/pm.h>
48 
#include <arch/asm.h>
 48 
#include <arch/asm.h>
49 
#include <arch/cpuid.h>
 49 
#include <arch/cpuid.h>
50 
#include <arch.h>
 50 
#include <arch.h>
51 
#include <time/delay.h>
 51 
#include <time/delay.h>
52 
#include <interrupt.h>
 52 
#include <ddi/irq.h>
- 
 
 53 
#include <ddi/device.h>
53 
 
 54 
 
54 
#define CLK_PORT1   0x40
 55 
#define CLK_PORT1   0x40
55 
#define CLK_PORT4   0x43
 56 
#define CLK_PORT4   0x43
56 
 
 57 
 
57 
#define CLK_CONST   1193180
 58 
#define CLK_CONST   1193180
58 
#define MAGIC_NUMBER    1194
 59 
#define MAGIC_NUMBER    1194
59 
 
 60 
 
- 
 
 61 
static irq_t i8254_irq;
- 
 
 62 
 
- 
 
 63 
static irq_ownership_t i8254_claim(void)
- 
 
 64 
{
- 
 
 65 
    return IRQ_ACCEPT;
- 
 
 66 
}
- 
 
 67 
 
60 
static void i8254_interrupt(int n, istate_t *istate);
 68 
static void i8254_irq_handler(irq_t *irq, void *arg, ...)
- 
 
 69 
{
- 
 
 70 
    clock();
- 
 
 71 
}
61 
 
 72 
 
62 
void i8254_init(void)
 73 
void i8254_init(void)
63 
{
 74 
{
- 
 
 75 
    irq_initialize(&i8254_irq);
- 
 
 76 
    i8254_irq.devno = device_assign_devno();
- 
 
 77 
    i8254_irq.inr = IRQ_CLK;
- 
 
 78 
    i8254_irq.claim = i8254_claim;
- 
 
 79 
    i8254_irq.handler = i8254_irq_handler;
- 
 
 80 
    irq_register(&i8254_irq);
- 
 
 81 
   
64 
    i8254_normal_operation();
 82 
    i8254_normal_operation();
65 
}
 83 
}
66 
 
 84 
 
67 
void i8254_normal_operation(void)
 85 
void i8254_normal_operation(void)
68 
{
 86 
{
69 
    outb(CLK_PORT4, 0x36);
 87 
    outb(CLK_PORT4, 0x36);
70 
    pic_disable_irqs(1<<IRQ_CLK);
 88 
    pic_disable_irqs(1 << IRQ_CLK);
71 
    outb(CLK_PORT1, (CLK_CONST/HZ) & 0xf);
 89 
    outb(CLK_PORT1, (CLK_CONST / HZ) & 0xf);
72 
    outb(CLK_PORT1, (CLK_CONST/HZ) >> 8);
 90 
    outb(CLK_PORT1, (CLK_CONST / HZ) >> 8);
73 
    pic_enable_irqs(1<<IRQ_CLK);
 91 
    pic_enable_irqs(1 << IRQ_CLK);
74 
    exc_register(VECTOR_CLK, "i8254_clock", (iroutine) i8254_interrupt);
 - 
 
75 
}
 92 
}
76 
 
 93 
 
77 
#define LOOPS 150000
 94 
#define LOOPS 150000
78 
#define SHIFT 11
 95 
#define SHIFT 11
79 
void i8254_calibrate_delay_loop(void)
 96 
void i8254_calibrate_delay_loop(void)
Line 127... Line 144...
127 
    CPU->frequency_mhz = (clk2-clk1)>>SHIFT;
 144 
    CPU->frequency_mhz = (clk2-clk1)>>SHIFT;
128 
 
 145 
 
129 
    return;
 146 
    return;
130 
}
 147 
}
131 
 
 148 
 
132 
void i8254_interrupt(int n, istate_t *istate)
 - 
 
133 
{
 - 
 
134 
    trap_virtual_eoi();
 - 
 
135 
    clock();
 - 
 
136 
}
 - 
 
137 
 
 - 
 
138 
/** @}
 149 
/** @}
139 
 */
 150 
 */