Subversion Repositories HelenOS-historic

Rev

Rev 1284 | Go to most recent revision | Details | Last modification | View Log | RSS feed

Rev Author Line No. Line
1281 palkovsky 1
/*
2
 * Copyright (C) 2006 Ondrej Palkovsky
3
 * All rights reserved.
4
 *
5
 * Redistribution and use in source and binary forms, with or without
6
 * modification, are permitted provided that the following conditions
7
 * are met:
8
 *
9
 * - Redistributions of source code must retain the above copyright
10
 *   notice, this list of conditions and the following disclaimer.
11
 * - Redistributions in binary form must reproduce the above copyright
12
 *   notice, this list of conditions and the following disclaimer in the
13
 *   documentation and/or other materials provided with the distribution.
14
 * - The name of the author may not be used to endorse or promote products
15
 *   derived from this software without specific prior written permission.
16
 *
17
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27
 */
28
 
29
#include <arch.h>
30
#include <mm/slab.h>
31
#include <errno.h>
32
#include <ipc/ipc.h>
33
#include <ipc/irq.h>
34
 
35
typedef struct {
36
    SPINLOCK_DECLARE(lock);
37
    answerbox_t *box;
38
    irq_code_t *code;
39
} ipc_irq_t;
40
 
41
 
42
static ipc_irq_t *irq_conns = NULL;
43
static int irq_conns_size;
44
 
45
#include <print.h>
46
/* Execute code associated with IRQ notification */
47
static void code_execute(call_t *call, irq_code_t *code)
48
{
49
    int i;
50
 
51
    if (!code)
52
        return;
53
 
54
    for (i=0; i < code->cmdcount;i++) {
55
        switch (code->cmds[i].cmd) {
56
        case CMD_MEM_READ_1:
57
            IPC_SET_ARG2(call->data, *((__u8 *)code->cmds[i].addr));
58
            break;
59
        case CMD_MEM_READ_2:
60
            IPC_SET_ARG2(call->data, *((__u16 *)code->cmds[i].addr));
61
            break;
62
        case CMD_MEM_READ_4:
63
            IPC_SET_ARG2(call->data, *((__u32 *)code->cmds[i].addr));
64
            break;
65
        case CMD_MEM_READ_8:
66
            IPC_SET_ARG2(call->data, *((__u64 *)code->cmds[i].addr));
67
            break;
68
        case CMD_MEM_WRITE_1:
69
            *((__u8 *)code->cmds[i].addr) = code->cmds[i].value;
70
            break;
71
        case CMD_MEM_WRITE_2:
72
            *((__u16 *)code->cmds[i].addr) = code->cmds[i].value;
73
            break;
74
        case CMD_MEM_WRITE_4:
75
            *((__u32 *)code->cmds[i].addr) = code->cmds[i].value;
76
            break;
77
        case CMD_MEM_WRITE_8:
78
            *((__u64 *)code->cmds[i].addr) = code->cmds[i].value;
79
            break;
80
        default:
81
            break;
82
        }
83
    }
84
}
85
 
86
static void code_free(irq_code_t *code)
87
{
88
    if (code) {
89
        free(code->cmds);
90
        free(code);
91
    }
92
}
93
 
94
static irq_code_t * code_from_uspace(irq_code_t *ucode)
95
{
96
    irq_code_t *code;
97
    irq_cmd_t *ucmds;
98
 
99
    code = malloc(sizeof(*code), 0);
100
    copy_from_uspace(code, ucode, sizeof(*code));
101
 
102
    if (code->cmdcount > IRQ_MAX_PROG_SIZE) {
103
        free(code);
104
        return NULL;
105
    }
106
    ucmds = code->cmds;
107
    code->cmds = malloc(sizeof(code->cmds[0]) * (code->cmdcount), 0);
108
    copy_from_uspace(code->cmds, ucmds, sizeof(code->cmds[0]) * (code->cmdcount));
109
 
110
    return code;
111
}
112
 
113
/** Unregister task from irq */
114
void ipc_irq_unregister(answerbox_t *box, int irq)
115
{
116
    ipl_t ipl;
117
 
118
    ipl = interrupts_disable();
119
    spinlock_lock(&irq_conns[irq].lock);
120
    if (irq_conns[irq].box == box) {
121
        irq_conns[irq].box = NULL;
122
        code_free(irq_conns[irq].code);
123
        irq_conns[irq].code = NULL;
124
    }
125
 
126
    spinlock_unlock(&irq_conns[irq].lock);
127
    interrupts_restore(ipl);
128
}
129
 
130
/** Register an answerbox as a receiving end of interrupts notifications */
131
int ipc_irq_register(answerbox_t *box, int irq, irq_code_t *ucode)
132
{
133
    ipl_t ipl;
134
    irq_code_t *code;
135
 
136
    ASSERT(irq_conns);
137
 
138
    if (ucode) {
139
        code = code_from_uspace(ucode);
140
        if (!code)
141
            return EBADMEM;
142
    } else
143
        code = NULL;
144
 
145
    ipl = interrupts_disable();
146
    spinlock_lock(&irq_conns[irq].lock);
147
 
148
    if (irq_conns[irq].box) {
149
        spinlock_unlock(&irq_conns[irq].lock);
150
        interrupts_restore(ipl);
151
        code_free(code);
152
        return EEXISTS;
153
    }
154
    irq_conns[irq].box = box;
155
    irq_conns[irq].code = code;
156
    spinlock_unlock(&irq_conns[irq].lock);
157
    interrupts_restore(ipl);
158
 
159
    return 0;
160
}
161
 
162
/** Notify process that an irq had happend
163
 *
164
 * We expect interrupts to be disabled
165
 */
166
void ipc_irq_send_notif(int irq)
167
{
168
    call_t *call;
169
 
170
    ASSERT(irq_conns);
171
    spinlock_lock(&irq_conns[irq].lock);
172
 
173
    if (irq_conns[irq].box) {
174
        call = ipc_call_alloc(FRAME_ATOMIC);
175
        call->flags |= IPC_CALL_NOTIF;
176
        IPC_SET_METHOD(call->data, IPC_M_INTERRUPT);
177
        IPC_SET_ARG1(call->data, irq);
178
 
179
        /* Execute code to handle irq */
180
        code_execute(call, irq_conns[irq].code);
181
 
182
        spinlock_lock(&irq_conns[irq].box->irq_lock);
183
        list_append(&call->list, &irq_conns[irq].box->irq_notifs);
184
        spinlock_unlock(&irq_conns[irq].box->irq_lock);
185
 
186
        waitq_wakeup(&irq_conns[irq].box->wq, 0);
187
    }
188
 
189
    spinlock_unlock(&irq_conns[irq].lock);
190
}
191
 
192
 
193
/** Initialize table of interrupt handlers */
194
void ipc_irq_make_table(int irqcount)
195
{
196
    int i;
197
 
198
    irq_conns_size = irqcount;
199
    irq_conns = malloc(irqcount * (sizeof(*irq_conns)), 0);
200
    for (i=0; i < irqcount; i++) {
201
        spinlock_initialize(&irq_conns[i].lock, "irq_ipc_lock");
202
        irq_conns[i].box = NULL;
203
        irq_conns[i].code = NULL;
204
    }
205
}
206
 
207
/** Disconnect all irq's notifications
208
 *
209
 * TODO: It may be better to do some linked list, so that
210
 *       we wouldn't need to go through whole array every cleanup
211
 */
212
void ipc_irq_cleanup(answerbox_t *box)
213
{
214
    int i;
215
    ipl_t ipl;
216
 
217
    for (i=0; i < irq_conns_size; i++) {
218
        ipl = interrupts_disable();
219
        spinlock_lock(&irq_conns[i].lock);
220
        if (irq_conns[i].box == box)
221
            irq_conns[i].box = NULL;
222
        spinlock_unlock(&irq_conns[i].lock);
223
        interrupts_restore(ipl);
224
    }
225
}