Subversion Repositories HelenOS

Rev

Rev 3343 | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 3343 Rev 3593
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);