Subversion Repositories HelenOS

Rev

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

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