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);