Subversion Repositories HelenOS

Rev

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

Rev 2787 Rev 3597
Line 44... Line 44...
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
 
48
 
-
 
49
#define FREQ_NUMERATOR_SHIFT 32
-
 
50
#define FREQ_NUMERATOR_MASK 0xffffffff00000000LL
-
 
51
 
-
 
52
#define FREQ_DENOMINATOR_SHIFT 0
-
 
53
#define FREQ_DENOMINATOR_MASK 0xffffffffLL
-
 
54
 
-
 
55
 
-
 
56
uint64_t it_delta;
-
 
57
 
-
 
58
 
49
static irq_t it_irq;
59
static irq_t it_irq;
50
 
60
 
51
static irq_ownership_t it_claim(void);
61
static irq_ownership_t it_claim(void);
52
static void it_interrupt(irq_t *irq, void *arg, ...);
62
static void it_interrupt(irq_t *irq, void *arg, ...);
53
 
63
 
54
/** Initialize Interval Timer. */
64
/** Initialize Interval Timer. */
55
void it_init(void)
65
void it_init(void)
56
{
66
{
57
    cr_itv_t itv;
67
    cr_itv_t itv;
58
 
68
   
-
 
69
    if(config.cpu_active==1)
-
 
70
    {
59
    irq_initialize(&it_irq);
71
        irq_initialize(&it_irq);
60
    it_irq.inr = INTERRUPT_TIMER;
72
        it_irq.inr = INTERRUPT_TIMER;
61
    it_irq.devno = device_assign_devno();
73
        it_irq.devno = device_assign_devno();
62
    it_irq.claim = it_claim;
74
        it_irq.claim = it_claim;
63
    it_irq.handler = it_interrupt;
75
        it_irq.handler = it_interrupt;
64
    irq_register(&it_irq);
76
        irq_register(&it_irq);
-
 
77
       
-
 
78
        uint64_t base_freq;
-
 
79
        base_freq  = ((bootinfo->freq_scale) & FREQ_NUMERATOR_MASK) >> FREQ_NUMERATOR_SHIFT;
-
 
80
        base_freq *= bootinfo->sys_freq;
-
 
81
        base_freq /= ((bootinfo->freq_scale) & FREQ_DENOMINATOR_MASK) >> FREQ_DENOMINATOR_SHIFT;
-
 
82
       
-
 
83
        it_delta = base_freq /HZ;
-
 
84
       
-
 
85
    }
65
 
86
   
66
    /* initialize Interval Timer external interrupt vector */
87
    /* initialize Interval Timer external interrupt vector */
67
    itv.value = itv_read();
88
    itv.value = itv_read();
68
    itv.vector = INTERRUPT_TIMER;
89
    itv.vector = INTERRUPT_TIMER;
69
    itv.m = 0;
90
    itv.m = 0;
70
    itv_write(itv.value);
91
    itv_write(itv.value);