/*
 * rdevice.c - Atari850 emulation
 *
 * Copyright (c) ???? Tom Hunt, Chris Martin
 * Copyright (c) 2003 Atari800 development team (see DOC/CREDITS)
 *
 * This file is part of the Atari800 emulator project which emulates
 * the Atari 400, 800, 800XL, 130XE, and 5200 8-bit computers.
 *
 * Atari800 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 2 of the License, or
 * (at your option) any later version.
 *
 * Atari800 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 Atari800; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
*/

/* Originally From Closer To Home (Tom Hunt)
 *
 * 2003.04.03 cmartin@ti.com - Added connecting Host name lookup and port
 *                             changing as well as CONNECT_STRING changing...
 * 2003.04.03 cmartin@ti.com - Added setsockopt SO_REUSEADDR for socket to
 *                             allow reconnections
 * 2003.04.05 cmartin@ti.com - Added sighandler for catching SIGPIPE error...
 *                             can get this and cause the emu to crash if
 *                             the other end disconnects prematurely...
 * 2003.04.06 cmartin@ti.com - Added translation on/off and line feeds
 *                           - Fixed IP address lookup (print ip address if
 *                             lookup fails...)
 * 2003.04.07 cmartin@ti.com - Added Local echo when not connected.
 * 2003.04.17 cmartin@ti.com - Added Telnet escape sequence parsing for
 *                             connecting to telnet
 * 2003.09.02 cmartin@ti.com - Cleaned up Serial port (/dev/ttyS*) Handling
 * 2003.09.05 cmartin@ti.com - Included minor bug fixes submitted from
 *                             Christian Groessler (thanks Chris!)
 *                           - Removed erroneous return in RREAD().
 *                           - Fixed typo for 9600 baud in xio_36()
 *                           - Modified serial port dev_name generation in
 *                             open_connection_serial()
 *                           - Now we only modify the serial port options if
 *                             we can open a port (in open_connection_serial())
 *                           - Removed Telnet IAC escape sequence handling in
 *                             RWRIT() and now we only
 *                             write to the port if we are connected.
 * 2003.09.08 cmartin@ti.com - Added missing baud rates and data word
 *                             lengths (5,6,7,8)
 * 2003.09.11 cmartin@ti.com - Fixed Address lookup in open_connection()
 *                           - Reformatted and cleaned whole file.
 *                           - Removed all memory writes to addresses 
 *                             746 - 749 except within the RSTAT function.
 *
 * TODO:
 *       create a new socket and a buffer for each port number....
 *       non-concurrent mode error reporting to 747
 *       error bits in location 746
 *       implement xio 32?
 *       error reporting to regY
 *       heavy ASCII translation
 *       controlling DTR, RTS, & XMT - xio 34
 *
 * Dialing out via telnet:
 * Type "ATDL" to toggle Linefeeds on/off (normally off)
 * Type "ATDI <hostname> <port>" example: "ATDI localhost 23"
 * if the port is omitted, then 23 is assumed.
 *
 */

#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <signal.h>
#include <ctype.h>
#include <time.h>
#include <errno.h>
#include <unistd.h>

#include <sys/stat.h>

#include <sys/socket.h>
#include <netinet/in.h>
#include <netdb.h>
#include <arpa/inet.h>
#include <sys/time.h>
#include <sys/types.h>
#include <fcntl.h>
#include <termios.h>

#include "cpu.h"
#include "memory.h"
#include "devices.h"
#include "log.h"

#define Peek(a)    (dGetByte((a)))
#define DPeek(a)   (dGetByte((a))+( dGetByte((a)+1)<<8 ) )
#define Poke(x,y)  (dPutByte((x),(y)))

extern int Device_isvalid(UBYTE ch);
//---------------------------------------------------------------------------
// Global Variables
//---------------------------------------------------------------------------
static int connected;
static int do_once;

#if 0
UBYTE r_dtr, r_rts, r_sd;
UBYTE r_dsr, r_cts, r_cd;
UBYTE r_parity, r_stop;
UBYTE r_error, r_in;
unsigned int r_stat;
#endif
//unsigned int svainit;

struct sockaddr_in in;
struct sockaddr_in peer_in;
int sock;
int rdev_fd;

char MESSAGE[256];
char command_buf[256];
//fd_set fd;
//struct timeval tv;
int retval;
unsigned char bufout[256];
//unsigned char bufin[256];
int concurrent;
static char inetaddress[256];

int command_end = 0;
char CONNECT_STRING[40] = "\r\n_CONNECT 2400\r\n";
int portnum = 9000;
int translation = 1;
int trans_cr = 0;
int linefeeds = 1;
int my_once = 1;

int r_serial = 0;
int bufend = 0;

//---------------------------------------------------------------------------
// Host Support Function - If Disconnect signal is found, then close socket
// and clean up.
//---------------------------------------------------------------------------
void catch_disconnect(int sig)
{
  Aprint("R*: Disconnected....");
  close(rdev_fd);
  connected = 0;
  do_once = 0;
  bufout[0] = 0;
  strcat(bufout, "\r\nNO CARRIER\r\n");
  bufend = 13;
#if 0  
  Poke(747,bufend);
  Poke(748,0);
#endif  
}

//---------------------------------------------------------------------------
// Host Support Function - XIO 34 - Called from Device_RSPEC
// Controls handshake lines DTR, RTS, SD
//---------------------------------------------------------------------------
void xio_34(void)
{
  int temp;
  //int fid;
  struct termios options;
  //int status;

  //fid = dGetByte(0x2e) >> 4;
  temp = dGetByte(ICAX1Z);

  if(r_serial)
  {
    tcgetattr(rdev_fd, &options);
    //ioctl(rdev_fd, TIOCMGET, &status);
  }

  if(temp & 0x80) 
  {
    if(temp & 0x40) 
    {
      /* turn DTR on */
      if(r_serial) 
      {
        //status |= TIOCM_DTR;
      }
    } 
    else 
    {
      //Drop DTR
      if(r_serial) 
      {
        cfsetispeed(&options, B0);
        cfsetospeed(&options, B0);
      }

      if(connected != 0)
      {
        close ( rdev_fd );
        connected = 0;
        do_once = 0;
        //bufend = 0;
      }
    }
  }

  if(r_serial) 
  {
    // RTS Set/Clear
    if(temp & 0x20) 
    {
      if(temp & 0x10) 
      {
        //status |= TIOCM_RTS;
      } 
      else 
      {
        //status &= ~TIOCM_RTS;
      }
    }

    if(temp & 0x02) 
    {
      if(temp & 0x01) 
      {
        //status |= TIOCM_RTS;
      } 
      else
      {
        //status &= ~TIOCM_RTS;
      }
    }
  }

  if(r_serial)
  {
    tcsetattr(rdev_fd, TCSANOW, &options);
    //ioctl(rdev_fd, TIOCMSET, &status);
  }

  regA = 1;
  regY = 1;
  ClrN;

}

//---------------------------------------------------------------------------
// Host Support Function - XIO 36 - Called from Device_RSPEC
// Sets baud, stop bits, and ready monitoring.
//---------------------------------------------------------------------------
void xio_36(void)
{
  int aux1, aux2;
  struct termios options;

  aux1 = dGetByte(ICAX1Z);
  aux2 = dGetByte(ICAX2Z);

  if(r_serial)
  {
    tcgetattr(rdev_fd, &options);

    //Set Stop bits
    if(aux1 & 0x80)
    { //2 Stop bits
      options.c_cflag |= CSTOPB;
    } 
    else 
    { //1 Stop bit
      options.c_cflag &= ~CSTOPB; 
    }

    //Set word size
    if((aux1 & 0x30) == 0)
    { //8 bit word size
      options.c_cflag &= ~CSIZE;
      options.c_cflag |= CS8;
    }
    else if((aux1 & 0x30) == 0x10)
    { //7 bit word size
      options.c_cflag &= ~CSIZE;
      options.c_cflag |= CS7;
    }
    else if((aux1 & 0x30) == 0x20)
    { //6 bit word size
      options.c_cflag &= ~CSIZE;
      options.c_cflag |= CS6;
    }
    else if((aux1 & 0x30) == 0x30)
    { //5 bit word size
      options.c_cflag &= ~CSIZE;
      options.c_cflag |= CS5;
    }
    else
    { //8 bit word size
      options.c_cflag &= ~CSIZE;
      options.c_cflag |= CS8;
    }

    //Set Baud Rate
    if((aux1 & 0x0f) == 0) 
    { //300 Baud
      cfsetispeed(&options, B300);
      cfsetospeed(&options, B300);
    } 
    else if((aux1 & 0x0f) == 1) 
    { // 45.5 Baud (unsupported) - now 57600
#ifdef B57600
      cfsetispeed(&options, B57600);
      cfsetospeed(&options, B57600);
#else
      cfsetispeed(&options, B50);
      cfsetospeed(&options, B50);
#endif
    } 
    else if ((aux1 & 0x0f) == 2)
    { // 50 Baud
      cfsetispeed(&options, B50);
      cfsetospeed(&options, B50);
    } 
    else if ((aux1 & 0x0f) == 3) 
    { // 56.875 Baud (unsupported) - now 115200
#ifdef B115200
      cfsetispeed(&options, B115200);
      cfsetospeed(&options, B115200);
#else
      cfsetispeed(&options, B50);
      cfsetospeed(&options, B50);
#endif
    } 
    else if((aux1 & 0x0f) == 4)
    { // 75 Baud
      cfsetispeed(&options, B75);
      cfsetospeed(&options, B75);
    }
    else if((aux1 & 0x0f) == 5)
    { // 110 Baud
      cfsetispeed(&options, B110);
      cfsetospeed(&options, B110);
    } 
    else if((aux1 & 0x0f) == 6)
    { // 134.5 Baud
      cfsetispeed(&options, B134);
      cfsetospeed(&options, B134);
    } 
    else if((aux1 & 0x0f) == 7)
    { // 150 Baud
      cfsetispeed(&options, B150);
      cfsetospeed(&options, B150);
    } 
    else if((aux1 & 0x0f) == 8)
    { // 300 Baud
      cfsetispeed(&options, B300);
      cfsetospeed(&options, B300);
    } 
    else if((aux1 & 0x0f) == 9)
    { // 600 Baud
      cfsetispeed(&options, B600);
      cfsetospeed(&options, B600);
    } 
    else if((aux1 & 0x0f) == 10) 
    { // 1200 Baud
      cfsetispeed(&options, B1200);
      cfsetospeed(&options, B1200);
    }
    else if((aux1 & 0x0f) == 12) 
    { // 2400 Baud
      cfsetispeed(&options, B2400);
      cfsetospeed(&options, B2400);
    } 
    else if((aux1 & 0x0f) == 13)
    { // 4800 Baud
      cfsetispeed(&options, B4800);
      cfsetospeed(&options, B4800);
    } 
    else if((aux1 & 0x0f) == 14)
    { // 9600 Baud
      cfsetispeed(&options, B9600);
      cfsetospeed(&options, B9600);
    }
    else if((aux1 & 0x0f) == 15) 
    { // 19200 Baud
#ifdef B19200
      cfsetispeed(&options, B19200);
      cfsetospeed(&options, B19200);
#else
      cfsetispeed(&options, B9600);
      cfsetospeed(&options, B9600);
#endif
    } 
    else 
    { // 115200 Baud (can add 38400, 76800 if wanted)
#ifdef B115200
      cfsetispeed(&options, B115200);
      cfsetospeed(&options, B115200);
#else
      cfsetispeed(&options, B9600);
      cfsetospeed(&options, B9600);
#endif
    }

    if(aux1 & 0x40)
    { // 230400 Baud
#ifdef B230400
      cfsetispeed(&options, B230400);
      cfsetospeed(&options, B230400);
#endif
    }

    tcsetattr(rdev_fd, TCSANOW, &options);
  }

  regA = 1;
  regY = 1;
  ClrN;
}



//---------------------------------------------------------------------------
// Host Support Function - XIO 38 - Called from Device_RSPEC
// Sets Translation and parity
//---------------------------------------------------------------------------
void xio_38(void)
{
  int aux1;
  struct termios options;

  regA = 1;
  regY = 1;
  ClrN;

  aux1 = Peek(ICAX1Z);
  if(r_serial) 
  {
    if(aux1 & 0x04) 
    { //Odd Parity
      tcgetattr(rdev_fd, &options);
      options.c_cflag |= PARENB;
      options.c_cflag |= PARODD;
      tcsetattr(rdev_fd, TCSANOW, &options);
    } 
    else if(aux1 & 0x08)
    { //Even Parity
      tcgetattr(rdev_fd, &options);
      options.c_cflag |= PARENB;
      options.c_cflag &= ~PARODD;
      tcsetattr(rdev_fd, TCSANOW, &options);

    } 
    else 
    { //No Parity
      tcgetattr(rdev_fd, &options);
      options.c_cflag &= ~PARENB;
      tcsetattr(rdev_fd, TCSANOW, &options);
    }
  }

  if(aux1 & 0x20)
  { // No Translation
    Aprint("R*: No ATASCII/ASCII TRANSLATION");
    translation = 0;
  }
  else
  {
    translation = 1;
  }

  if(aux1 & 0x40)
  { // Append line feed
    Aprint("R*: Append Line Feeds");
    linefeeds = 1;
  }
  else
  {
    linefeeds = 0;
  }

}

//---------------------------------------------------------------------------
// Host Support Function - XIO 40 - Called from Device_RSPEC
// Sets concurrent mode.  Also checks for dropped carrier.
//---------------------------------------------------------------------------
void xio_40(void)
{

  int aux1;
/*
    if(connected == 0)
      Poke(747,0);
*/
  regA = 1;
  regY = 1;
  ClrN;

  aux1 = Peek(ICAX1Z);

  if(aux1 >= 12) 
  {
    concurrent = 1;
    Aprint("R*: Entering concurrent IO mode...");
  }
  else 
  {
    concurrent = 0;
    sprintf(MESSAGE, "R*: XIO 40, %d", aux1);
    Aprint(MESSAGE);
  }

}

//---------------------------------------------------------------------------
// Host Support Function - Internet Socket Open Connection
//---------------------------------------------------------------------------
void open_connection(char * address, int port)
{
  struct hostent *host;
  if((address != NULL) && (strlen(address) > 0))
  {
    close(rdev_fd);
    close(sock);
    do_once = 1;
    connected = 1;
    memset ( &peer_in, 0, sizeof ( struct sockaddr_in ) );
    //rdev_fd = socket ( AF_INET, SOCK_STREAM, IPPROTO_TCP );
    rdev_fd = socket ( AF_INET, SOCK_STREAM, 0 );
    fcntl( rdev_fd, F_SETFL, O_NONBLOCK);
    peer_in.sin_family = AF_INET;
    if(inet_pton(AF_INET, address, &peer_in.sin_addr) == 0) 
    { // invalid address if zero
      if((peer_in.sin_addr.s_addr == -1) || (peer_in.sin_addr.s_addr == 0))
      {
        host = gethostbyname(address);
        if(host != NULL)
        {
          printf("Host = %s.\n",  host->h_addr_list[0]);
          memcpy((caddr_t)&peer_in.sin_addr, host->h_addr_list[0], host->h_length);
        }
        else
        {
          perror("gethostbyname");
        }
      }
    }
    
    if(port > 0)
    {
      peer_in.sin_port = htons (port);
    } 
    else
    {  /* telnet port */
      peer_in.sin_port = htons (23);
    }
    if(connect(rdev_fd, (struct sockaddr *)&peer_in, sizeof ( peer_in )) < 0) 
    {
      perror("connect");
    }
    signal(SIGPIPE, catch_disconnect); //Need to see if the other end disconnects...
    signal(SIGHUP, catch_disconnect); //Need to see if the other end disconnects...
    sprintf(MESSAGE, "R*: Connecting to %s", address);
    Aprint(MESSAGE);
    fcntl(rdev_fd, F_SETFL, O_NONBLOCK);

    /* Telnet negotiation */
    sprintf(MESSAGE, "%c%c%c%c%c%c%c%c%c", 0xff, 0xfb, 0x01, 0xff, 0xfb, 0x03, 0xff, 0xfd, 0x0f3);
    write(rdev_fd, MESSAGE, 9);
    Aprint("R*: Negotiating Terminal Options...");
  }

}


#if defined (__linux__) && defined(__i386__)
#define TTY_DEV_NAME "/dev/ttyS0"   /* Linux/x86 */
#elif defined (__NetBSD__) && defined(__i386__)
#define TTY_DEV_NAME "/dev/tty00"   /* NetBSD/x86 */
#elif defined (__sun__)
#define TTY_DEV_NAME "/dev/ttya"    /* Solaris */
#else
#error tty name unknown!
#endif

//---------------------------------------------------------------------------
// Host Support Function - Serial Open Connection
//---------------------------------------------------------------------------
void open_connection_serial(int port)
{
  char * dev_name;
  struct termios options;

  if(connected)
  {
    close(rdev_fd);
  }
  do_once = 1;
  connected = 1;

  dev_name = malloc(sizeof(TTY_DEV_NAME));
  if (! dev_name) 
  {
    perror("R*: open_connection_serial: cannot allocate memory - ");
    return;
  }
  strcpy(dev_name, TTY_DEV_NAME);
  *(dev_name + strlen(dev_name) - 1) += port - 1;

  rdev_fd = open(dev_name, O_RDWR | O_NOCTTY | O_NDELAY);
  //rdev_fd = open("/dev/ttyS0", O_RDONLY | O_NOCTTY | O_NDELAY);
  //rdev_fd = open("/dev/ttyS0", O_WRONLY | O_NOCTTY | O_NDELAY);
  if(rdev_fd == -1) 
  {
    connected = 0;
    perror("R*: open_port: Unable to open serial Port - ");
  } 
  else
  {
#if 0
    fcntl(rdev_fd, F_SETFL, O_NONBLOCK);
#endif
    //Set 8N1 by default on open
    //Set Baud to 115200 by default;
    tcgetattr(rdev_fd, &options);
    options.c_lflag = 0;
    options.c_iflag = 0;
    options.c_oflag = 0;
    options.c_cc[VMIN] = 1;
    options.c_cc[VTIME] = 0;

    options.c_cflag = CS8 | CREAD | CLOCAL;
#if 0
    cfmakeraw(&options);
/*#else*/
    /* from glibc 2.3.2 */
    options.c_iflag &= ~(IGNBRK|BRKINT|PARMRK|ISTRIP|INLCR|IGNCR|ICRNL|IXON);
    options.c_oflag &= ~OPOST;
    options.c_lflag &= ~(ECHO|ECHONL|ICANON|ISIG|IEXTEN);
    options.c_cflag &= ~(CSIZE|PARENB);
    options.c_cflag |= CS8;
    options.c_cc[VMIN] = 1;            /* read returns when one char is available.  */
    options.c_cc[VTIME] = 0;
#endif

    cfsetispeed(&options, B115200);
    cfsetospeed(&options, B115200);
    tcsetattr(rdev_fd, TCSANOW, &options);
  }
  free(dev_name);

}

//---------------------------------------------------------------------------
// Host Support Function - Retrieve address from open command:
// From Basic: OPEN #1,8,23,"R:jybolac.homelinux.com"
// Returns:    "jybolac.homelinux.com"
//---------------------------------------------------------------------------
void Device_GetInetAddress(void)
{
  int bufadr;
  int offset;
  int devnam;

  offset = 0;
  devnam = TRUE;
  bufadr = (dGetByte(ICBAHZ) << 8) | dGetByte(ICBALZ);

  while (Device_isvalid(dGetByte(bufadr)))
  {
    int byte = dGetByte(bufadr);

    if (!devnam)
    {
      if (isupper(byte))
        byte = tolower(byte);

      inetaddress[offset++] = byte;
    }
    else if (byte == ':')
      devnam = FALSE;

    bufadr++;
  }

  inetaddress[offset++] = '\0';
}


//---------------------------------------------------------------------------
// R Device OPEN vector - called from Atari OS Device Handler Address Table
//---------------------------------------------------------------------------
void Device_ROPEN(void)
{
  int  port;
  int  direction;
  int  devnum;

  regA = 1;
  regY = 1;
  ClrN;

  bufend = 0;

  port = Peek(ICAX2Z);
  direction = Peek(ICAX1Z);
  devnum = dGetByte(ICDNOZ);
  if(direction & 0x04)
  {
    Aprint("R*: Open for Reading...");
  }
  
  if(direction & 0x08) 
  {
    Aprint("R*: Open for Writing...");
    if(r_serial) 
    {
      Aprint("R*: serial mode.");
      open_connection_serial(devnum);
    } 
    else 
    {
      Aprint("R*: Socket mode.");
      Device_GetInetAddress();
      open_connection(inetaddress, port);
    }
  }
  if(direction & 0x01)
  {
    /* Open for concurrent mode */
  }
  
}

//---------------------------------------------------------------------------
// R Device CLOSE vector - called from Atari OS Device Handler Address Table
//---------------------------------------------------------------------------
void Device_RCLOS(void)
{
  regA = 1;
  regY = 1;
  ClrN;
  concurrent = 0;
  bufend = 0;
  close(rdev_fd);
}

//---------------------------------------------------------------------------
// R Device READ vector - called from Atari OS Device Handler Address Table
//---------------------------------------------------------------------------
void Device_RREAD(void)
{
  int j;

  //bufend = Peek(747);
  //printf("Bufend = %d.\n", bufend);

//  if(bufend >= 0)
//  {
    if(translation)
    {
      if(bufout[0] == 0x0d)
      {
        regA = 0x9b;
      }
    }
    else
    {
      regA = bufout[0];
    }

    bufend--;

    for(j = 0; j <= bufend; j++)
    {
      bufout[j] = bufout[j+1];
    }

    //Cycle the buffer again to skip over linefeed....
    if(translation && linefeeds && (bufout[0] == 0x0a))
    {
      for(j = 0; j <= bufend; j++)
      {
        bufout[j] = bufout[j+1];
      }
    }
    /*return; ???*/
//  }

  regY = 1;
  ClrN;
}



//---------------------------------------------------------------------------
// R Device WRITE vector - called from Atari OS Device Handler Address Table
//---------------------------------------------------------------------------
void Device_RWRIT(void)
{
  int port;
  unsigned char out_char;

  regY = 1;
  ClrN;

  //bufend = Peek(747);

  /* Translation mode */
  if(translation)
  {
    if(regA == 0x9b)
    {
      out_char = 0x0d;
      if(linefeeds)
      {
        if((r_serial == 0) && (connected == 0)) 
        { /* local echo */
          bufend++;
          bufout[bufend-1] = out_char;
          bufout[bufend] = 0;

          command_end = 0;
          command_buf[command_end] = 0;
          strcat(bufout, "OK\r\n");
          bufend += 4;

        } 
        else 
        {
          write(rdev_fd, &out_char, 1); // Write return
        }
        out_char = 0x0a;  //set char for line feed to be output later....
      }
    }
  }
  else 
  {
    out_char = regA;
  }

  /* Translate the CR to a LF for telnet, ftp, etc */
  if(connected && trans_cr && (out_char == 0x0d))
  {
    out_char = 0x0a;
  }

  //if((r_serial == 0) && (out_char == 255))
  //{
  //  Aprint("R: Writing IAC...");
  //  retval = write(rdev_fd, &out_char, 1); /* IAC escape sequence */
  //}
  //if(retval == -1)

  if((r_serial == 0) && (connected == 0)) 
  { /* Local echo - only do if in socket mode */
    bufend++;
    bufout[bufend-1] = out_char;
    bufout[bufend] = 0;

    // Grab Command
    if((out_char == 0x9b) || (out_char == 0x0d)) 
    { //process command with a return/enter
      command_end = 0;

      //Make out going connection command 'ATDI'
      if((command_buf[0] == 'A') && (command_buf[1] == 'T') && (command_buf[2] == 'D') && (command_buf[3] == 'I'))
      {
        //Aprint(command_buf);
        if(strchr(command_buf, ' ') != NULL) 
        {
          if(strrchr(command_buf, ' ') != strchr(command_buf, ' '))
          {
            port = atoi((char *)(strrchr(command_buf, ' ')+1));
            * strrchr(command_buf, ' ') = '\0'; //zero last space in line
          }
          else 
          {
            port = 23;
          }
          open_connection((char *)(strchr(command_buf, ' ')+1), port); //send string after first space in line
        }
        command_buf[command_end] = 0;
        strcat(bufout, "OK\r\n");
        bufend += 4;
      //Change translation command 'ATDL'
      } 
      else if((command_buf[0] == 'A') && (command_buf[1] == 'T') && (command_buf[2] == 'D') && (command_buf[3] == 'L')) 
      {
        trans_cr = (trans_cr + 1) % 2;

        command_buf[command_end] = 0;
        strcat(bufout, "OK\r\n");
        bufend += 4;
      }
    } 
    else 
    {
      if(((out_char == 0x7f) || (out_char == 0x08)) && (command_end > 0)) 
      {
        command_end--; /* backspace */
        command_buf[command_end] = 0;
      }
      else
      {
        command_buf[command_end] = out_char;
        command_buf[command_end+1] = 0;
        command_end = (command_end + 1) % 256;
      }
    }
  }
  else if((connected) && (write(rdev_fd, &out_char, 1) < 1)) 
  { /* returns -1 if disconnected or 0 if could not send */
    perror("write");
    Aprint("R*: ERROR on write.");
    SetN;
    regY = 135;
    //bufend = 13; /* To catch NO CARRIER message */
  }


  regA = 1;
}

//---------------------------------------------------------------------------
// R Device GET STATUS vector - called from Device Handler Address Table
//---------------------------------------------------------------------------
void Device_RSTAT(void)
{
  int len;
  int bytesread;
  unsigned char one;
  int devnum;
  int on;
  unsigned char telnet_command[2];
  //static char IACctr = 0;
  on = 1;

  if(Peek(764) == 1) 
  { /* Hack for Ice-T Terminal program to work! */
    Poke(764, 255);
  }
  devnum = dGetByte(ICDNOZ);

  if(connected == 0)
  {
    if(r_serial == 0)
    {
      if(do_once == 0)
      {

        //strcpy(PORT,"23\n");
        //strcpy(PORT,"8000\n");
        //sprintf(PORT, "%d", 8000 + devnum);
        portnum = portnum + devnum - 1;
        
        /* Set up the listening port. */
        do_once = 1;
        memset ( &in, 0, sizeof ( struct sockaddr_in ) );
        sock = socket ( AF_INET, SOCK_STREAM, 0 );
        in.sin_family = AF_INET;
        in.sin_addr.s_addr = INADDR_ANY;
        //in.sin_port = htons ( atoi ( PORT ) );
        in.sin_port = htons (portnum);
        setsockopt(sock, SOL_SOCKET, SO_REUSEADDR, &on, sizeof(on) ); // cmartin
        if(bind ( sock, (struct sockaddr *)&in, sizeof ( struct sockaddr_in ) ) < 0) perror("bind");
        listen ( sock, 5 );
        /* sethostent(1); */
        retval = fcntl( sock, F_SETFL, O_NONBLOCK);
        len = sizeof ( struct sockaddr_in );
        //bufend = 0;
        sprintf(MESSAGE, "R%d: Listening on port %d...", devnum, portnum);
        Aprint(MESSAGE);
      }

      rdev_fd = accept ( sock, (struct sockaddr *)&peer_in, &len );
      if(rdev_fd != -1)
      {
        struct hostent *host;
        if (getpeername(rdev_fd, (struct sockaddr *) &peer_in, &len) < 0)
        {
          perror("getpeername");
        }
        else
        {
          sprintf(MESSAGE, "R%d: Serving Connection from %s...", devnum, inet_ntoa(peer_in.sin_addr));
          if ((host = gethostbyaddr((char *) &peer_in.sin_addr, sizeof peer_in.sin_addr, AF_INET)) == NULL)
          {
            //perror("gethostbyaddr");
            //Aprint("Connected.");
          } else {
            sprintf(MESSAGE, "R%d: Serving Connection from %s.", devnum, host->h_name);
          }
        }
        Aprint(MESSAGE);
        signal(SIGPIPE, catch_disconnect); //Need to see if the other end disconnects...
        signal(SIGHUP, catch_disconnect); //Need to see if the other end disconnects...
        retval = fcntl( rdev_fd, F_SETFL, O_NONBLOCK);

        /* Telnet negotiation */
        sprintf(MESSAGE, "%c%c%c%c%c%c%c%c%c", 0xff, 0xfb, 0x01, 0xff, 0xfb, 0x03, 0xff, 0xfd, 0x0f3);
        write(rdev_fd, MESSAGE, 9);
        Aprint("R*: Negotiating Terminal Options...");

        connected = 1;
  /*
        retval = write(rdev_fd, &IACdoBinary, 3);
        retval = write(rdev_fd, &IACwillBinary, 3);
        retval = write(rdev_fd, &IACdontLinemode, 3);
        retval = write(rdev_fd, &IACwontLinemode, 3);
  */


        bufout[0] = 0;
        strcat(bufout, CONNECT_STRING);
        bufend = strlen(CONNECT_STRING);
        close(sock);
      }
    }
  }
  else
  {
    /* Actually reading and setting the Atari input buffer here */
    if(concurrent)
    {
      bytesread = read(rdev_fd, &one, 1);
      if(bytesread > 0)
      {
        if((r_serial == 0) && (one == 0xff))
        {
          /* Start Telnet escape seq processing... */
          while(read(rdev_fd, telnet_command,2) != 2) {};

          //sprintf(MESSAGE, "Telnet Command = 0x%x 0x%x", telnet_command[0], telnet_command[1]);
          //Aprint(MESSAGE);
          if(telnet_command[0] ==  0xfd) 
          { //DO
            if((telnet_command[1] == 0x01) || (telnet_command[1] == 0x03))
            { /* WILL ECHO and GO AHEAD (char mode) */
              telnet_command[0] = 0xfb; // WILL
            } 
            else 
            {
              telnet_command[0] = 0xfc; // WONT
            }
          }
          else if(telnet_command[0] == 0xfb)
          { //WILL
            //telnet_command[0] = 0xfd; //DO
            telnet_command[0] = 0xfe; //DONT
          } 
          else if(telnet_command[0] == 0xfe)
          { //DONT
            telnet_command[0] = 0xfc;
          } 
          else if(telnet_command[0] == 0xfc)
          { //WONT
            telnet_command[0] = 0xfe;
          }

          if(telnet_command[0] == 0xfa) 
          { /* subnegotiation */
            while(read(rdev_fd, &one, 1) != 1) {};
            
            while(one != 0xf0) 
            { /* wait for end of sub negotiation */
              while(read(rdev_fd, &one, 1) != 1) {};
            }
          } 
          else 
          {
            write(rdev_fd, &one, 1);
            write(rdev_fd, telnet_command, 2);
          }
        }
        else
        {
          bufend++;
          bufout[bufend-1] = one;
          bufout[bufend] = 0;
          //return;
        }
      }

    }
  }


  // Set all values at all memory locations we modify on exit
  Poke(746,0);
  Poke(748,0);
  Poke(749,0);
  regA = 1;
  regY = 1;
  ClrN;

  if(concurrent) 
  {
    Poke(747,bufend);
  }
  else
  {
    Aprint("R*: Not in concurrent mode....");
    //Poke(747,8);
    Poke(747,(12+48+192)); // Write 0xfc to address 747

  }
}

//---------------------------------------------------------------------------
// R Device SPECIAL vector - called from Atari OS Device Handler Address Table
//---------------------------------------------------------------------------
void Device_RSPEC(void)
{
  int iccom;

  iccom = Peek(ICCOMZ);
  sprintf(MESSAGE, "R*: XIO %d", iccom);
  Aprint(MESSAGE);

/*
  Aprint("ICCOMZ =");
  Aprint("%d",iccom);
  Aprint("^^ in ICCOMZ");
*/

  switch (iccom)
  {
    case 32: //Force Short Block
      break;
    case 34:
      xio_34();
      break;
    case 36:
      xio_36();
      break;
    case 38:
      xio_38();
      break;
    case 40:
      xio_40();
      break;
    default:
      Aprint("R*: Unsupported XIO #.");
      break;
  }
/*
  regA = 1;
  regY = 1;
  ClrN;
*/

}

//---------------------------------------------------------------------------
// R Device INIT vector - called from Atari OS Device Handler Address Table
//---------------------------------------------------------------------------
void Device_RINIT(void)
{
  Aprint("R*: INIT");
  regA = 1;
  regY = 1;
  ClrN;
}