Subversion Repositories HelenOS

Rev

Rev 1888 | Rev 1955 | Go to most recent revision | Show entire file | Regard whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 1888 Rev 1936
Line 37... Line 37...
37 
#include <arch/types.h>
 37 
#include <arch/types.h>
38 
#include <arch.h>
 38 
#include <arch.h>
39 
#include <arch/cp0.h>
 39 
#include <arch/cp0.h>
40 
#include <time/clock.h>
 40 
#include <time/clock.h>
41 
#include <arch/drivers/arc.h>
 41 
#include <arch/drivers/arc.h>
42 
 
 - 
 
43 
#include <ipc/sysipc.h>
 42 
#include <ipc/sysipc.h>
- 
 
 43 
#include <ddi/device.h>
- 
 
 44 
#include <ddi/irq.h>
- 
 
 45 
 
- 
 
 46 
#define IRQ_COUNT 8
- 
 
 47 
#define TIMER_IRQ 7
- 
 
 48 
 
- 
 
 49 
function timer_fnc = NULL;
- 
 
 50 
static irq_t timer_irq;
44 
 
 51 
 
45 
/** Disable interrupts.
 52 
/** Disable interrupts.
46 
 *
 53 
 *
47 
 * @return Old interrupt priority level.
 54 
 * @return Old interrupt priority level.
48 
 */
 55 
 */
Line 89... Line 96...
89 
{
 96 
{
90 
    nextcount = cp0_compare_value + cp0_count_read();
 97 
    nextcount = cp0_compare_value + cp0_count_read();
91 
    cp0_compare_write(nextcount);
 98 
    cp0_compare_write(nextcount);
92 
}
 99 
}
93 
 
 100 
 
- 
 
 101 
static irq_ownership_t timer_claim(void)
- 
 
 102 
{
- 
 
 103 
    return IRQ_ACCEPT;
- 
 
 104 
}
- 
 
 105 
 
94 
static void timer_exception(int n, istate_t *istate)
 106 
static void timer_irq_handler(irq_t *irq, void *arg, ...)
95 
{
 107 
{
96 
    unsigned long drift;
 108 
    unsigned long drift;
97 
 
 109 
 
98 
    drift = cp0_count_read() - nextcount;
 110 
    drift = cp0_count_read() - nextcount;
99 
    while (drift > cp0_compare_value) {
 111 
    while (drift > cp0_compare_value) {
Line 101... Line 113...
101 
        CPU->missed_clock_ticks++;
 113 
        CPU->missed_clock_ticks++;
102 
    }
 114 
    }
103 
    nextcount = cp0_count_read() + cp0_compare_value - drift;
 115 
    nextcount = cp0_count_read() + cp0_compare_value - drift;
104 
    cp0_compare_write(nextcount);
 116 
    cp0_compare_write(nextcount);
105 
    clock();
 117 
    clock();
106 
}
 - 
 
107 
 
 118 
   
108 
static void swint0(int n, istate_t *istate)
 - 
 
109 
{
 - 
 
110 
    cp0_cause_write(cp0_cause_read() & ~(1 << 8)); /* clear SW0 interrupt */
 - 
 
111 
    ipc_irq_send_notif(0);
 119 
    if (timer_fnc != NULL)
112 
}
 - 
 
113 
 
 - 
 
114 
static void swint1(int n, istate_t *istate)
 - 
 
115 
{
 - 
 
116 
    cp0_cause_write(cp0_cause_read() & ~(1 << 9)); /* clear SW1 interrupt */
 - 
 
117 
    ipc_irq_send_notif(1);
 120 
        timer_fnc();
118 
}
 121 
}
119 
 
 122 
 
120 
/* Initialize basic tables for exception dispatching */
 123 
/* Initialize basic tables for exception dispatching */
121 
void interrupt_init(void)
 124 
void interrupt_init(void)
122 
{
 125 
{
123 
    int_register(TIMER_IRQ, "timer", timer_exception);
 - 
 
124 
    int_register(0, "swint0", swint0);
 - 
 
125 
    int_register(1, "swint1", swint1);
 126 
    irq_init(IRQ_COUNT, IRQ_COUNT);
126 
    timer_start();
 - 
 
127 
}
 - 
 
128 
 
 127 
   
- 
 
 128 
    irq_initialize(&timer_irq);
129 
static void ipc_int(int n, istate_t *istate)
 129 
    timer_irq.devno = device_assign_devno();
130 
{
 - 
 
- 
 
 130 
    timer_irq.inr = TIMER_IRQ;
- 
 
 131 
    timer_irq.claim = timer_claim;
131 
    ipc_irq_send_notif(n-INT_OFFSET);
 132 
    timer_irq.handler = timer_irq_handler;
132 
}
 - 
 
- 
 
 133 
    irq_register(&timer_irq);
133 
 
 134 
   
134 
/* Reregister irq to be IPC-ready */
 - 
 
135 
void irq_ipc_bind_arch(unative_t irq)
 - 
 
136 
{
 - 
 
137 
    /* Do not allow to redefine timer */
 - 
 
138 
    /* Swint0, Swint1 are already handled */
 - 
 
139 
    if (irq == TIMER_IRQ || irq < 2)
 - 
 
140 
        return;
 135 
    timer_start();
141 
    int_register(irq, "ipc_int", ipc_int);
 136 
    cp0_unmask_int(TIMER_IRQ);
142 
}
 137 
}
143 
 
 138 
 
144 
/** @}
 139 
/** @}
145 
 */
 140 
 */