void lanaddress_server_thread(void *p) { L4_ThreadId_t partner; L4_MsgTag_t msgtag; idl4_msgbuf_t msgbuf; long cnt; static void *ILanAddress_vtable[ILANADDRESS_DEFAULT_VTABLE_SIZE] = ILANADDRESS_DEFAULT_VTABLE; idl4_msgbuf_init( &msgbuf ); while( 1 ) { partner = L4_nilthread; msgtag.raw = 0; cnt = 0; while( 1 ) { idl4_msgbuf_sync( &msgbuf ); idl4_reply_and_wait( &partner, &msgtag, &msgbuf, &cnt ); if( idl4_is_error( &msgtag ) ) break; idl4_process_request( &partner, &msgtag, &msgbuf, &cnt, ILanAddress_vtable[ idl4_get_function_id(&msgtag) & ILANADDRESS_FID_MASK] ); } } }
void File_server(void) { L4_ThreadId_t partner; L4_MsgTag_t msgtag; idl4_msgbuf_t msgbuf; long cnt; idl4_msgbuf_init(&msgbuf); for (cnt = 0;cnt < FILE_STRBUF_SIZE;cnt++) idl4_msgbuf_add_buffer(&msgbuf, malloc(8000), 8000); while (1) { partner = L4_nilthread; msgtag.raw = 0; cnt = 0; while (1) { idl4_msgbuf_sync(&msgbuf); idl4_reply_and_wait(&partner, &msgtag, &msgbuf, &cnt); if (idl4_is_error(&msgtag)) break; idl4_process_request(&partner, &msgtag, &msgbuf, &cnt, File_vtable[idl4_get_function_id(&msgtag) & FILE_FID_MASK]); } } }
void device_server(void) { L4_ThreadId_t partner; L4_MsgTag_t msgtag; idl4_msgbuf_t msgbuf; long cnt; uintptr_t *size; partner = L4_nilthread; msgtag.raw = 0; cnt = 0; while (1) { /* * Now check async queues -- we check this everytime, which is a bit * silly, would be nice if we could detect a failed ipc to us */ size = cb_get(iguana_cb_handle, sizeof(uintptr_t)); if (size) { // uintptr_t *data = cb_get(iguana_cb_handle, *size); // DEBUG_PRINT("Got stuff: %" PRIdPTR "\n", *size); // DEBUG_PRINT("Got stuff: %" PRIxPTR " %" PRIxPTR "\n", data[0], // data[1]); } /* Wait for message */ idl4_msgbuf_sync(&msgbuf); idl4_reply_and_wait(&partner, &msgtag, &msgbuf, &cnt); if (idl4_is_error(&msgtag)) { DEBUG_PRINT("timer:device_server(%d) Error %" PRIxPTR " -- replying_to: %" PRIxPTR "\n", __LINE__, L4_ErrorCode(), partner.raw); partner = L4_nilthread; msgtag.raw = 0; cnt = 0; continue; } if (msgtag.X.label == IRQ_LABEL) { driver_interrupt(global_device, partner.global.X.thread_no); continue; } switch (magpie_get_interface_bigid(&msgbuf)) { case 37: idl4_process_request(&partner, &msgtag, &msgbuf, &cnt, device_vtable[idl4_get_function_id(&msgtag) & DEVICE_FID_MASK]); break; case 40: idl4_process_request(&partner, &msgtag, &msgbuf, &cnt, timer_server_vtable[idl4_get_function_id (&msgtag) & TIMER_SERVER_FID_MASK]); break; case 41: idl4_process_request(&partner, &msgtag, &msgbuf, &cnt, timer__vtable[idl4_get_function_id(&msgtag) & TIMER__FID_MASK]); break; default: DEBUG_PRINT("timer: device_server: Bad label! (0x%lx)\n", magpie_get_interface_bigid(&msgbuf)); partner = L4_nilthread; } } }