Subversion Repositories HelenOS-historic

Rev

Rev 1573 | Rev 1591 | Go to most recent revision | Only display areas with differences | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 1573 Rev 1582
1
/*
1
/*
2
 * Copyright (C) 2006 Ondrej Palkovsky
2
 * Copyright (C) 2006 Ondrej Palkovsky
3
 * All rights reserved.
3
 * All rights reserved.
4
 *
4
 *
5
 * Redistribution and use in source and binary forms, with or without
5
 * Redistribution and use in source and binary forms, with or without
6
 * modification, are permitted provided that the following conditions
6
 * modification, are permitted provided that the following conditions
7
 * are met:
7
 * are met:
8
 *
8
 *
9
 * - Redistributions of source code must retain the above copyright
9
 * - Redistributions of source code must retain the above copyright
10
 *   notice, this list of conditions and the following disclaimer.
10
 *   notice, this list of conditions and the following disclaimer.
11
 * - Redistributions in binary form must reproduce the above copyright
11
 * - Redistributions in binary form must reproduce the above copyright
12
 *   notice, this list of conditions and the following disclaimer in the
12
 *   notice, this list of conditions and the following disclaimer in the
13
 *   documentation and/or other materials provided with the distribution.
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
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.
15
 *   derived from this software without specific prior written permission.
16
 *
16
 *
17
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
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
18
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
19
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
20
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
21
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
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
23
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
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
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.
26
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27
 */
27
 */
28
 
28
 
29
/* Lock ordering
29
/* Lock ordering
30
 *
30
 *
31
 * First the answerbox, then the phone
31
 * First the answerbox, then the phone
32
 */
32
 */
33
 
33
 
34
#include <synch/spinlock.h>
34
#include <synch/spinlock.h>
35
#include <synch/waitq.h>
35
#include <synch/waitq.h>
36
#include <synch/synch.h>
36
#include <synch/synch.h>
37
#include <ipc/ipc.h>
37
#include <ipc/ipc.h>
38
#include <errno.h>
38
#include <errno.h>
39
#include <mm/slab.h>
39
#include <mm/slab.h>
40
#include <arch.h>
40
#include <arch.h>
41
#include <proc/task.h>
41
#include <proc/task.h>
42
#include <memstr.h>
42
#include <memstr.h>
43
#include <debug.h>
43
#include <debug.h>
44
 
44
 
45
#include <print.h>
45
#include <print.h>
46
#include <proc/thread.h>
46
#include <proc/thread.h>
47
#include <arch/interrupt.h>
47
#include <arch/interrupt.h>
48
#include <ipc/irq.h>
48
#include <ipc/irq.h>
49
 
49
 
50
/* Open channel that is assigned automatically to new tasks */
50
/* Open channel that is assigned automatically to new tasks */
51
answerbox_t *ipc_phone_0 = NULL;
51
answerbox_t *ipc_phone_0 = NULL;
52
 
52
 
53
static slab_cache_t *ipc_call_slab;
53
static slab_cache_t *ipc_call_slab;
54
 
54
 
55
/* Initialize new call */
55
/* Initialize new call */
56
static void _ipc_call_init(call_t *call)
56
static void _ipc_call_init(call_t *call)
57
{
57
{
58
    memsetb((__address)call, sizeof(*call), 0);
58
    memsetb((__address)call, sizeof(*call), 0);
59
    call->callerbox = &TASK->answerbox;
59
    call->callerbox = &TASK->answerbox;
60
    call->sender = TASK;
60
    call->sender = TASK;
61
}
61
}
62
 
62
 
63
/** Allocate & initialize call structure
63
/** Allocate & initialize call structure
64
 *
64
 *
65
 * The call is initialized, so that the reply will be directed
65
 * The call is initialized, so that the reply will be directed
66
 * to TASK->answerbox
66
 * to TASK->answerbox
67
 *
67
 *
68
 * @param flags Parameters for slab_alloc (ATOMIC, etc.)
68
 * @param flags Parameters for slab_alloc (ATOMIC, etc.)
69
 */
69
 */
70
call_t * ipc_call_alloc(int flags)
70
call_t * ipc_call_alloc(int flags)
71
{
71
{
72
    call_t *call;
72
    call_t *call;
73
 
73
 
74
    call = slab_alloc(ipc_call_slab, flags);
74
    call = slab_alloc(ipc_call_slab, flags);
75
    _ipc_call_init(call);
75
    _ipc_call_init(call);
76
 
76
 
77
    return call;
77
    return call;
78
}
78
}
79
 
79
 
80
/** Initialize allocated call */
80
/** Initialize allocated call */
81
void ipc_call_static_init(call_t *call)
81
void ipc_call_static_init(call_t *call)
82
{
82
{
83
    _ipc_call_init(call);
83
    _ipc_call_init(call);
84
    call->flags |= IPC_CALL_STATIC_ALLOC;
84
    call->flags |= IPC_CALL_STATIC_ALLOC;
85
}
85
}
86
 
86
 
87
/** Deallocate call stracuture */
87
/** Deallocate call stracuture */
88
void ipc_call_free(call_t *call)
88
void ipc_call_free(call_t *call)
89
{
89
{
90
    slab_free(ipc_call_slab, call);
90
    slab_free(ipc_call_slab, call);
91
}
91
}
92
 
92
 
93
/** Initialize answerbox structure
93
/** Initialize answerbox structure
94
 */
94
 */
95
void ipc_answerbox_init(answerbox_t *box)
95
void ipc_answerbox_init(answerbox_t *box)
96
{
96
{
97
    spinlock_initialize(&box->lock, "ipc_box_lock");
97
    spinlock_initialize(&box->lock, "ipc_box_lock");
98
    spinlock_initialize(&box->irq_lock, "ipc_box_irqlock");
98
    spinlock_initialize(&box->irq_lock, "ipc_box_irqlock");
99
    waitq_initialize(&box->wq);
99
    waitq_initialize(&box->wq);
100
    list_initialize(&box->connected_phones);
100
    list_initialize(&box->connected_phones);
101
    list_initialize(&box->calls);
101
    list_initialize(&box->calls);
102
    list_initialize(&box->dispatched_calls);
102
    list_initialize(&box->dispatched_calls);
103
    list_initialize(&box->answers);
103
    list_initialize(&box->answers);
104
    list_initialize(&box->irq_notifs);
104
    list_initialize(&box->irq_notifs);
105
    box->task = TASK;
105
    box->task = TASK;
106
}
106
}
107
 
107
 
108
/** Connect phone to answerbox */
108
/** Connect phone to answerbox */
109
void ipc_phone_connect(phone_t *phone, answerbox_t *box)
109
void ipc_phone_connect(phone_t *phone, answerbox_t *box)
110
{
110
{
111
    spinlock_lock(&phone->lock);
111
    spinlock_lock(&phone->lock);
112
 
112
 
113
    phone->state = IPC_PHONE_CONNECTED;
113
    phone->state = IPC_PHONE_CONNECTED;
114
    phone->callee = box;
114
    phone->callee = box;
115
 
115
 
116
    spinlock_lock(&box->lock);
116
    spinlock_lock(&box->lock);
117
    list_append(&phone->link, &box->connected_phones);
117
    list_append(&phone->link, &box->connected_phones);
118
    spinlock_unlock(&box->lock);
118
    spinlock_unlock(&box->lock);
119
 
119
 
120
    spinlock_unlock(&phone->lock);
120
    spinlock_unlock(&phone->lock);
121
}
121
}
122
 
122
 
123
/** Initialize phone structure and connect phone to answerbox
123
/** Initialize phone structure and connect phone to answerbox
124
 */
124
 */
125
void ipc_phone_init(phone_t *phone)
125
void ipc_phone_init(phone_t *phone)
126
{
126
{
127
    spinlock_initialize(&phone->lock, "phone_lock");
127
    spinlock_initialize(&phone->lock, "phone_lock");
128
    phone->callee = NULL;
128
    phone->callee = NULL;
129
    phone->state = IPC_PHONE_FREE;
129
    phone->state = IPC_PHONE_FREE;
130
    atomic_set(&phone->active_calls, 0);
130
    atomic_set(&phone->active_calls, 0);
131
}
131
}
132
 
132
 
133
/** Helper function to facilitate synchronous calls */
133
/** Helper function to facilitate synchronous calls */
134
void ipc_call_sync(phone_t *phone, call_t *request)
134
void ipc_call_sync(phone_t *phone, call_t *request)
135
{
135
{
136
    answerbox_t sync_box;
136
    answerbox_t sync_box;
137
 
137
 
138
    ipc_answerbox_init(&sync_box);
138
    ipc_answerbox_init(&sync_box);
139
 
139
 
140
    /* We will receive data on special box */
140
    /* We will receive data on special box */
141
    request->callerbox = &sync_box;
141
    request->callerbox = &sync_box;
142
 
142
 
143
    ipc_call(phone, request);
143
    ipc_call(phone, request);
144
    ipc_wait_for_call(&sync_box, SYNCH_NO_TIMEOUT, SYNCH_FLAGS_NONE);
144
    ipc_wait_for_call(&sync_box, SYNCH_NO_TIMEOUT, SYNCH_FLAGS_NONE);
145
}
145
}
146
 
146
 
147
/** Answer message that was not dispatched and is not entered in
147
/** Answer message that was not dispatched and is not entered in
148
 * any queue
148
 * any queue
149
 */
149
 */
150
static void _ipc_answer_free_call(call_t *call)
150
static void _ipc_answer_free_call(call_t *call)
151
{
151
{
152
    answerbox_t *callerbox = call->callerbox;
152
    answerbox_t *callerbox = call->callerbox;
153
 
153
 
154
    call->flags |= IPC_CALL_ANSWERED;
154
    call->flags |= IPC_CALL_ANSWERED;
155
 
155
 
156
    spinlock_lock(&callerbox->lock);
156
    spinlock_lock(&callerbox->lock);
157
    list_append(&call->link, &callerbox->answers);
157
    list_append(&call->link, &callerbox->answers);
158
    spinlock_unlock(&callerbox->lock);
158
    spinlock_unlock(&callerbox->lock);
159
    waitq_wakeup(&callerbox->wq, 0);
159
    waitq_wakeup(&callerbox->wq, 0);
160
}
160
}
161
 
161
 
162
/** Answer message, that is in callee queue
162
/** Answer message, that is in callee queue
163
 *
163
 *
164
 * @param box Answerbox that is answering the message
164
 * @param box Answerbox that is answering the message
165
 * @param call Modified request that is being sent back
165
 * @param call Modified request that is being sent back
166
 */
166
 */
167
void ipc_answer(answerbox_t *box, call_t *call)
167
void ipc_answer(answerbox_t *box, call_t *call)
168
{
168
{
169
    /* Remove from active box */
169
    /* Remove from active box */
170
    spinlock_lock(&box->lock);
170
    spinlock_lock(&box->lock);
171
    list_remove(&call->link);
171
    list_remove(&call->link);
172
    spinlock_unlock(&box->lock);
172
    spinlock_unlock(&box->lock);
173
    /* Send back answer */
173
    /* Send back answer */
174
    _ipc_answer_free_call(call);
174
    _ipc_answer_free_call(call);
175
}
175
}
176
 
176
 
177
/** Simulate sending back a message
177
/** Simulate sending back a message
178
 *
178
 *
179
 * Most errors are better handled by forming a normal backward
179
 * Most errors are better handled by forming a normal backward
180
 * message and sending it as a normal answer.
180
 * message and sending it as a normal answer.
181
 */
181
 */
182
void ipc_backsend_err(phone_t *phone, call_t *call, __native err)
182
void ipc_backsend_err(phone_t *phone, call_t *call, __native err)
183
{
183
{
184
    call->data.phone = phone;
184
    call->data.phone = phone;
185
    atomic_inc(&phone->active_calls);
185
    atomic_inc(&phone->active_calls);
186
    IPC_SET_RETVAL(call->data, err);
186
    IPC_SET_RETVAL(call->data, err);
187
    _ipc_answer_free_call(call);
187
    _ipc_answer_free_call(call);
188
}
188
}
189
 
189
 
190
/* Unsafe unchecking ipc_call */
190
/* Unsafe unchecking ipc_call */
191
static void _ipc_call(phone_t *phone, answerbox_t *box, call_t *call)
191
static void _ipc_call(phone_t *phone, answerbox_t *box, call_t *call)
192
{
192
{
193
    if (! (call->flags & IPC_CALL_FORWARDED)) {
193
    if (! (call->flags & IPC_CALL_FORWARDED)) {
194
        atomic_inc(&phone->active_calls);
194
        atomic_inc(&phone->active_calls);
195
        call->data.phone = phone;
195
        call->data.phone = phone;
196
    }
196
    }
197
 
197
 
198
    spinlock_lock(&box->lock);
198
    spinlock_lock(&box->lock);
199
    list_append(&call->link, &box->calls);
199
    list_append(&call->link, &box->calls);
200
    spinlock_unlock(&box->lock);
200
    spinlock_unlock(&box->lock);
201
    waitq_wakeup(&box->wq, 0);
201
    waitq_wakeup(&box->wq, 0);
202
}
202
}
203
 
203
 
204
/** Send a asynchronous request using phone to answerbox
204
/** Send a asynchronous request using phone to answerbox
205
 *
205
 *
206
 * @param phone Phone connected to answerbox
206
 * @param phone Phone connected to answerbox
207
 * @param request Request to be sent
207
 * @param request Request to be sent
208
 */
208
 */
209
int ipc_call(phone_t *phone, call_t *call)
209
int ipc_call(phone_t *phone, call_t *call)
210
{
210
{
211
    answerbox_t *box;
211
    answerbox_t *box;
212
 
212
 
213
    spinlock_lock(&phone->lock);
213
    spinlock_lock(&phone->lock);
214
    if (phone->state != IPC_PHONE_CONNECTED) {
214
    if (phone->state != IPC_PHONE_CONNECTED) {
215
        spinlock_unlock(&phone->lock);
215
        spinlock_unlock(&phone->lock);
216
        if (call->flags & IPC_CALL_FORWARDED) {
216
        if (call->flags & IPC_CALL_FORWARDED) {
217
            IPC_SET_RETVAL(call->data, EFORWARD);
217
            IPC_SET_RETVAL(call->data, EFORWARD);
218
            _ipc_answer_free_call(call);
218
            _ipc_answer_free_call(call);
219
        } else {
219
        } else {
220
            if (phone->state == IPC_PHONE_HUNGUP)
220
            if (phone->state == IPC_PHONE_HUNGUP)
221
                ipc_backsend_err(phone, call, EHANGUP);
221
                ipc_backsend_err(phone, call, EHANGUP);
222
            else
222
            else
223
                ipc_backsend_err(phone, call, ENOENT);
223
                ipc_backsend_err(phone, call, ENOENT);
224
        }
224
        }
225
        return ENOENT;
225
        return ENOENT;
226
    }
226
    }
227
    box = phone->callee;
227
    box = phone->callee;
228
    _ipc_call(phone, box, call);
228
    _ipc_call(phone, box, call);
229
   
229
   
230
    spinlock_unlock(&phone->lock);
230
    spinlock_unlock(&phone->lock);
231
    return 0;
231
    return 0;
232
}
232
}
233
 
233
 
234
/** Disconnect phone from answerbox
234
/** Disconnect phone from answerbox
235
 *
235
 *
236
 * This call leaves the phone in HUNGUP state. The change to 'free' is done
236
 * This call leaves the phone in HUNGUP state. The change to 'free' is done
237
 * lazily later.
237
 * lazily later.
238
 *
238
 *
239
 * @param phone Phone to be hung up
239
 * @param phone Phone to be hung up
240
 * @param aggressive If false, the phone is only marked hungup, and all
240
 * @param aggressive If false, the phone is only marked hungup, and all
241
 *              messages are allowed to complete.
241
 *              messages are allowed to complete.
242
 *              If true, all messages in all queues are discarded. There
242
 *              If true, all messages in all queues are discarded. There
243
 *              may still be some messages that will be 'in-transit' on
243
 *              may still be some messages that will be 'in-transit' on
244
 *              other CPU.
244
 *              other CPU.
245
 *              
245
 *              
246
 * @return 0 - phone disconnected, -1 - the phone was already disconnected
246
 * @return 0 - phone disconnected, -1 - the phone was already disconnected
247
 */
247
 */
248
int ipc_phone_hangup(phone_t *phone, int aggressive)
248
int ipc_phone_hangup(phone_t *phone, int aggressive)
249
{
249
{
250
    answerbox_t *box;
250
    answerbox_t *box;
251
    call_t *call;
251
    call_t *call;
252
   
252
   
253
    spinlock_lock(&phone->lock);
253
    spinlock_lock(&phone->lock);
254
    if (phone->state == IPC_PHONE_FREE || phone->state ==IPC_PHONE_HUNGUP \
254
    if (phone->state == IPC_PHONE_FREE || phone->state ==IPC_PHONE_HUNGUP \
255
        || phone->state == IPC_PHONE_CONNECTING) {
255
        || phone->state == IPC_PHONE_CONNECTING) {
256
        spinlock_unlock(&phone->lock);
256
        spinlock_unlock(&phone->lock);
257
        return -1;
257
        return -1;
258
    }
258
    }
259
    box = phone->callee;
259
    box = phone->callee;
260
    if (phone->state != IPC_PHONE_SLAMMED) {
260
    if (phone->state != IPC_PHONE_SLAMMED) {
261
        /* Remove myself from answerbox */
261
        /* Remove myself from answerbox */
262
        spinlock_lock(&box->lock);
262
        spinlock_lock(&box->lock);
263
        list_remove(&phone->link);
263
        list_remove(&phone->link);
264
        spinlock_unlock(&box->lock);
264
        spinlock_unlock(&box->lock);
265
 
265
 
266
        if (phone->state != IPC_PHONE_SLAMMED) {
266
        if (phone->state != IPC_PHONE_SLAMMED) {
267
            call = ipc_call_alloc(0);
267
            call = ipc_call_alloc(0);
268
            IPC_SET_METHOD(call->data, IPC_M_PHONE_HUNGUP);
268
            IPC_SET_METHOD(call->data, IPC_M_PHONE_HUNGUP);
269
            call->flags |= IPC_CALL_DISCARD_ANSWER;
269
            call->flags |= IPC_CALL_DISCARD_ANSWER;
270
            _ipc_call(phone, box, call);
270
            _ipc_call(phone, box, call);
271
        }
271
        }
272
    }
272
    }
273
 
273
 
274
    if (aggressive && atomic_get(&phone->active_calls) > 0) {
274
    if (aggressive && atomic_get(&phone->active_calls) > 0) {
275
        /* TODO: Do some stuff be VERY aggressive */
275
        /* TODO: Do some stuff be VERY aggressive */
276
    }
276
    }
277
 
277
 
278
    phone->state = IPC_PHONE_HUNGUP;
278
    phone->state = IPC_PHONE_HUNGUP;
279
    spinlock_unlock(&phone->lock);
279
    spinlock_unlock(&phone->lock);
280
 
280
 
281
    return 0;
281
    return 0;
282
}
282
}
283
 
283
 
284
/** Forwards call from one answerbox to a new one
284
/** Forwards call from one answerbox to a new one
285
 *
285
 *
286
 * @param call Call to be redirected.
286
 * @param call Call to be redirected.
287
 * @param newphone Phone to target answerbox.
287
 * @param newphone Phone to target answerbox.
288
 * @param oldbox Old answerbox
288
 * @param oldbox Old answerbox
289
 * @return 0 on forward ok, error code, if there was error
289
 * @return 0 on forward ok, error code, if there was error
290
 *
290
 *
291
 * - the return value serves only as an information for the forwarder,
291
 * - the return value serves only as an information for the forwarder,
292
 *   the original caller is notified automatically with EFORWARD
292
 *   the original caller is notified automatically with EFORWARD
293
 */
293
 */
294
int ipc_forward(call_t *call, phone_t *newphone, answerbox_t *oldbox)
294
int ipc_forward(call_t *call, phone_t *newphone, answerbox_t *oldbox)
295
{
295
{
296
    spinlock_lock(&oldbox->lock);
296
    spinlock_lock(&oldbox->lock);
297
    list_remove(&call->link);
297
    list_remove(&call->link);
298
    spinlock_unlock(&oldbox->lock);
298
    spinlock_unlock(&oldbox->lock);
299
 
299
 
300
    return ipc_call(newphone, call);
300
    return ipc_call(newphone, call);
301
}
301
}
302
 
302
 
303
 
303
 
304
/** Wait for phone call
304
/** Wait for phone call
305
 *
305
 *
306
 * @param box Answerbox expecting the call.
306
 * @param box Answerbox expecting the call.
307
 * @param usec Timeout in microseconds. See documentation for waitq_sleep_timeout() for
307
 * @param usec Timeout in microseconds. See documentation for waitq_sleep_timeout() for
308
 *         decription of its special meaning.
308
 *         decription of its special meaning.
309
 * @param flags Select mode of sleep operation. See documentation for waitq_sleep_timeout()i
309
 * @param flags Select mode of sleep operation. See documentation for waitq_sleep_timeout()i
310
 *      for description of its special meaning.
310
 *      for description of its special meaning.
311
 * @return Recived message address
311
 * @return Recived message address
312
 * - to distinguish between call and answer, look at call->flags
312
 * - to distinguish between call and answer, look at call->flags
313
 */
313
 */
314
call_t * ipc_wait_for_call(answerbox_t *box, __u32 usec, int flags)
314
call_t * ipc_wait_for_call(answerbox_t *box, __u32 usec, int flags)
315
{
315
{
316
    call_t *request;
316
    call_t *request;
317
    ipl_t ipl;
317
    ipl_t ipl;
318
    int rc;
318
    int rc;
319
 
319
 
320
restart:
320
restart:
321
    rc = waitq_sleep_timeout(&box->wq, usec, flags);
321
    rc = waitq_sleep_timeout(&box->wq, usec, flags);
322
    if (SYNCH_FAILED(rc))
322
    if (SYNCH_FAILED(rc))
323
        return NULL;
323
        return NULL;
324
   
324
   
325
    spinlock_lock(&box->lock);
325
    spinlock_lock(&box->lock);
326
    if (!list_empty(&box->irq_notifs)) {
326
    if (!list_empty(&box->irq_notifs)) {
327
        ipl = interrupts_disable();
327
        ipl = interrupts_disable();
328
        spinlock_lock(&box->irq_lock);
328
        spinlock_lock(&box->irq_lock);
329
 
329
 
330
        request = list_get_instance(box->irq_notifs.next, call_t, link);
330
        request = list_get_instance(box->irq_notifs.next, call_t, link);
331
        list_remove(&request->link);
331
        list_remove(&request->link);
332
 
332
 
333
        spinlock_unlock(&box->irq_lock);
333
        spinlock_unlock(&box->irq_lock);
334
        interrupts_restore(ipl);
334
        interrupts_restore(ipl);
335
    } else if (!list_empty(&box->answers)) {
335
    } else if (!list_empty(&box->answers)) {
336
        /* Handle asynchronous answers */
336
        /* Handle asynchronous answers */
337
        request = list_get_instance(box->answers.next, call_t, link);
337
        request = list_get_instance(box->answers.next, call_t, link);
338
        list_remove(&request->link);
338
        list_remove(&request->link);
339
        atomic_dec(&request->data.phone->active_calls);
339
        atomic_dec(&request->data.phone->active_calls);
340
    } else if (!list_empty(&box->calls)) {
340
    } else if (!list_empty(&box->calls)) {
341
        /* Handle requests */
341
        /* Handle requests */
342
        request = list_get_instance(box->calls.next, call_t, link);
342
        request = list_get_instance(box->calls.next, call_t, link);
343
        list_remove(&request->link);
343
        list_remove(&request->link);
344
        /* Append request to dispatch queue */
344
        /* Append request to dispatch queue */
345
        list_append(&request->link, &box->dispatched_calls);
345
        list_append(&request->link, &box->dispatched_calls);
346
    } else {
346
    } else {
347
        /* This can happen regularly after ipc_cleanup, remove
347
        /* This can happen regularly after ipc_cleanup, remove
348
         * the warning in the future when the IPC is
348
         * the warning in the future when the IPC is
349
         * more debugged */
349
         * more debugged */
350
        printf("WARNING: Spurious IPC wakeup.\n");
350
        printf("WARNING: Spurious IPC wakeup.\n");
351
        spinlock_unlock(&box->lock);
351
        spinlock_unlock(&box->lock);
352
        goto restart;
352
        goto restart;
353
    }
353
    }
354
    spinlock_unlock(&box->lock);
354
    spinlock_unlock(&box->lock);
355
    return request;
355
    return request;
356
}
356
}
357
 
357
 
358
/** Answer all calls from list with EHANGUP msg */
358
/** Answer all calls from list with EHANGUP msg */
359
static void ipc_cleanup_call_list(link_t *lst)
359
static void ipc_cleanup_call_list(link_t *lst)
360
{
360
{
361
    call_t *call;
361
    call_t *call;
362
 
362
 
363
    while (!list_empty(lst)) {
363
    while (!list_empty(lst)) {
364
        call = list_get_instance(lst->next, call_t, link);
364
        call = list_get_instance(lst->next, call_t, link);
365
        list_remove(&call->link);
365
        list_remove(&call->link);
366
 
366
 
367
        IPC_SET_RETVAL(call->data, EHANGUP);
367
        IPC_SET_RETVAL(call->data, EHANGUP);
368
        _ipc_answer_free_call(call);
368
        _ipc_answer_free_call(call);
369
    }
369
    }
370
}
370
}
371
 
371
 
372
/** Cleans up all IPC communication of the given task
372
/** Cleans up all IPC communication of the current task
373
 *
-
 
374
 *
373
 *
-
 
374
 * Note: ipc_hangup sets returning answerbox to TASK->answerbox, you
-
 
375
 * have to change it as well if you want to cleanup other current then current.
375
 */
376
 */
376
void ipc_cleanup(task_t *task)
377
void ipc_cleanup(void)
377
{
378
{
378
    int i;
379
    int i;
379
    call_t *call;
380
    call_t *call;
380
    phone_t *phone;
381
    phone_t *phone;
381
   
382
 
382
    /* Disconnect all our phones ('ipc_phone_hangup') */
383
    /* Disconnect all our phones ('ipc_phone_hangup') */
383
    for (i=0;i < IPC_MAX_PHONES; i++)
384
    for (i=0;i < IPC_MAX_PHONES; i++)
384
        ipc_phone_hangup(&task->phones[i], 1);
385
        ipc_phone_hangup(&TASK->phones[i], 1);
385
 
386
 
386
    /* Disconnect all connected irqs */
387
    /* Disconnect all connected irqs */
387
    ipc_irq_cleanup(&task->answerbox);
388
    ipc_irq_cleanup(&TASK->answerbox);
388
 
389
 
389
    /* Disconnect all phones connected to our answerbox */
390
    /* Disconnect all phones connected to our answerbox */
390
restart_phones:
391
restart_phones:
391
    spinlock_lock(&task->answerbox.lock);
392
    spinlock_lock(&TASK->answerbox.lock);
392
    while (!list_empty(&task->answerbox.connected_phones)) {
393
    while (!list_empty(&TASK->answerbox.connected_phones)) {
393
        phone = list_get_instance(task->answerbox.connected_phones.next,
394
        phone = list_get_instance(TASK->answerbox.connected_phones.next,
394
                      phone_t, link);
395
                      phone_t, link);
395
        if (! spinlock_trylock(&phone->lock)) {
396
        if (! spinlock_trylock(&phone->lock)) {
396
            spinlock_unlock(&task->answerbox.lock);
397
            spinlock_unlock(&TASK->answerbox.lock);
397
            goto restart_phones;
398
            goto restart_phones;
398
        }
399
        }
399
       
400
       
400
        /* Disconnect phone */
401
        /* Disconnect phone */
401
        ASSERT(phone->state == IPC_PHONE_CONNECTED);
402
        ASSERT(phone->state == IPC_PHONE_CONNECTED);
402
        phone->state = IPC_PHONE_SLAMMED;
403
        phone->state = IPC_PHONE_SLAMMED;
403
        list_remove(&phone->link);
404
        list_remove(&phone->link);
404
 
405
 
405
        spinlock_unlock(&phone->lock);
406
        spinlock_unlock(&phone->lock);
406
    }
407
    }
407
 
408
 
408
    /* Answer all messages in 'calls' and 'dispatched_calls' queues */
409
    /* Answer all messages in 'calls' and 'dispatched_calls' queues */
409
    spinlock_lock(&task->answerbox.lock);
-
 
410
    ipc_cleanup_call_list(&task->answerbox.dispatched_calls);
410
    ipc_cleanup_call_list(&TASK->answerbox.dispatched_calls);
411
    ipc_cleanup_call_list(&task->answerbox.calls);
411
    ipc_cleanup_call_list(&TASK->answerbox.calls);
412
    spinlock_unlock(&task->answerbox.lock);
412
    spinlock_unlock(&TASK->answerbox.lock);
413
   
413
   
414
    /* Wait for all async answers to arrive */
414
    /* Wait for all async answers to arrive */
415
    while (1) {
415
    while (1) {
416
        /* Go through all phones, until all are FREE... */
416
        /* Go through all phones, until all are FREE... */
417
        /* Locking not needed, no one else should modify
417
        /* Locking not needed, no one else should modify
418
         * it, when we are in cleanup */
418
         * it, when we are in cleanup */
419
        for (i=0;i < IPC_MAX_PHONES; i++) {
419
        for (i=0;i < IPC_MAX_PHONES; i++) {
420
            if (task->phones[i].state == IPC_PHONE_HUNGUP && \
420
            if (TASK->phones[i].state == IPC_PHONE_HUNGUP && \
421
                atomic_get(&task->phones[i].active_calls) == 0)
421
                atomic_get(&TASK->phones[i].active_calls) == 0)
422
                task->phones[i].state = IPC_PHONE_FREE;
422
                TASK->phones[i].state = IPC_PHONE_FREE;
-
 
423
           
-
 
424
            if (TASK->phones[i].state == IPC_PHONE_CONNECTED)
-
 
425
                ipc_phone_hangup(&TASK->phones[i], 1);
-
 
426
           
423
            if (task->phones[i].state != IPC_PHONE_FREE)
427
            if (TASK->phones[i].state != IPC_PHONE_FREE)
424
                break;
428
                break;
425
        }
429
        }
426
        /* Voila, got into cleanup */
430
        /* Voila, got into cleanup */
427
        if (i == IPC_MAX_PHONES)
431
        if (i == IPC_MAX_PHONES)
428
            break;
432
            break;
429
       
433
       
430
        call = ipc_wait_for_call(&task->answerbox, SYNCH_NO_TIMEOUT, SYNCH_FLAGS_NONE);
434
        call = ipc_wait_for_call(&TASK->answerbox, SYNCH_NO_TIMEOUT, SYNCH_FLAGS_NONE);
431
        ASSERT((call->flags & IPC_CALL_ANSWERED) || (call->flags & IPC_CALL_NOTIF));
435
        ASSERT((call->flags & IPC_CALL_ANSWERED) || (call->flags & IPC_CALL_NOTIF));
432
        ASSERT(! (call->flags & IPC_CALL_STATIC_ALLOC));
436
        ASSERT(! (call->flags & IPC_CALL_STATIC_ALLOC));
433
       
437
       
434
        atomic_dec(&task->active_calls);
438
        atomic_dec(&TASK->active_calls);
435
        ipc_call_free(call);
439
        ipc_call_free(call);
436
    }
440
    }
437
}
441
}
438
 
442
 
439
 
443
 
440
/** Initilize ipc subsystem */
444
/** Initilize ipc subsystem */
441
void ipc_init(void)
445
void ipc_init(void)
442
{
446
{
443
    ipc_call_slab = slab_cache_create("ipc_call",
447
    ipc_call_slab = slab_cache_create("ipc_call",
444
                      sizeof(call_t),
448
                      sizeof(call_t),
445
                      0,
449
                      0,
446
                      NULL, NULL, 0);
450
                      NULL, NULL, 0);
447
    ipc_irq_make_table(IRQ_COUNT);
451
    ipc_irq_make_table(IRQ_COUNT);
448
}
452
}
449
 
453
 
450
 
454
 
451
/** Kconsole - list answerbox contents */
455
/** Kconsole - list answerbox contents */
452
void ipc_print_task(task_id_t taskid)
456
void ipc_print_task(task_id_t taskid)
453
{
457
{
454
    task_t *task;
458
    task_t *task;
455
    int i;
459
    int i;
456
    call_t *call;
460
    call_t *call;
457
    link_t *tmp;
461
    link_t *tmp;
458
   
462
   
459
    spinlock_lock(&tasks_lock);
463
    spinlock_lock(&tasks_lock);
460
    task = task_find_by_id(taskid);
464
    task = task_find_by_id(taskid);
461
    if (task)
465
    if (task)
462
        spinlock_lock(&task->lock);
466
        spinlock_lock(&task->lock);
463
    spinlock_unlock(&tasks_lock);
467
    spinlock_unlock(&tasks_lock);
464
    if (!task)
468
    if (!task)
465
        return;
469
        return;
466
 
470
 
467
    /* Print opened phones & details */
471
    /* Print opened phones & details */
468
    printf("PHONE:\n");
472
    printf("PHONE:\n");
469
    for (i=0; i < IPC_MAX_PHONES;i++) {
473
    for (i=0; i < IPC_MAX_PHONES;i++) {
470
        spinlock_lock(&task->phones[i].lock);
474
        spinlock_lock(&task->phones[i].lock);
471
        if (task->phones[i].state != IPC_PHONE_FREE) {
475
        if (task->phones[i].state != IPC_PHONE_FREE) {
472
            printf("%d: ",i);
476
            printf("%d: ",i);
473
            switch (task->phones[i].state) {
477
            switch (task->phones[i].state) {
474
            case IPC_PHONE_CONNECTING:
478
            case IPC_PHONE_CONNECTING:
475
                printf("connecting ");
479
                printf("connecting ");
476
                break;
480
                break;
477
            case IPC_PHONE_CONNECTED:
481
            case IPC_PHONE_CONNECTED:
478
                printf("connected to: %P ",
482
                printf("connected to: %P ",
479
                       task->phones[i].callee);
483
                       task->phones[i].callee);
480
                break;
484
                break;
481
            case IPC_PHONE_SLAMMED:
485
            case IPC_PHONE_SLAMMED:
482
                printf("slammed by: %P ",
486
                printf("slammed by: %P ",
483
                       task->phones[i].callee);
487
                       task->phones[i].callee);
484
                break;
488
                break;
485
            case IPC_PHONE_HUNGUP:
489
            case IPC_PHONE_HUNGUP:
486
                printf("hung up - was: %P ",
490
                printf("hung up - was: %P ",
487
                       task->phones[i].callee);
491
                       task->phones[i].callee);
488
                break;
492
                break;
489
            default:
493
            default:
490
                break;
494
                break;
491
            }
495
            }
492
            printf("active: %d\n", atomic_get(&task->phones[i].active_calls));
496
            printf("active: %d\n", atomic_get(&task->phones[i].active_calls));
493
        }
497
        }
494
        spinlock_unlock(&task->phones[i].lock);
498
        spinlock_unlock(&task->phones[i].lock);
495
    }
499
    }
496
 
500
 
497
 
501
 
498
    /* Print answerbox - calls */
502
    /* Print answerbox - calls */
499
    spinlock_lock(&task->answerbox.lock);
503
    spinlock_lock(&task->answerbox.lock);
500
    printf("ABOX - CALLS:\n");
504
    printf("ABOX - CALLS:\n");
501
    for (tmp=task->answerbox.calls.next; tmp != &task->answerbox.calls;tmp = tmp->next) {
505
    for (tmp=task->answerbox.calls.next; tmp != &task->answerbox.calls;tmp = tmp->next) {
502
        call = list_get_instance(tmp, call_t, link);
506
        call = list_get_instance(tmp, call_t, link);
503
        printf("Callid: %P Srctask:%lld M:%d A1:%d A2:%d A3:%d Flags:%x\n",call,
507
        printf("Callid: %P Srctask:%lld M:%d A1:%d A2:%d A3:%d Flags:%x\n",call,
504
               call->sender->taskid, IPC_GET_METHOD(call->data), IPC_GET_ARG1(call->data),
508
               call->sender->taskid, IPC_GET_METHOD(call->data), IPC_GET_ARG1(call->data),
505
               IPC_GET_ARG2(call->data), IPC_GET_ARG3(call->data), call->flags);
509
               IPC_GET_ARG2(call->data), IPC_GET_ARG3(call->data), call->flags);
506
    }
510
    }
507
    /* Print answerbox - calls */
511
    /* Print answerbox - calls */
508
    printf("ABOX - DISPATCHED CALLS:\n");
512
    printf("ABOX - DISPATCHED CALLS:\n");
509
    for (tmp=task->answerbox.dispatched_calls.next;
513
    for (tmp=task->answerbox.dispatched_calls.next;
510
         tmp != &task->answerbox.dispatched_calls;
514
         tmp != &task->answerbox.dispatched_calls;
511
         tmp = tmp->next) {
515
         tmp = tmp->next) {
512
        call = list_get_instance(tmp, call_t, link);
516
        call = list_get_instance(tmp, call_t, link);
513
        printf("Callid: %P Srctask:%lld M:%d A1:%d A2:%d A3:%d Flags:%x\n",call,
517
        printf("Callid: %P Srctask:%lld M:%d A1:%d A2:%d A3:%d Flags:%x\n",call,
514
               call->sender->taskid, IPC_GET_METHOD(call->data), IPC_GET_ARG1(call->data),
518
               call->sender->taskid, IPC_GET_METHOD(call->data), IPC_GET_ARG1(call->data),
515
               IPC_GET_ARG2(call->data), IPC_GET_ARG3(call->data), call->flags);
519
               IPC_GET_ARG2(call->data), IPC_GET_ARG3(call->data), call->flags);
516
    }
520
    }
517
    /* Print answerbox - calls */
521
    /* Print answerbox - calls */
518
    printf("ABOX - ANSWERS:\n");
522
    printf("ABOX - ANSWERS:\n");
519
    for (tmp=task->answerbox.answers.next; tmp != &task->answerbox.answers; tmp = tmp->next) {
523
    for (tmp=task->answerbox.answers.next; tmp != &task->answerbox.answers; tmp = tmp->next) {
520
        call = list_get_instance(tmp, call_t, link);
524
        call = list_get_instance(tmp, call_t, link);
521
        printf("Callid:%P M:%d A1:%d A2:%d A3:%d Flags:%x\n",call,
525
        printf("Callid:%P M:%d A1:%d A2:%d A3:%d Flags:%x\n",call,
522
               IPC_GET_METHOD(call->data), IPC_GET_ARG1(call->data),
526
               IPC_GET_METHOD(call->data), IPC_GET_ARG1(call->data),
523
               IPC_GET_ARG2(call->data), IPC_GET_ARG3(call->data), call->flags);
527
               IPC_GET_ARG2(call->data), IPC_GET_ARG3(call->data), call->flags);
524
    }
528
    }
525
 
529
 
526
    spinlock_unlock(&task->answerbox.lock);
530
    spinlock_unlock(&task->answerbox.lock);
527
    spinlock_unlock(&task->lock);
531
    spinlock_unlock(&task->lock);
528
}
532
}
529
 
533