URL
https://opencores.org/ocsvn/openrisc_2011-10-31/openrisc_2011-10-31/trunk
Subversion Repositories openrisc_2011-10-31
[/] [openrisc/] [trunk/] [or1ksim/] [peripheral/] [channels/] [tty.c] - Rev 509
Go to most recent revision | Compare with Previous | Blame | View Log
/* tty.c -- Definition of functions for peripheral to * communicate with host via a tty. 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 Or1ksim, the 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 */ #include <stdlib.h> #include <unistd.h> #include <termios.h> #include <stdio.h> #include <fcntl.h> /* Package includes */ #include "channel.h" #include "generic.h" #include "fd.h" /* Default parameters if not specified in config file */ #define DEFAULT_BAUD B19200 #define DEFAULT_TTY_DEVICE "/dev/ttyS0" /*! Data structure representing a TTY channel */ struct tty_channel { struct fd_channel fds; }; /*! Table of Baud rates */ static const struct { char *name; int value; } baud_table[] = { { "50", B50}, { "2400", B2400}, { "4800", B4800}, { "9600", B9600}, { "19200", B19200}, { "38400", B38400}, { "115200", B115200}, { "230400", B230400}, { 0, 0} }; /* Forward declaration of static functions */ static void *tty_init (const char *input); static int tty_open (void *data); /*! Global data structure representing the operations on a TTY channel */ struct channel_ops tty_channel_ops = { .init = tty_init, .open = tty_open, .close = generic_close, .read = fd_read, .write = fd_write, .free = generic_free, }; /* Convert baud rate string to termio baud rate constant */ static int parse_baud (char *baud_string) { int i; for (i = 0; baud_table[i].name; i++) { if (!strcmp (baud_table[i].name, baud_string)) return baud_table[i].value; } fprintf (stderr, "Error: unknown baud rate: %s\n", baud_string); fprintf (stderr, " Known baud rates: "); for (i = 0; baud_table[i].name; i++) { fprintf (stderr, "%s%s", baud_table[i].name, baud_table[i + 1].name ? ", " : "\n"); } return B0; } static void * tty_init (const char *input) { int fd = 0, baud; char *param_name, *param_value, *device; struct termios options; struct tty_channel *channel; channel = (struct tty_channel *) malloc (sizeof (struct tty_channel)); if (!channel) return NULL; /* Make a copy of config string, because we're about to mutate it */ input = strdup (input); if (!input) goto error; baud = DEFAULT_BAUD; device = DEFAULT_TTY_DEVICE; /* Parse command-line parameters Command line looks like name1=value1,name2,name3=value3,... */ while ((param_name = strtok ((char *) input, ","))) { input = NULL; /* Parse a parameter's name and value */ param_value = strchr (param_name, '='); if (param_value != NULL) { *param_value = '\0'; param_value++; /* Advance past '=' character */ } if (!strcmp (param_name, "baud") && param_value) { baud = parse_baud (param_value); if (baud == B0) { goto error; } } else if (!strcmp (param_name, "device")) { device = param_value; } else { fprintf (stderr, "error: unknown tty channel parameter \"%s\"\n", param_name); goto error; } } fd = open (device, O_RDWR); if (fd < 0) goto error; /* Get the current options for the port... */ if (tcgetattr (fd, &options) < 0) goto error; /* Set the serial baud rate */ cfsetispeed (&options, baud); cfsetospeed (&options, baud); /* Enable the receiver and set local mode... */ /* cfmakeraw(&options); * * cygwin lacks cfmakeraw(), just do it explicitly */ 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_cflag |= (CLOCAL | CREAD); /* Set the new options for the port... */ if (tcsetattr (fd, TCSANOW, &options) < 0) goto error; channel->fds.fdin = channel->fds.fdout = fd; free ((void *) input); return channel; error: if (fd > 0) close (fd); free (channel); if (input) free ((void *) input); return NULL; } static int tty_open (void *data) { return 0; }
Go to most recent revision | Compare with Previous | Blame | View Log