WebSVN – HelenOS – Diff – /branches/dynload/uspace/app/trace/ipcp.c


/*
 * Copyright (c) 2008 Jiri Svoboda
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 *
 * - Redistributions of source code must retain the above copyright
 *   notice, this list of conditions and the following disclaimer.
 * - Redistributions in binary form must reproduce the above copyright
 *   notice, this list of conditions and the following disclaimer in the
 *   documentation and/or other materials provided with the distribution.
 * - The name of the author may not be used to endorse or promote products
 *   derived from this software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 */
 
/** @addtogroup trace
 * @{
 */
/** @file
 */
 
#include <stdio.h>
#include <stdlib.h>
#include <libadt/hash_table.h>
 
#include "ipc_desc.h"
#include "proto.h"
#include "trace.h"
#include "ipcp.h"
 
#define IPCP_CALLID_SYNC 0
 
typedef struct {
    int phone_hash;
    ipc_call_t question;
 
    int call_hash;
 
    link_t link;
} pending_call_t;
 
typedef struct {
    int server;
    proto_t *proto;
} connection_t;
 
#define MAX_PHONE 64
connection_t connections[MAX_PHONE];
int have_conn[MAX_PHONE];
 
#define PCALL_TABLE_CHAINS 32
hash_table_t pending_calls;
 
/*
 * Pseudo-protocols
 */
proto_t *proto_system;      /**< Protocol describing system IPC methods. */
proto_t *proto_unknown;     /**< Protocol with no known methods. */
 
static hash_index_t pending_call_hash(unsigned long key[]);
static int pending_call_compare(unsigned long key[], hash_count_t keys,
    link_t *item);
static void pending_call_remove_callback(link_t *item);
 
hash_table_operations_t pending_call_ops = {
    .hash = pending_call_hash,
    .compare = pending_call_compare,
    .remove_callback = pending_call_remove_callback
};
 
 
static hash_index_t pending_call_hash(unsigned long key[])
{
//  printf("pending_call_hash\n");
    return key[0] % PCALL_TABLE_CHAINS;
}
 
static int pending_call_compare(unsigned long key[], hash_count_t keys,
    link_t *item)
{
    pending_call_t *hs;
 
//  printf("pending_call_compare\n");
    hs = hash_table_get_instance(item, pending_call_t, link);
 
    return key[0] == hs->call_hash;
}
 
static void pending_call_remove_callback(link_t *item)
{
//  printf("pending_call_remove_callback\n");
}
 
 
void ipcp_connection_set(int phone, int server, proto_t *proto)
{
    if (phone <0 || phone >= MAX_PHONE) return;
    connections[phone].server = server;
    connections[phone].proto = proto;
    have_conn[phone] = 1;
}
 
void ipcp_connection_clear(int phone)
{
    have_conn[phone] = 0;
    connections[phone].server = 0;
    connections[phone].proto = NULL;
}
 
static void ipc_m_print(proto_t *proto, ipcarg_t method)
{
    oper_t *oper;
 
    /* Try system methods first */
    oper = proto_get_oper(proto_system, method);
 
    if (oper == NULL && proto != NULL) {
        /* Not a system method, try the user protocol. */
        oper = proto_get_oper(proto, method);
    }
 
    if (oper != NULL) {
        printf("%s (%d)", oper->name, method);
        return;
    }
 
    printf("%d", method);
}
 
void ipcp_init(void)
{
    ipc_m_desc_t *desc;
    oper_t *oper;
 
    /*
     * Create a pseudo-protocol 'unknown' that has no known methods.
     */
    proto_unknown = proto_new("unknown");
 
    /*
     * Create a pseudo-protocol 'system' defining names of system IPC
     * methods.
     */
    proto_system = proto_new("system");
 
    desc = ipc_methods;
    while (desc->number != 0) {
        oper = oper_new(desc->name);
        proto_add_oper(proto_system, desc->number, oper);
 
        ++desc;
    }
 
    hash_table_create(&pending_calls, PCALL_TABLE_CHAINS, 1, &pending_call_ops);
}
 
void ipcp_cleanup(void)
{
    proto_delete(proto_system);
    hash_table_destroy(&pending_calls);
}
 
void ipcp_call_out(int phone, ipc_call_t *call, ipc_callid_t hash)
{
    pending_call_t *pcall;
    proto_t *proto;
    unsigned long key[1];
    oper_t *oper;
 
    if (have_conn[phone]) proto = connections[phone].proto;
    else proto = NULL;
 
    if ((display_mask & DM_IPC) != 0) {
        printf("Call ID: 0x%x, phone: %d, proto: %s, method: ", hash,
            phone, (proto ? proto->name : "n/a"));
        ipc_m_print(proto, IPC_GET_METHOD(*call));
        printf(" args: (%u, %u, %u, %u, %u)\n",
            IPC_GET_ARG1(*call),
            IPC_GET_ARG2(*call),
            IPC_GET_ARG3(*call),
            IPC_GET_ARG4(*call),
            IPC_GET_ARG5(*call)
        );
    }
 
 
    if ((display_mask & DM_USER) != 0) {
 
        if (proto != NULL) {
            oper = proto_get_oper(proto, IPC_GET_METHOD(*call));
        } else {
            oper = NULL;
        }
 
        if (oper != NULL) {
 
            printf("%s(%d).%s", (proto ? proto->name : "n/a"),
                phone, (oper ? oper->name : "unknown"));
 
            printf("(%u, %u, %u, %u, %u)\n",
                IPC_GET_ARG1(*call),
                IPC_GET_ARG2(*call),
                IPC_GET_ARG3(*call),
                IPC_GET_ARG4(*call),
                IPC_GET_ARG5(*call)
            );
        }
    }
 
    /* Store call in hash table for response matching */
 
    pcall = malloc(sizeof(pending_call_t));
    pcall->phone_hash = phone;
    pcall->question = *call;
    pcall->call_hash = hash;
 
    key[0] = hash;
 
    hash_table_insert(&pending_calls, key, &pcall->link);
}
 
static void parse_answer(ipc_callid_t hash, pending_call_t *pcall,
    ipc_call_t *answer)
{
    int phone;
    ipcarg_t method;
    ipcarg_t service;
    int retval;
    proto_t *proto;
    int cphone;
 
//  printf("parse_answer\n");
 
    phone = pcall->phone_hash;
    method = IPC_GET_METHOD(pcall->question);
    retval = IPC_GET_RETVAL(*answer);
 
    if ((display_mask & DM_IPC) != 0) {
        printf("Response to 0x%x: retval=%d, args = (%u, %u, %u, %u, %u)\n",
            hash, retval, IPC_GET_ARG1(*answer),
            IPC_GET_ARG2(*answer), IPC_GET_ARG3(*answer),
            IPC_GET_ARG4(*answer), IPC_GET_ARG5(*answer));
    }
 
    if ((display_mask & DM_USER) != 0) {
        printf("-> %d\n", retval);
    }
 
    if (phone == 0 && method == IPC_M_CONNECT_ME_TO && retval == 0) {
        /* Connected to a service (through NS) */
        service = IPC_GET_ARG1(pcall->question);
        proto = proto_get_by_srv(service);
        if (proto == NULL) proto = proto_unknown;
 
        cphone = IPC_GET_ARG5(*answer);
        if ((display_mask & DM_SYSTEM) != 0) {
            printf("Registering connection (phone %d, protocol: %s)\n", cphone,
                    proto->name);
        }
        ipcp_connection_set(cphone, 0, proto);
    }
}
 
void ipcp_call_in(ipc_call_t *call, ipc_callid_t hash)
{
    link_t *item;
    pending_call_t *pcall;
    unsigned long key[1];
 
//  printf("ipcp_call_in()\n");
/*  printf("phone: %d, method: ", call->in_phone_hash);
    ipc_m_print(IPC_GET_METHOD(*call));
    printf(" args: (%u, %u, %u, %u, %u)\n",
        IPC_GET_ARG1(*call),
        IPC_GET_ARG2(*call),
        IPC_GET_ARG3(*call),
        IPC_GET_ARG4(*call),
        IPC_GET_ARG5(*call)
    );*/
 
    if ((hash & IPC_CALLID_ANSWERED) == 0 && hash != IPCP_CALLID_SYNC) {
        /* Not a response */
        if ((display_mask & DM_IPC) != 0) {
            printf("Not a response (hash %d)\n", hash);
        }
        return;
    }
 
    hash = hash & ~IPC_CALLID_ANSWERED;
    key[0] = hash;
 
    item = hash_table_find(&pending_calls, key);
    if (item == NULL) return; // No matching question found
 
    /*
     * Response matched to question.
     */
   
    pcall = hash_table_get_instance(item, pending_call_t, link);
    hash_table_remove(&pending_calls, key, 1);
 
    parse_answer(hash, pcall, call);
    free(pcall);
}
 
void ipcp_call_sync(int phone, ipc_call_t *call, ipc_call_t *answer)
{
    ipcp_call_out(phone, call, IPCP_CALLID_SYNC);
    ipcp_call_in(answer, IPCP_CALLID_SYNC);
}
 
void ipcp_hangup(int phone, int rc)
{
    if ((display_mask & DM_SYSTEM) != 0) {
        printf("Hang phone %d up -> %d\n", phone, rc);
        ipcp_connection_clear(phone);
    }
}
 
/** @}
 */
 

Rev 3444	Rev 3448
1	/*	1	/*
2	* Copyright (c) 2008 Jiri Svoboda	2	* Copyright (c) 2008 Jiri Svoboda
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	/** @addtogroup trace	29	/** @addtogroup trace
30	* @{	30	* @{
31	*/	31	*/
32	/** @file	32	/** @file
33	*/	33	*/
34		34
35	#include <stdio.h>	35	#include <stdio.h>
36	#include <stdlib.h>	36	#include <stdlib.h>
37	#include <libadt/hash_table.h>	37	#include <libadt/hash_table.h>
38		38
39	#include "ipc_desc.h"	39	#include "ipc_desc.h"
40	#include "proto.h"	40	#include "proto.h"
41	#include "trace.h"	41	#include "trace.h"
42	#include "ipcp.h"	42	#include "ipcp.h"
43		43
44	#define IPCP_CALLID_SYNC 0	44	#define IPCP_CALLID_SYNC 0
45		45
46	typedef struct {	46	typedef struct {
47	int phone_hash;	47	int phone_hash;
48	ipc_call_t question;	48	ipc_call_t question;
49		49
50	int call_hash;	50	int call_hash;
51		51
52	link_t link;	52	link_t link;
53	} pending_call_t;	53	} pending_call_t;
54		54
55	typedef struct {	55	typedef struct {
56	int server;	56	int server;
57	proto_t *proto;	57	proto_t *proto;
58	} connection_t;	58	} connection_t;
59		59
60	#define MAX_PHONE 64	60	#define MAX_PHONE 64
61	connection_t connections[MAX_PHONE];	61	connection_t connections[MAX_PHONE];
62	int have_conn[MAX_PHONE];	62	int have_conn[MAX_PHONE];
63		63
64	#define PCALL_TABLE_CHAINS 32	64	#define PCALL_TABLE_CHAINS 32
65	hash_table_t pending_calls;	65	hash_table_t pending_calls;
66		66
67	/*	67	/*
68	* Pseudo-protocols	68	* Pseudo-protocols
69	*/	69	*/
70	proto_t proto_system; /< Protocol describing system IPC methods. /	70	proto_t proto_system; /< Protocol describing system IPC methods. /
71	proto_t proto_unknown; /< Protocol with no known methods. /	71	proto_t proto_unknown; /< Protocol with no known methods. /
72		72
73	static hash_index_t pending_call_hash(unsigned long key[]);	73	static hash_index_t pending_call_hash(unsigned long key[]);
74	static int pending_call_compare(unsigned long key[], hash_count_t keys,	74	static int pending_call_compare(unsigned long key[], hash_count_t keys,
75	link_t *item);	75	link_t *item);
76	static void pending_call_remove_callback(link_t *item);	76	static void pending_call_remove_callback(link_t *item);
77		77
78	hash_table_operations_t pending_call_ops = {	78	hash_table_operations_t pending_call_ops = {
79	.hash = pending_call_hash,	79	.hash = pending_call_hash,
80	.compare = pending_call_compare,	80	.compare = pending_call_compare,
81	.remove_callback = pending_call_remove_callback	81	.remove_callback = pending_call_remove_callback
82	};	82	};
83		83
84		84
85	static hash_index_t pending_call_hash(unsigned long key[])	85	static hash_index_t pending_call_hash(unsigned long key[])
86	{	86	{
87	// printf("pending_call_hash\n");	87	// printf("pending_call_hash\n");
88	return key[0] % PCALL_TABLE_CHAINS;	88	return key[0] % PCALL_TABLE_CHAINS;
89	}	89	}
90		90
91	static int pending_call_compare(unsigned long key[], hash_count_t keys,	91	static int pending_call_compare(unsigned long key[], hash_count_t keys,
92	link_t *item)	92	link_t *item)
93	{	93	{
94	pending_call_t *hs;	94	pending_call_t *hs;
95		95
96	// printf("pending_call_compare\n");	96	// printf("pending_call_compare\n");
97	hs = hash_table_get_instance(item, pending_call_t, link);	97	hs = hash_table_get_instance(item, pending_call_t, link);
98		98
99	return key[0] == hs->call_hash;	99	return key[0] == hs->call_hash;
100	}	100	}
101		101
102	static void pending_call_remove_callback(link_t *item)	102	static void pending_call_remove_callback(link_t *item)
103	{	103	{
104	// printf("pending_call_remove_callback\n");	104	// printf("pending_call_remove_callback\n");
105	}	105	}
106		106
107		107
108	void ipcp_connection_set(int phone, int server, proto_t *proto)	108	void ipcp_connection_set(int phone, int server, proto_t *proto)
109	{	109	{
110	if (phone <0 \|\| phone >= MAX_PHONE) return;	110	if (phone <0 \|\| phone >= MAX_PHONE) return;
111	connections[phone].server = server;	111	connections[phone].server = server;
112	connections[phone].proto = proto;	112	connections[phone].proto = proto;
113	have_conn[phone] = 1;	113	have_conn[phone] = 1;
114	}	114	}
115		115
116	void ipcp_connection_clear(int phone)	116	void ipcp_connection_clear(int phone)
117	{	117	{
118	have_conn[phone] = 0;	118	have_conn[phone] = 0;
119	connections[phone].server = 0;	119	connections[phone].server = 0;
120	connections[phone].proto = NULL;	120	connections[phone].proto = NULL;
121	}	121	}
122		122
123	static void ipc_m_print(proto_t *proto, ipcarg_t method)	123	static void ipc_m_print(proto_t *proto, ipcarg_t method)
124	{	124	{
125	oper_t *oper;	125	oper_t *oper;
126		126
127	/* Try system methods first */	127	/* Try system methods first */
128	oper = proto_get_oper(proto_system, method);	128	oper = proto_get_oper(proto_system, method);
129		129
130	if (oper == NULL && proto != NULL) {	130	if (oper == NULL && proto != NULL) {
131	/* Not a system method, try the user protocol. */	131	/* Not a system method, try the user protocol. */
132	oper = proto_get_oper(proto, method);	132	oper = proto_get_oper(proto, method);
133	}	133	}
134		134
135	if (oper != NULL) {	135	if (oper != NULL) {
136	printf("%s (%d)", oper->name, method);	136	printf("%s (%d)", oper->name, method);
137	return;	137	return;
138	}	138	}
139		139
140	printf("%d", method);	140	printf("%d", method);
141	}	141	}
142		142
143	void ipcp_init(void)	143	void ipcp_init(void)
144	{	144	{
145	ipc_m_desc_t *desc;	145	ipc_m_desc_t *desc;
146	oper_t *oper;	146	oper_t *oper;
147		147
148	/*	148	/*
149	* Create a pseudo-protocol 'unknown' that has no known methods.	149	* Create a pseudo-protocol 'unknown' that has no known methods.
150	*/	150	*/
151	proto_unknown = proto_new("unknown");	151	proto_unknown = proto_new("unknown");
152		152
153	/*	153	/*
154	* Create a pseudo-protocol 'system' defining names of system IPC	154	* Create a pseudo-protocol 'system' defining names of system IPC
155	* methods.	155	* methods.
156	*/	156	*/
157	proto_system = proto_new("system");	157	proto_system = proto_new("system");
158		158
159	desc = ipc_methods;	159	desc = ipc_methods;
160	while (desc->number != 0) {	160	while (desc->number != 0) {
161	oper = oper_new(desc->name);	161	oper = oper_new(desc->name);
162	proto_add_oper(proto_system, desc->number, oper);	162	proto_add_oper(proto_system, desc->number, oper);
163		163
164	++desc;	164	++desc;
165	}	165	}
166		166
167	hash_table_create(&pending_calls, PCALL_TABLE_CHAINS, 1, &pending_call_ops);	167	hash_table_create(&pending_calls, PCALL_TABLE_CHAINS, 1, &pending_call_ops);
168	}	168	}
169		169
170	void ipcp_cleanup(void)	170	void ipcp_cleanup(void)
171	{	171	{
172	proto_delete(proto_system);	172	proto_delete(proto_system);
173	hash_table_destroy(&pending_calls);	173	hash_table_destroy(&pending_calls);
174	}	174	}
175		175
176	void ipcp_call_out(int phone, ipc_call_t *call, ipc_callid_t hash)	176	void ipcp_call_out(int phone, ipc_call_t *call, ipc_callid_t hash)
177	{	177	{
178	pending_call_t *pcall;	178	pending_call_t *pcall;
179	proto_t *proto;	179	proto_t *proto;
180	unsigned long key[1];	180	unsigned long key[1];
181	oper_t *oper;	181	oper_t *oper;
182		182
183	if (have_conn[phone]) proto = connections[phone].proto;	183	if (have_conn[phone]) proto = connections[phone].proto;
184	else proto = NULL;	184	else proto = NULL;
185		185
186	if ((display_mask & DM_IPC) != 0) {	186	if ((display_mask & DM_IPC) != 0) {
187	printf("Call ID: 0x%x, phone: %d, proto: %s, method: ", hash,	187	printf("Call ID: 0x%x, phone: %d, proto: %s, method: ", hash,
188	phone, (proto ? proto->name : "n/a"));	188	phone, (proto ? proto->name : "n/a"));
189	ipc_m_print(proto, IPC_GET_METHOD(*call));	189	ipc_m_print(proto, IPC_GET_METHOD(*call));
190	printf(" args: (%u, %u, %u, %u, %u)\n",	190	printf(" args: (%u, %u, %u, %u, %u)\n",
191	IPC_GET_ARG1(*call),	191	IPC_GET_ARG1(*call),
192	IPC_GET_ARG2(*call),	192	IPC_GET_ARG2(*call),
193	IPC_GET_ARG3(*call),	193	IPC_GET_ARG3(*call),
194	IPC_GET_ARG4(*call),	194	IPC_GET_ARG4(*call),
195	IPC_GET_ARG5(*call)	195	IPC_GET_ARG5(*call)
196	);	196	);
197	}	197	}
198		198
199		199
200	if ((display_mask & DM_USER) != 0) {	200	if ((display_mask & DM_USER) != 0) {
201		201
202	if (proto != NULL) {	202	if (proto != NULL) {
203	oper = proto_get_oper(proto, IPC_GET_METHOD(*call));	203	oper = proto_get_oper(proto, IPC_GET_METHOD(*call));
204	} else {	204	} else {
205	oper = NULL;	205	oper = NULL;
206	}	206	}
207		207
208	if (oper != NULL) {	208	if (oper != NULL) {
209		209
210	printf("%s(%d).%s", (proto ? proto->name : "n/a"),	210	printf("%s(%d).%s", (proto ? proto->name : "n/a"),
211	phone, (oper ? oper->name : "unknown"));	211	phone, (oper ? oper->name : "unknown"));
212		212
213	printf("(%u, %u, %u, %u, %u)\n",	213	printf("(%u, %u, %u, %u, %u)\n",
214	IPC_GET_ARG1(*call),	214	IPC_GET_ARG1(*call),
215	IPC_GET_ARG2(*call),	215	IPC_GET_ARG2(*call),
216	IPC_GET_ARG3(*call),	216	IPC_GET_ARG3(*call),
217	IPC_GET_ARG4(*call),	217	IPC_GET_ARG4(*call),
218	IPC_GET_ARG5(*call)	218	IPC_GET_ARG5(*call)
219	);	219	);
220	}	220	}
221	}	221	}
222		222
223	/* Store call in hash table for response matching */	223	/* Store call in hash table for response matching */
224		224
225	pcall = malloc(sizeof(pending_call_t));	225	pcall = malloc(sizeof(pending_call_t));
226	pcall->phone_hash = phone;	226	pcall->phone_hash = phone;
227	pcall->question = *call;	227	pcall->question = *call;
228	pcall->call_hash = hash;	228	pcall->call_hash = hash;
229		229
230	key[0] = hash;	230	key[0] = hash;
231		231
232	hash_table_insert(&pending_calls, key, &pcall->link);	232	hash_table_insert(&pending_calls, key, &pcall->link);
233	}	233	}
234		234
235	static void parse_answer(ipc_callid_t hash, pending_call_t *pcall,	235	static void parse_answer(ipc_callid_t hash, pending_call_t *pcall,
236	ipc_call_t *answer)	236	ipc_call_t *answer)
237	{	237	{
238	int phone;	238	int phone;
239	ipcarg_t method;	239	ipcarg_t method;
240	ipcarg_t service;	240	ipcarg_t service;
241	int retval;	241	int retval;
242	proto_t *proto;	242	proto_t *proto;
243	int cphone;	243	int cphone;
244		244
245	// printf("parse_answer\n");	245	// printf("parse_answer\n");
246		246
247	phone = pcall->phone_hash;	247	phone = pcall->phone_hash;
248	method = IPC_GET_METHOD(pcall->question);	248	method = IPC_GET_METHOD(pcall->question);
249	retval = IPC_GET_RETVAL(*answer);	249	retval = IPC_GET_RETVAL(*answer);
250		250
251	if ((display_mask & DM_IPC) != 0) {	251	if ((display_mask & DM_IPC) != 0) {
252	printf("Response to 0x%x: retval=%d, args = (%u, %u, %u, %u, %u)\n",	252	printf("Response to 0x%x: retval=%d, args = (%u, %u, %u, %u, %u)\n",
253	hash, retval, IPC_GET_ARG1(*answer),	253	hash, retval, IPC_GET_ARG1(*answer),
254	IPC_GET_ARG2(answer), IPC_GET_ARG3(answer),	254	IPC_GET_ARG2(answer), IPC_GET_ARG3(answer),
255	IPC_GET_ARG4(answer), IPC_GET_ARG5(answer));	255	IPC_GET_ARG4(answer), IPC_GET_ARG5(answer));
256	}	256	}
257		257
258	if ((display_mask & DM_USER) != 0) {	258	if ((display_mask & DM_USER) != 0) {
259	printf("-> %d\n", retval);	259	printf("-> %d\n", retval);
260	}	260	}
261		261
262	if (phone == 0 && method == IPC_M_CONNECT_ME_TO && retval == 0) {	262	if (phone == 0 && method == IPC_M_CONNECT_ME_TO && retval == 0) {
263	/* Connected to a service (through NS) */	263	/* Connected to a service (through NS) */
264	service = IPC_GET_ARG1(pcall->question);	264	service = IPC_GET_ARG1(pcall->question);
265	proto = proto_get_by_srv(service);	265	proto = proto_get_by_srv(service);
266	if (proto == NULL) proto = proto_unknown;	266	if (proto == NULL) proto = proto_unknown;
267		267
268	cphone = IPC_GET_ARG5(*answer);	268	cphone = IPC_GET_ARG5(*answer);
269	if ((display_mask & DM_SYSTEM) != 0) {	269	if ((display_mask & DM_SYSTEM) != 0) {
270	printf("Registering connection (phone %d, protocol: %s)\n", cphone,	270	printf("Registering connection (phone %d, protocol: %s)\n", cphone,
271	proto->name);	271	proto->name);
272	}	272	}
273	ipcp_connection_set(cphone, 0, proto);	273	ipcp_connection_set(cphone, 0, proto);
274	}	274	}
275	}	275	}
276		276
277	void ipcp_call_in(ipc_call_t *call, ipc_callid_t hash)	277	void ipcp_call_in(ipc_call_t *call, ipc_callid_t hash)
278	{	278	{
279	link_t *item;	279	link_t *item;
280	pending_call_t *pcall;	280	pending_call_t *pcall;
281	unsigned long key[1];	281	unsigned long key[1];
282		282
283	// printf("ipcp_call_in()\n");	283	// printf("ipcp_call_in()\n");
284	/* printf("phone: %d, method: ", call->in_phone_hash);	284	/* printf("phone: %d, method: ", call->in_phone_hash);
285	ipc_m_print(IPC_GET_METHOD(*call));	285	ipc_m_print(IPC_GET_METHOD(*call));
286	printf(" args: (%u, %u, %u, %u, %u)\n",	286	printf(" args: (%u, %u, %u, %u, %u)\n",
287	IPC_GET_ARG1(*call),	287	IPC_GET_ARG1(*call),
288	IPC_GET_ARG2(*call),	288	IPC_GET_ARG2(*call),
289	IPC_GET_ARG3(*call),	289	IPC_GET_ARG3(*call),
290	IPC_GET_ARG4(*call),	290	IPC_GET_ARG4(*call),
291	IPC_GET_ARG5(*call)	291	IPC_GET_ARG5(*call)
292	);*/	292	);*/
293		293
294	if ((hash & IPC_CALLID_ANSWERED) == 0 && hash != IPCP_CALLID_SYNC) {	294	if ((hash & IPC_CALLID_ANSWERED) == 0 && hash != IPCP_CALLID_SYNC) {
295	/* Not a response */	295	/* Not a response */
296	if ((display_mask & DM_IPC) != 0) {	296	if ((display_mask & DM_IPC) != 0) {
297	printf("Not a response (hash %d)\n", hash);	297	printf("Not a response (hash %d)\n", hash);
298	}	298	}
299	return;	299	return;
300	}	300	}
301		301
302	hash = hash & ~IPC_CALLID_ANSWERED;	302	hash = hash & ~IPC_CALLID_ANSWERED;
303	key[0] = hash;	303	key[0] = hash;
304		304
305	item = hash_table_find(&pending_calls, key);	305	item = hash_table_find(&pending_calls, key);
306	if (item == NULL) return; // No matching question found	306	if (item == NULL) return; // No matching question found
307		307
308	/*	308	/*
309	* Response matched to question.	309	* Response matched to question.
310	*/	310	*/
311		311
312	pcall = hash_table_get_instance(item, pending_call_t, link);	312	pcall = hash_table_get_instance(item, pending_call_t, link);
313	hash_table_remove(&pending_calls, key, 1);	313	hash_table_remove(&pending_calls, key, 1);
314		314
315	parse_answer(hash, pcall, call);	315	parse_answer(hash, pcall, call);
316	free(pcall);	316	free(pcall);
317	}	317	}
318		318
319	void ipcp_call_sync(int phone, ipc_call_t call, ipc_call_t answer)	319	void ipcp_call_sync(int phone, ipc_call_t call, ipc_call_t answer)
320	{	320	{
321	ipcp_call_out(phone, call, IPCP_CALLID_SYNC);	321	ipcp_call_out(phone, call, IPCP_CALLID_SYNC);
322	ipcp_call_in(answer, IPCP_CALLID_SYNC);	322	ipcp_call_in(answer, IPCP_CALLID_SYNC);
323	}	323	}
324		324
325	void ipcp_hangup(int phone, int rc)	325	void ipcp_hangup(int phone, int rc)
326	{	326	{
327	if ((display_mask & DM_SYSTEM) != 0) {	327	if ((display_mask & DM_SYSTEM) != 0) {
328	printf("Hang phone %d up -> %d\n", phone, rc);	328	printf("Hang phone %d up -> %d\n", phone, rc);
329	ipcp_connection_clear(phone);	329	ipcp_connection_clear(phone);
330	}	330	}
331	}	331	}
332		332
333	/** @}	333	/** @}
334	*/	334	*/
335		335

Subversion Repositories HelenOS

(root)/branches/dynload/uspace/app/trace/ipcp.c @ 3530 – Rev 3444 → 3448