Subversion Repositories openrisc_2011-10-31

/*
 **************************************************************************
 *
 *  Component:	RDBG
 *  Module:	servtsp.c
 *
 *  Synopsis:	Transport management for remote debug server.
 *
 * $Id: servtsp.c,v 1.2 2001-09-27 12:02:01 chris Exp $
 *
 **************************************************************************
 */
 
#include <sys/errno.h>
#include <rdbg/rdbg.h>	
#include <rdbg/servrpc.h>
#include <signal.h>		
#include <rpc/rpc.h>		
#include <rpc/svc.h>		
#include <netinet/in.h>		
#include <sys/socket.h>		
 
static int	out_sock;	
static int	warm_test;	
 
static void TimeTestHandler();	
 
    /*
     *  TspInit - Initialize the transport system.
     *
     */
 
    void
TspInit (int id)
{
    struct sigaction sa;
 
	/* setup a socket to send event messages back through */
    out_sock = socket (PF_INET, SOCK_DGRAM, 0);
    if (out_sock < 0) {
	DPRINTF (("TspInit: socket() failed %d errno %d\n",
		out_sock, getErrno()));
	return;		/* failed to open socket, let caller deal with */
    }
    {
	struct sockaddr_in addr;
 
	bzero ((void *)(&addr), sizeof addr);
	addr.sin_family = AF_INET;
	addr.sin_port = htons (BackPort);
	if (bind (out_sock, (struct sockaddr*) &addr, sizeof addr) < 0) {
	    DPRINTF (("TspInit: bind() failed\n"));
	}
    }
    /* setup alarm timer for warm testing */
    memset (&sa, 0, sizeof (sa));
    sa.sa_handler = TimeTestHandler;
    sigaction (SIGALRM, &sa, 0);
}
 
    /*
     *  TspTranslateRpcAddr - translate from an RPC handle to an
     *                        opaque address.
     *
     *  Converts the sender's address into the opaque data structure
     *  used for network addresses. This is used to look up the sender
     *  on each call.
     */
 
    Boolean
TspTranslateRpcAddr (struct svc_req* rqstp, NET_OPAQUE* opaque)
{
    struct sockaddr_in*	addr;	/* used as template to extract net info */
    unsigned char*	up;
 
    memset (opaque, 0, sizeof (NET_OPAQUE));
	/*
	 *  We interpret the remote address as a standard netbuf name.
	 *  The format is 2 bytes of address family (normally AF_INET)
	 *  and then a length (5) and then the IP address.
	 */
    if (rqstp->rq_xprt->xp_addrlen != 16)
    {
	DPRINTF (("TspTranslateRpcAddr: Unknown remote address!!!\n"));
	setErrno (EPROTONOSUPPORT);
	return False;		/* invalid, so fails */
    }
	/* addr = &rqstp->rq_xprt->xp_raddr; */
    addr = svc_getcaller (rqstp->rq_xprt);
	/* verify it is AF_INET */
    if (addr->sin_family != AF_INET) {		/* no, error */
	DPRINTF (("TspTranslateRpcAddr: Not an internet address!!\n"));
	setErrno (EAFNOSUPPORT);/* invalid addr family */
	return False;
    }
	/* good address type */
    up = (unsigned char *) &addr->sin_addr.s_addr;
    DPRINTF (("TspTranslateRpcAddr: Sent by %u.%u.%u.%u port #%u\n",
	up[0], up[1], up[2], up[3], htons (addr->sin_port)));
    memcpy (opaque, addr, sizeof (struct sockaddr_in));
    return True;
}
 
    /*
     *  TspValidateAddr - validate a passed in opaque address.
     *
     *  Checks that the passed in address is in the format
     *  expected.
     */
 
    Boolean
TspValidateAddr (NET_OPAQUE* opaque, NET_OPAQUE* sender)
{
    struct sockaddr_in*	addr;	/* used as template to extract net info */
 
    addr = (struct sockaddr_in*) opaque;
	/* Verify it is AF_INET. Should check against sender IP address too */
    if (addr->sin_family != AF_INET) {
	DPRINTF (("TspValidateAddr: Back port invalid: %d\n",
	    htons (addr->sin_port)));
	return False;		/* not valid */
    }
	/* otherwise, we copy in the IP address, since client may not know it */
    addr->sin_addr.s_addr = ((struct sockaddr_in*) sender)->sin_addr.s_addr;
    DPRINTF (("TspValidateAddr: Back port is %d\n", htons (addr->sin_port)));
    return True;
}
 
    /*
     *  TspConnGetIndex - lookup an rpc caller's address as a connection entry.
     *
     *  Looks up an ip address of a caller to locate the
     *  connection index in our connection array.
     */
 
    int
TspConnGetIndex (struct svc_req* rqstp)
{
    int		conn;
	/* &rqstp->rq_xprt->xp_raddr; */
    struct sockaddr_in *addr = svc_getcaller (rqstp->rq_xprt);
 
    for (conn = 0; conn < conn_list_cnt; conn++) {
	if (!conn_list[conn].in_use)
	    continue;			/* not used */
 
	if (addr->sin_addr.s_addr == ((struct sockaddr_in *)
		&conn_list [conn].sender)->sin_addr.s_addr
		&&  addr->sin_port == ((struct sockaddr_in *)
		&conn_list[conn].sender)->sin_port) {
	    return conn;
	}
    }
    return -1;
}
 
 
    /*
     *  TspSendWaitChange - send wait-change message to clients to
     *                      notify change.
     */
 
    void
TspSendWaitChange(
    int		conn,		/* connection to send to */
    BACK_MSG	msg,		/* BMSG type */
    UINT16	spec,		/* special information */
    PID		pid,		/* pid it refers to */
    UINT32	context,	/* additional context for message */
    Boolean	force)		/* force into being only message */
{
    int			idx;
    struct SEND_LIST*	snd_ptr;
 
    if (force) {
	    /* force to top, which means others gone */
	idx = 0;
	conn_list [conn].send_idx = 1;
	conn_list[conn].retry = 0;
    } else {
	for (idx = 0; idx < (int) conn_list[conn].send_idx; idx++) {
	    if (conn_list[conn].send_list[idx].send_type == msg
		&&  conn_list[conn].send_list[idx].pid == pid)
	    return;			/* already pended for this pid */
	}
	idx = conn_list[conn].send_idx;
	if (idx+1 > MAX_SEND)
	    return;			/* we lose it, what should we do??? */
	conn_list[conn].send_idx++;
    }
    snd_ptr = &conn_list[conn].send_list[idx];
    snd_ptr->send_type = msg;		/* message to send */
    snd_ptr->retry = TSP_RETRIES;	/* about 1 minute of retries */
    snd_ptr->spec = htons ((u_short) spec);
    snd_ptr->pid = htonl (pid);
    snd_ptr->context = htonl (context);
    TspSendMessage (conn, False);	/* now do the send */
}
 
    /*
     *  TspSendMessage - send message at top of send list for connection.
     */
 
    void
TspSendMessage( int conn, Boolean resend)
{
    struct sockaddr_in	addr;
    struct UDP_MSG	msg;
    int			cnt;
 
    if (!resend && conn_list[conn].retry)
	return;			/* already waiting for reply */
 
	/*
	 *  Note on above: if no back port we can't remove unless
	 *  someone blows off.
	 */
    if (!resend) {
	    /* first time, setup. Set retry count: */
	conn_list[conn].retry = conn_list[conn].send_list[0].retry;
	conn_list[conn].last_msg_num++; /* new sequence number */
	if (!warm_test++) { 		/* starting, so enable timer */
	    alarm (2);			/* resend every 2 seconds as needed */
	}
    }
 
    msg.type	= conn_list[conn].send_list[0].send_type;
    msg.msg_num	= conn_list[conn].last_msg_num;
    msg.spec	= conn_list[conn].send_list[0].spec;
    msg.pid	= conn_list[conn].send_list[0].pid;
    msg.context	= conn_list[conn].send_list[0].context;
 
    memset (&addr, 0, sizeof addr);
    addr.sin_family = AF_INET;
    addr.sin_port = ((struct sockaddr_in*)&conn_list[conn].back_port)->sin_port;
    addr.sin_addr.s_addr = 
	((struct sockaddr_in*)&conn_list[conn].back_port)->sin_addr.s_addr;
 
    DPRINTF (("TspSendMessage: Sending msg %d (%s) to port %d\n",
	msg.type, BmsgNames [msg.type], HL_W (addr.sin_port)));
 
    cnt = sendto (out_sock, &msg, sizeof msg, 0, (struct sockaddr*) &addr,
		    sizeof addr);
    if (cnt != sizeof msg) {		/* failed on send */
	printf ("%s: Failed to send msg %d to conn %d (%d vs. %d)\n",
	    ActName, msg.type, conn, cnt, sizeof msg);
    }
}
 
    /*
     *  TspMessageReceive - confirmation received, now send next if any.
     *
     *  - since UDP is connectionless, we batch up the sends and use
     *    one at a time until we get a message indicating ready for
     *    next (from ack).
     */
 
    void
TspMessageReceive (int conn, PID pid)
{
	/* We remove the send list entry and use next if any */
    conn_list[conn].retry = 0;	/* reset */
    if (!warm_test || !--warm_test) {
	alarm (0);			/* reset timer if not used */
    }
#ifdef DDEBUG
    if (conn_list[conn].send_list[0].send_type == BMSG_WARM) {
	DPRINTF (("TspMessageReceive: Connection reset for conn %d\n", conn));
    }
#endif
	/* Move up by one if needed */
    if (!--conn_list[conn].send_idx)
	return;			/* no more to do */
 
    memcpy (conn_list[conn].send_list, conn_list[conn].send_list+1,
	conn_list[conn].send_idx * sizeof(struct SEND_LIST)); /* copy down */
    TspSendMessage (conn, 0);
}
 
    /*
     *  TspGetHostName - return client's host name.
     *
     *  - this routine returns the name of the client's host or the net
     *    number of unknown.
     */
 
    char*
TspGetHostName (conn_idx)
    int		conn_idx;	/* client connection number */
{
    static char		buff [30];	/* largest net num */
    unsigned char*	cp;
 
    cp = conn_list[conn_idx].sender.c+4;
    sprintf (buff, "%u.%u.%u.%u", cp[0], cp[1], cp[2], cp[3]);
    return buff;
}
 
    /*
     *  TimeTestHandler - alarm timer handler to resend warm/wait test.
     */
 
    static void
TimeTestHandler()
{
    int		conn;
 
    if (!warm_test)
	return;			/* no longer enabled */
 
    for (conn = 0; conn < conn_list_cnt; conn++) {	
	    /* locate all that are using this */
	if (!conn_list[conn].in_use)
	    continue;			/* not used */
 
	if (!conn_list[conn].retry) continue;
	    /* found one that we are testing */
	if (!--conn_list[conn].retry) {
		/*
		 *  Counted down the retries: blow off.
		 *  Need to have connection flag to indicate not blowing
		 *  off for cases where client is stopped due to being
		 *  debugged.
		 */
	    ConnDelete (conn, NULL, CLOSE_IGNORE);
	    continue;
	}
	TspSendMessage (conn, True);	/* send another message */
    }
    alarm (2);			/* setup for 2 seconds from now */
}