Subversion Repositories HelenOS

Rev

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

Rev 3022 Rev 4055
Line 42... Line 42...
42 
#include <time/clock.h>
 42 
#include <time/clock.h>
43 
#include <ddi/irq.h>
 43 
#include <ddi/irq.h>
44 
#include <ddi/device.h>
 44 
#include <ddi/device.h>
45 
#include <arch.h>
 45 
#include <arch.h>
46 
 
 46 
 
47 
#define IT_SERVICE_CLOCKS 64
 47 
#define IT_SERVICE_CLOCKS   64
- 
 
 48 
 
- 
 
 49 
#define FREQ_NUMERATOR_SHIFT    32
- 
 
 50 
#define FREQ_NUMERATOR_MASK 0xffffffff00000000ULL
- 
 
 51 
 
- 
 
 52 
#define FREQ_DENOMINATOR_SHIFT  0
- 
 
 53 
#define FREQ_DENOMINATOR_MASK   0xffffffffULL
- 
 
 54 
 
- 
 
 55 
uint64_t it_delta;
48 
 
 56 
 
49 
static irq_t it_irq;
 57 
static irq_t it_irq;
50 
 
 58 
 
51 
static irq_ownership_t it_claim(void);
 59 
static irq_ownership_t it_claim(irq_t *);
52 
static void it_interrupt(irq_t *irq, void *arg, ...);
 60 
static void it_interrupt(irq_t *);
53 
 
 61 
 
54 
/** Initialize Interval Timer. */
 62 
/** Initialize Interval Timer. */
55 
void it_init(void)
 63 
void it_init(void)
56 
{
 64 
{
57 
    cr_itv_t itv;
 65 
    cr_itv_t itv;
58 
 
 66 
   
- 
 
 67 
    if (config.cpu_active == 1) {
59 
    irq_initialize(&it_irq);
 68 
        irq_initialize(&it_irq);
60 
    it_irq.inr = INTERRUPT_TIMER;
 69 
        it_irq.inr = INTERRUPT_TIMER;
61 
    it_irq.devno = device_assign_devno();
 70 
        it_irq.devno = device_assign_devno();
62 
    it_irq.claim = it_claim;
 71 
        it_irq.claim = it_claim;
63 
    it_irq.handler = it_interrupt;
 72 
        it_irq.handler = it_interrupt;
64 
    irq_register(&it_irq);
 73 
        irq_register(&it_irq);
- 
 
 74 
       
- 
 
 75 
        uint64_t base_freq;
- 
 
 76 
        base_freq  = ((bootinfo->freq_scale) & FREQ_NUMERATOR_MASK) >>
- 
 
 77 
            FREQ_NUMERATOR_SHIFT;
- 
 
 78 
        base_freq *= bootinfo->sys_freq;
- 
 
 79 
        base_freq /= ((bootinfo->freq_scale) & FREQ_DENOMINATOR_MASK) >>
- 
 
 80 
            FREQ_DENOMINATOR_SHIFT;
- 
 
 81 
       
- 
 
 82 
        it_delta = base_freq / HZ;
- 
 
 83 
    }
65 
 
 84 
   
66 
    /* initialize Interval Timer external interrupt vector */
 85 
    /* initialize Interval Timer external interrupt vector */
67 
    itv.value = itv_read();
 86 
    itv.value = itv_read();
68 
    itv.vector = INTERRUPT_TIMER;
 87 
    itv.vector = INTERRUPT_TIMER;
69 
    itv.m = 0;
 88 
    itv.m = 0;
70 
    itv_write(itv.value);
 89 
    itv_write(itv.value);
Line 83... Line 102...
83 
 *
 102 
 *
84 
 * Other devices are responsible to avoid using INR 0.
 103 
 * Other devices are responsible to avoid using INR 0.
85 
 *
 104 
 *
86 
 * @return Always IRQ_ACCEPT.
 105 
 * @return Always IRQ_ACCEPT.
87 
 */
 106 
 */
88 
irq_ownership_t it_claim(void)
 107 
irq_ownership_t it_claim(irq_t *irq)
89 
{
 108 
{
90 
    return IRQ_ACCEPT;
 109 
    return IRQ_ACCEPT;
91 
}
 110 
}
92 
 
 111 
 
93 
/** Process Interval Timer interrupt. */
 112 
/** Process Interval Timer interrupt. */
94 
void it_interrupt(irq_t *irq, void *arg, ...)
 113 
void it_interrupt(irq_t *irq)
95 
{
 114 
{
96 
    int64_t c;
 115 
    int64_t c;
97 
    int64_t m;
 116 
    int64_t m;
98 
   
 117 
   
99 
    eoi_write(EOI);
 118 
    eoi_write(EOI);