Subversion Repositories HelenOS

Rev

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

Rev 3386 Rev 4153
Line 33... Line 33...
33
 *  @brief Interrupts controlling routines.
33
 *  @brief Interrupts controlling routines.
34
 */
34
 */
35
 
35
 
36
#include <arch/asm.h>
36
#include <arch/asm.h>
37
#include <arch/regutils.h>
37
#include <arch/regutils.h>
-
 
38
#include <arch/drivers/gxemul.h>
38
#include <ddi/irq.h>
39
#include <ddi/irq.h>
39
#include <arch/machine.h>
40
#include <ddi/device.h>
40
#include <interrupt.h>
41
#include <interrupt.h>
41
 
42
 
42
/** Initial size of a table holding interrupt handlers. */
43
/** Initial size of a table holding interrupt handlers. */
43
#define IRQ_COUNT 8
44
#define IRQ_COUNT 8
44
 
45
 
-
 
46
static irq_t gxemul_timer_irq;
-
 
47
 
45
/** Disable interrupts.
48
/** Disable interrupts.
46
 *
49
 *
47
 * @return Old interrupt priority level.
50
 * @return Old interrupt priority level.
48
 */
51
 */
49
ipl_t interrupts_disable(void)
52
ipl_t interrupts_disable(void)
50
{
53
{
51
    ipl_t ipl = current_status_reg_read();
54
    ipl_t ipl = current_status_reg_read();
52
 
55
   
53
    current_status_reg_control_write(STATUS_REG_IRQ_DISABLED_BIT | ipl);
56
    current_status_reg_control_write(STATUS_REG_IRQ_DISABLED_BIT | ipl);
54
   
57
   
55
    return ipl;
58
    return ipl;
56
}
59
}
57
 
60
 
Line 60... Line 63...
60
 * @return Old interrupt priority level.
63
 * @return Old interrupt priority level.
61
 */
64
 */
62
ipl_t interrupts_enable(void)
65
ipl_t interrupts_enable(void)
63
{
66
{
64
    ipl_t ipl = current_status_reg_read();
67
    ipl_t ipl = current_status_reg_read();
65
 
68
   
66
    current_status_reg_control_write(ipl & ~STATUS_REG_IRQ_DISABLED_BIT);
69
    current_status_reg_control_write(ipl & ~STATUS_REG_IRQ_DISABLED_BIT);
67
 
70
   
68
    return ipl;
71
    return ipl;
69
}
72
}
70
 
73
 
71
/** Restore interrupt priority level.
74
/** Restore interrupt priority level.
72
 *
75
 *
Line 86... Line 89...
86
ipl_t interrupts_read(void)
89
ipl_t interrupts_read(void)
87
{
90
{
88
    return current_status_reg_read();
91
    return current_status_reg_read();
89
}
92
}
90
 
93
 
-
 
94
/** Starts gxemul Real Time Clock device, which asserts regular interrupts.
-
 
95
 *
-
 
96
 * @param frequency Interrupts frequency (0 disables RTC).
-
 
97
 */
-
 
98
static void gxemul_timer_start(uint32_t frequency)
-
 
99
{
-
 
100
    *((uint32_t *) (gxemul_rtc + GXEMUL_RTC_FREQ_OFFSET))
-
 
101
        = frequency;
-
 
102
}
-
 
103
 
-
 
104
static irq_ownership_t gxemul_timer_claim(irq_t *irq)
-
 
105
{
-
 
106
    return IRQ_ACCEPT;
-
 
107
}
-
 
108
 
-
 
109
/** Timer interrupt handler.
-
 
110
 *
-
 
111
 * @param irq Interrupt information.
-
 
112
 * @param arg Not used.
-
 
113
 */
-
 
114
static void gxemul_timer_irq_handler(irq_t *irq)
-
 
115
{
-
 
116
    /*
-
 
117
    * We are holding a lock which prevents preemption.
-
 
118
    * Release the lock, call clock() and reacquire the lock again.
-
 
119
    */
-
 
120
    spinlock_unlock(&irq->lock);
-
 
121
    clock();
-
 
122
    spinlock_lock(&irq->lock);
-
 
123
   
-
 
124
    /* acknowledge tick */
-
 
125
    *((uint32_t *) (gxemul_rtc + GXEMUL_RTC_ACK_OFFSET))
-
 
126
        = 0;
-
 
127
}
-
 
128
 
91
/** Initialize basic tables for exception dispatching
129
/** Initialize basic tables for exception dispatching
92
 * and starts the timer.
130
 * and starts the timer.
93
 */
131
 */
94
void interrupt_init(void)
132
void interrupt_init(void)
95
{
133
{
96
    irq_init(IRQ_COUNT, IRQ_COUNT);
134
    irq_init(IRQ_COUNT, IRQ_COUNT);
-
 
135
   
-
 
136
    irq_initialize(&gxemul_timer_irq);
-
 
137
    gxemul_timer_irq.devno = device_assign_devno();
-
 
138
    gxemul_timer_irq.inr = GXEMUL_TIMER_IRQ;
-
 
139
    gxemul_timer_irq.claim = gxemul_timer_claim;
-
 
140
    gxemul_timer_irq.handler = gxemul_timer_irq_handler;
-
 
141
   
97
    machine_timer_irq_start();
142
    irq_register(&gxemul_timer_irq);
-
 
143
   
-
 
144
    gxemul_timer_start(GXEMUL_TIMER_FREQ);
98
}
145
}
99
 
146
 
100
/** @}
147
/** @}
101
 */
148
 */