Subversion Repositories openrisc_2011-10-31

/* xterm.c -- Definition of functions and structures for 
   peripheral to communicate with host through an xterm.
   Inspired from SWI-Prolog by Jan Wielemaker (GPL too)
   even if there is really few in common.
 
   Copyright (C) 2002 Richard Prescott <rip@step.polymtl.ca>
   Copyright (C) 2008 Embecosm Limited
 
   Contributor Jeremy Bennett <jeremy.bennett@embecosm.com>
 
   This file is part of OpenRISC 1000 Architectural Simulator.
 
   This program is free software; you can redistribute it and/or modify it
   under the terms of the GNU General Public License as published by the Free
   Software Foundation; either version 3 of the License, or (at your option)
   any later version.
 
   This program is distributed in the hope that it will be useful, but WITHOUT
   ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
   FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
   more details.
 
   You should have received a copy of the GNU General Public License along
   with this program.  If not, see <http://www.gnu.org/licenses/>. */
 
 
/* This program is commented throughout in a fashion suitable for processing
   with Doxygen. */
 
 
/* Autoconf and/or portability configuration */
#include "config.h"
#include "port.h"
 
/* System includes */
#if defined(HAVE_GRANTPT) && defined(HAVE_UNLOCKPT) && defined(HAVE_PTSNAME)
#endif
 
#include <stdlib.h>
#include <unistd.h>
#include <signal.h>
#include <termios.h>
#include <errno.h>
#include <stdio.h>
#include <fcntl.h>
#include <sys/types.h>
#include <sys/wait.h>
 
#if HAVE_SYS_STROPTS_H
#include <sys/stropts.h>	/* I_PUSH ioctl */
#endif
 
#if HAVE_BASENAME
#include <libgen.h>		/* basename() */
#endif
 
/* Package includes */
#include "channel.h"
#include "generic.h"
#include "fd.h"
 
/*! Data structure to represent the connection to the xterm */
struct xterm_channel
{
  struct fd_channel fds;
  int pid;
  char **argv;
};
 
/* Forward declaration of static functions */
static void  xterm_close (void *data);
static void *xterm_init (const char *input);
static int   xterm_open (void *data);
 
/*! Global data structure with the xterm interface functions */
struct channel_ops  xterm_channel_ops = {
	.init  = xterm_init,
	.open  = xterm_open,
	.close = xterm_close,
	.read  = fd_read,
	.write = fd_write,
	.free  = generic_free,
};
 
 
#if !(HAVE_BASENAME)
static char *
basename (const char *filename)
{
  char *p = strrchr (filename, '/');
 
  return p ? p + 1 : (char *) filename;
}
#endif /* HAVE_BASENAME */
 
static void
xterm_close (void *data)
{
  struct xterm_channel *xt = data;
 
  if (!xt)
    return;
 
  if (xt->fds.fdin != -1)
    close (xt->fds.fdin);
 
  if (xt->pid != -1)
    {
      kill (xt->pid, SIGKILL);
      waitpid (xt->pid, NULL, 0);
    }
 
  if (xt->argv)
    free (xt->argv);
 
  xt->fds.fdin = -1;
  xt->fds.fdout = -1;
  xt->pid = -1;
  xt->argv = NULL;
 
}
 
#if defined(HAVE_ON_EXIT)
static void
xterm_exit (int i, void *data)
{
  xterm_close (data);
}
#endif
 
#define MAX_XTERM_ARGS 100
static void *
xterm_init (const char *input)
{
  struct xterm_channel *retval = malloc (sizeof (struct xterm_channel));
  if (retval)
    {
      int i;
      char *arglist;
 
      retval->fds.fdin = -1;
      retval->fds.fdout = -1;
      retval->pid = -1;
 
#if defined(HAVE_ON_EXIT)
      /* reset cause exit(1), leaving an xterm opened */
      on_exit (xterm_exit, retval);
#endif
 
      i = 2;
      arglist = (char *) input;
      retval->argv = malloc (sizeof (char *) * MAX_XTERM_ARGS);
      if (!retval->argv)
	{
	  free (retval);
	  return NULL;
	}
      /* Assume xterm arguments are separated by whitespace */
      while ((retval->argv[i++] = strtok (arglist, " \t\n")))
	{
	  arglist = NULL;
	  if (i == MAX_XTERM_ARGS - 1)
	    {
	      free (retval);
	      return NULL;
	    }
	}
 
    }
  return (void *) retval;
}
 
 
 
static int
xterm_open (void *data)
{
#if defined(HAVE_GRANTPT) && defined(HAVE_UNLOCKPT) && defined(HAVE_PTSNAME)
  struct xterm_channel *xt = data;
  int master, retval;
  char *slavename;
  struct termios termio;
  char arg[64], *fin;
 
  if (!data)
    {
      errno = ENODEV;
      return -1;
    }
 
  master = open ("/dev/ptmx", O_RDWR);
 
  if (master < 0)
    return -1;
 
  grantpt (master);
  unlockpt (master);
  slavename = (char *) ptsname (master);
 
  if (!slavename)
    {
      errno = ENOTTY;
      goto closemastererror;
    }
 
  xt->fds.fdout = xt->fds.fdin = open (slavename, O_RDWR);
  if (xt->fds.fdout < 0)
    goto closemastererror;
 
#if HAVE_DECL_I_PUSH
  /* These modules must be pushed onto the stream for some non-Linux and
     non-Cygwin operating systems. */
  retval = ioctl (xt->fds.fdin, I_PUSH, "ptem");
  if (retval < 0)
    goto closeslaveerror;
 
  retval = ioctl (xt->fds.fdin, I_PUSH, "ldterm");
  if (retval < 0)
    goto closeslaveerror;
#endif
 
  retval = tcgetattr (xt->fds.fdin, &termio);
  if (retval < 0)
    goto closeslaveerror;
  termio.c_lflag &= ~ECHO;
  retval = tcsetattr (xt->fds.fdin, TCSADRAIN, &termio);
  if (retval < 0)
    goto closeslaveerror;
 
  xt->pid = fork ();
 
  if (xt->pid == -1)
    goto closeslaveerror;
 
  if (xt->pid == 0)
    {
      /* Ctrl-C on sim still kill the xterm, grrr */
      signal (SIGINT, SIG_IGN);
 
      fin = slavename + strlen (slavename) - 2;
      if (strchr (fin, '/'))
	{
	  sprintf (arg, "-S%s/%d", basename (slavename), master);
	}
      else
	{
	  sprintf (arg, "-S%c%c%d", fin[0], fin[1], master);
	}
      xt->argv[0] = "xterm";
      xt->argv[1] = arg;
      execvp ("xterm", xt->argv);
      if (write (master, "\n", 1) < 0)	/* Don't ignore result */
	{
	  printf ("ERROR: xterm: write failed\n");
	}
      exit (1);
    }
 
  do
    retval = read (xt->fds.fdin, &arg, 1);
  while (retval >= 0 && arg[0] != '\n');
  if (retval < 0)
    goto closeslaveerror;
 
  termio.c_lflag |= ECHO;
  retval = tcsetattr (xt->fds.fdin, TCSADRAIN, &termio);
 
  if (retval < 0)
    goto closeslaveerror;
 
  return 0;
 
closeslaveerror:
  close (xt->fds.fdin);
 
closemastererror:
  close (master);
  xt->pid = xt->fds.fdin = xt->fds.fdout = -1;
  return -1;
 
#else
  /* I don't see how this stuff should be working on a system that doesn't know
     grantpt(), unlockpt(), ptsname(). Mac OS X also does not have /dev/ptmx.
     -hpanther
   */
  return -1;
#endif
}