![Sachin Kamat](/assets/img/avatar_default.png)
0 should not be used instead of NULL for pointers. Signed-off-by: Sachin Kamat <sachin.kamat@linaro.org> Cc: Lidza Louina <lidza.louina@gmail.com> Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
3581 lines
83 KiB
C
3581 lines
83 KiB
C
/*
|
|
* Copyright 2003 Digi International (www.digi.com)
|
|
* Scott H Kilau <Scott_Kilau at digi dot com>
|
|
*
|
|
* 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 2, or (at your option)
|
|
* any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY, EXPRESS OR IMPLIED; 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, write to the Free Software
|
|
* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
|
|
*
|
|
*
|
|
* NOTE TO LINUX KERNEL HACKERS: DO NOT REFORMAT THIS CODE!
|
|
*
|
|
* This is shared code between Digi's CVS archive and the
|
|
* Linux Kernel sources.
|
|
* Changing the source just for reformatting needlessly breaks
|
|
* our CVS diff history.
|
|
*
|
|
* Send any bug fixes/changes to: Eng.Linux at digi dot com.
|
|
* Thank you.
|
|
*/
|
|
|
|
/************************************************************************
|
|
*
|
|
* This file implements the tty driver functionality for the
|
|
* FEP5 based product lines.
|
|
*
|
|
************************************************************************
|
|
*
|
|
* $Id: dgap_tty.c,v 1.3 2011/06/23 12:11:31 markh Exp $
|
|
*/
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/version.h>
|
|
#include <linux/sched.h> /* For jiffies, task states */
|
|
#include <linux/interrupt.h> /* For tasklet and interrupt structs/defines */
|
|
#include <linux/module.h>
|
|
#include <linux/ctype.h>
|
|
#include <linux/tty.h>
|
|
#include <linux/tty_flip.h>
|
|
#include <linux/serial_reg.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/delay.h> /* For udelay */
|
|
#include <asm/uaccess.h> /* For copy_from_user/copy_to_user */
|
|
#include <asm/io.h> /* For read[bwl]/write[bwl] */
|
|
#include <linux/pci.h>
|
|
|
|
#include "dgap_driver.h"
|
|
#include "dgap_tty.h"
|
|
#include "dgap_types.h"
|
|
#include "dgap_fep5.h"
|
|
#include "dgap_parse.h"
|
|
#include "dgap_conf.h"
|
|
#include "dgap_sysfs.h"
|
|
|
|
#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)
|
|
#define init_MUTEX(sem) sema_init(sem, 1)
|
|
#define DECLARE_MUTEX(name) \
|
|
struct semaphore name = __SEMAPHORE_INITIALIZER(name, 1)
|
|
#endif
|
|
|
|
/*
|
|
* internal variables
|
|
*/
|
|
static struct board_t *dgap_BoardsByMajor[256];
|
|
static uchar *dgap_TmpWriteBuf = NULL;
|
|
static DECLARE_MUTEX(dgap_TmpWriteSem);
|
|
|
|
/*
|
|
* Default transparent print information.
|
|
*/
|
|
static struct digi_t dgap_digi_init = {
|
|
.digi_flags = DIGI_COOK, /* Flags */
|
|
.digi_maxcps = 100, /* Max CPS */
|
|
.digi_maxchar = 50, /* Max chars in print queue */
|
|
.digi_bufsize = 100, /* Printer buffer size */
|
|
.digi_onlen = 4, /* size of printer on string */
|
|
.digi_offlen = 4, /* size of printer off string */
|
|
.digi_onstr = "\033[5i", /* ANSI printer on string ] */
|
|
.digi_offstr = "\033[4i", /* ANSI printer off string ] */
|
|
.digi_term = "ansi" /* default terminal type */
|
|
};
|
|
|
|
|
|
/*
|
|
* Define a local default termios struct. All ports will be created
|
|
* with this termios initially.
|
|
*
|
|
* This defines a raw port at 9600 baud, 8 data bits, no parity,
|
|
* 1 stop bit.
|
|
*/
|
|
|
|
static struct ktermios DgapDefaultTermios =
|
|
{
|
|
.c_iflag = (DEFAULT_IFLAGS), /* iflags */
|
|
.c_oflag = (DEFAULT_OFLAGS), /* oflags */
|
|
.c_cflag = (DEFAULT_CFLAGS), /* cflags */
|
|
.c_lflag = (DEFAULT_LFLAGS), /* lflags */
|
|
.c_cc = INIT_C_CC,
|
|
.c_line = 0,
|
|
};
|
|
|
|
/* Our function prototypes */
|
|
static int dgap_tty_open(struct tty_struct *tty, struct file *file);
|
|
static void dgap_tty_close(struct tty_struct *tty, struct file *file);
|
|
static int dgap_block_til_ready(struct tty_struct *tty, struct file *file, struct channel_t *ch);
|
|
static int dgap_tty_ioctl(struct tty_struct *tty, unsigned int cmd, unsigned long arg);
|
|
static int dgap_tty_digigeta(struct tty_struct *tty, struct digi_t __user *retinfo);
|
|
static int dgap_tty_digiseta(struct tty_struct *tty, struct digi_t __user *new_info);
|
|
static int dgap_tty_digigetedelay(struct tty_struct *tty, int __user *retinfo);
|
|
static int dgap_tty_digisetedelay(struct tty_struct *tty, int __user *new_info);
|
|
static int dgap_tty_write_room(struct tty_struct* tty);
|
|
static int dgap_tty_chars_in_buffer(struct tty_struct* tty);
|
|
static void dgap_tty_start(struct tty_struct *tty);
|
|
static void dgap_tty_stop(struct tty_struct *tty);
|
|
static void dgap_tty_throttle(struct tty_struct *tty);
|
|
static void dgap_tty_unthrottle(struct tty_struct *tty);
|
|
static void dgap_tty_flush_chars(struct tty_struct *tty);
|
|
static void dgap_tty_flush_buffer(struct tty_struct *tty);
|
|
static void dgap_tty_hangup(struct tty_struct *tty);
|
|
static int dgap_wait_for_drain(struct tty_struct *tty);
|
|
static int dgap_set_modem_info(struct tty_struct *tty, unsigned int command, unsigned int __user *value);
|
|
static int dgap_get_modem_info(struct channel_t *ch, unsigned int __user *value);
|
|
static int dgap_tty_digisetcustombaud(struct tty_struct *tty, int __user *new_info);
|
|
static int dgap_tty_digigetcustombaud(struct tty_struct *tty, int __user *retinfo);
|
|
#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,39)
|
|
static int dgap_tty_tiocmget(struct tty_struct *tty);
|
|
static int dgap_tty_tiocmset(struct tty_struct *tty, unsigned int set, unsigned int clear);
|
|
#else
|
|
static int dgap_tty_tiocmget(struct tty_struct *tty, struct file *file);
|
|
static int dgap_tty_tiocmset(struct tty_struct *tty, struct file *file, unsigned int set, unsigned int clear);
|
|
#endif
|
|
static int dgap_tty_send_break(struct tty_struct *tty, int msec);
|
|
static void dgap_tty_wait_until_sent(struct tty_struct *tty, int timeout);
|
|
static int dgap_tty_write(struct tty_struct *tty, const unsigned char *buf, int count);
|
|
static void dgap_tty_set_termios(struct tty_struct *tty, struct ktermios *old_termios);
|
|
static int dgap_tty_put_char(struct tty_struct *tty, unsigned char c);
|
|
static void dgap_tty_send_xchar(struct tty_struct *tty, char ch);
|
|
|
|
static const struct tty_operations dgap_tty_ops = {
|
|
.open = dgap_tty_open,
|
|
.close = dgap_tty_close,
|
|
.write = dgap_tty_write,
|
|
.write_room = dgap_tty_write_room,
|
|
.flush_buffer = dgap_tty_flush_buffer,
|
|
.chars_in_buffer = dgap_tty_chars_in_buffer,
|
|
.flush_chars = dgap_tty_flush_chars,
|
|
.ioctl = dgap_tty_ioctl,
|
|
.set_termios = dgap_tty_set_termios,
|
|
.stop = dgap_tty_stop,
|
|
.start = dgap_tty_start,
|
|
.throttle = dgap_tty_throttle,
|
|
.unthrottle = dgap_tty_unthrottle,
|
|
.hangup = dgap_tty_hangup,
|
|
.put_char = dgap_tty_put_char,
|
|
.tiocmget = dgap_tty_tiocmget,
|
|
.tiocmset = dgap_tty_tiocmset,
|
|
.break_ctl = dgap_tty_send_break,
|
|
.wait_until_sent = dgap_tty_wait_until_sent,
|
|
.send_xchar = dgap_tty_send_xchar
|
|
};
|
|
|
|
|
|
|
|
|
|
|
|
/************************************************************************
|
|
*
|
|
* TTY Initialization/Cleanup Functions
|
|
*
|
|
************************************************************************/
|
|
|
|
/*
|
|
* dgap_tty_preinit()
|
|
*
|
|
* Initialize any global tty related data before we download any boards.
|
|
*/
|
|
int dgap_tty_preinit(void)
|
|
{
|
|
unsigned long flags;
|
|
|
|
DGAP_LOCK(dgap_global_lock, flags);
|
|
|
|
/*
|
|
* Allocate a buffer for doing the copy from user space to
|
|
* kernel space in dgap_input(). We only use one buffer and
|
|
* control access to it with a semaphore. If we are paging, we
|
|
* are already in trouble so one buffer won't hurt much anyway.
|
|
*/
|
|
dgap_TmpWriteBuf = kmalloc(WRITEBUFLEN, GFP_ATOMIC);
|
|
|
|
if (!dgap_TmpWriteBuf) {
|
|
DGAP_UNLOCK(dgap_global_lock, flags);
|
|
DPR_INIT(("unable to allocate tmp write buf"));
|
|
return (-ENOMEM);
|
|
}
|
|
|
|
DGAP_UNLOCK(dgap_global_lock, flags);
|
|
return(0);
|
|
}
|
|
|
|
|
|
/*
|
|
* dgap_tty_register()
|
|
*
|
|
* Init the tty subsystem for this board.
|
|
*/
|
|
int dgap_tty_register(struct board_t *brd)
|
|
{
|
|
int rc = 0;
|
|
|
|
DPR_INIT(("tty_register start"));
|
|
|
|
brd->SerialDriver = alloc_tty_driver(MAXPORTS);
|
|
|
|
snprintf(brd->SerialName, MAXTTYNAMELEN, "tty_dgap_%d_", brd->boardnum);
|
|
brd->SerialDriver->name = brd->SerialName;
|
|
brd->SerialDriver->name_base = 0;
|
|
brd->SerialDriver->major = 0;
|
|
brd->SerialDriver->minor_start = 0;
|
|
brd->SerialDriver->type = TTY_DRIVER_TYPE_SERIAL;
|
|
brd->SerialDriver->subtype = SERIAL_TYPE_NORMAL;
|
|
brd->SerialDriver->init_termios = DgapDefaultTermios;
|
|
brd->SerialDriver->driver_name = DRVSTR;
|
|
brd->SerialDriver->flags = (TTY_DRIVER_REAL_RAW | TTY_DRIVER_DYNAMIC_DEV | TTY_DRIVER_HARDWARE_BREAK);
|
|
|
|
/* The kernel wants space to store pointers to tty_structs */
|
|
brd->SerialDriver->ttys = dgap_driver_kzmalloc(MAXPORTS * sizeof(struct tty_struct *), GFP_KERNEL);
|
|
if (!brd->SerialDriver->ttys)
|
|
return(-ENOMEM);
|
|
|
|
#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,28)
|
|
brd->SerialDriver->refcount = brd->TtyRefCnt;
|
|
#endif
|
|
|
|
/*
|
|
* Entry points for driver. Called by the kernel from
|
|
* tty_io.c and n_tty.c.
|
|
*/
|
|
tty_set_operations(brd->SerialDriver, &dgap_tty_ops);
|
|
|
|
/*
|
|
* If we're doing transparent print, we have to do all of the above
|
|
* again, separately so we don't get the LD confused about what major
|
|
* we are when we get into the dgap_tty_open() routine.
|
|
*/
|
|
brd->PrintDriver = alloc_tty_driver(MAXPORTS);
|
|
|
|
snprintf(brd->PrintName, MAXTTYNAMELEN, "pr_dgap_%d_", brd->boardnum);
|
|
brd->PrintDriver->name = brd->PrintName;
|
|
brd->PrintDriver->name_base = 0;
|
|
brd->PrintDriver->major = 0;
|
|
brd->PrintDriver->minor_start = 0;
|
|
brd->PrintDriver->type = TTY_DRIVER_TYPE_SERIAL;
|
|
brd->PrintDriver->subtype = SERIAL_TYPE_NORMAL;
|
|
brd->PrintDriver->init_termios = DgapDefaultTermios;
|
|
brd->PrintDriver->driver_name = DRVSTR;
|
|
brd->PrintDriver->flags = (TTY_DRIVER_REAL_RAW | TTY_DRIVER_DYNAMIC_DEV | TTY_DRIVER_HARDWARE_BREAK);
|
|
|
|
/* The kernel wants space to store pointers to tty_structs */
|
|
brd->PrintDriver->ttys = dgap_driver_kzmalloc(MAXPORTS * sizeof(struct tty_struct *), GFP_KERNEL);
|
|
if (!brd->PrintDriver->ttys)
|
|
return(-ENOMEM);
|
|
|
|
#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,28)
|
|
brd->PrintDriver->refcount = brd->TtyRefCnt;
|
|
#endif
|
|
|
|
/*
|
|
* Entry points for driver. Called by the kernel from
|
|
* tty_io.c and n_tty.c.
|
|
*/
|
|
tty_set_operations(brd->PrintDriver, &dgap_tty_ops);
|
|
|
|
if (!brd->dgap_Major_Serial_Registered) {
|
|
/* Register tty devices */
|
|
rc = tty_register_driver(brd->SerialDriver);
|
|
if (rc < 0) {
|
|
APR(("Can't register tty device (%d)\n", rc));
|
|
return(rc);
|
|
}
|
|
brd->dgap_Major_Serial_Registered = TRUE;
|
|
dgap_BoardsByMajor[brd->SerialDriver->major] = brd;
|
|
brd->dgap_Serial_Major = brd->SerialDriver->major;
|
|
}
|
|
|
|
if (!brd->dgap_Major_TransparentPrint_Registered) {
|
|
/* Register Transparent Print devices */
|
|
rc = tty_register_driver(brd->PrintDriver);
|
|
if (rc < 0) {
|
|
APR(("Can't register Transparent Print device (%d)\n", rc));
|
|
return(rc);
|
|
}
|
|
brd->dgap_Major_TransparentPrint_Registered = TRUE;
|
|
dgap_BoardsByMajor[brd->PrintDriver->major] = brd;
|
|
brd->dgap_TransparentPrint_Major = brd->PrintDriver->major;
|
|
}
|
|
|
|
DPR_INIT(("DGAP REGISTER TTY: MAJORS: %d %d\n", brd->SerialDriver->major,
|
|
brd->PrintDriver->major));
|
|
|
|
return (rc);
|
|
}
|
|
|
|
|
|
/*
|
|
* dgap_tty_init()
|
|
*
|
|
* Init the tty subsystem. Called once per board after board has been
|
|
* downloaded and init'ed.
|
|
*/
|
|
int dgap_tty_init(struct board_t *brd)
|
|
{
|
|
int i;
|
|
int tlw;
|
|
uint true_count = 0;
|
|
uchar *vaddr;
|
|
uchar modem = 0;
|
|
struct channel_t *ch;
|
|
struct bs_t *bs;
|
|
struct cm_t *cm;
|
|
|
|
if (!brd)
|
|
return (-ENXIO);
|
|
|
|
DPR_INIT(("dgap_tty_init start\n"));
|
|
|
|
/*
|
|
* Initialize board structure elements.
|
|
*/
|
|
|
|
vaddr = brd->re_map_membase;
|
|
true_count = readw((vaddr + NCHAN));
|
|
|
|
brd->nasync = dgap_config_get_number_of_ports(brd);
|
|
|
|
if (!brd->nasync) {
|
|
brd->nasync = brd->maxports;
|
|
}
|
|
|
|
if (brd->nasync > brd->maxports) {
|
|
brd->nasync = brd->maxports;
|
|
}
|
|
|
|
if (true_count != brd->nasync) {
|
|
if ((brd->type == PPCM) && (true_count == 64)) {
|
|
APR(("***WARNING**** %s configured for %d ports, has %d ports.\nPlease make SURE the EBI cable running from the card\nto each EM module is plugged into EBI IN!\n",
|
|
brd->name, brd->nasync, true_count));
|
|
}
|
|
else if ((brd->type == PPCM) && (true_count == 0)) {
|
|
APR(("***WARNING**** %s configured for %d ports, has %d ports.\nPlease make SURE the EBI cable running from the card\nto each EM module is plugged into EBI IN!\n",
|
|
brd->name, brd->nasync, true_count));
|
|
}
|
|
else {
|
|
APR(("***WARNING**** %s configured for %d ports, has %d ports.\n",
|
|
brd->name, brd->nasync, true_count));
|
|
}
|
|
|
|
brd->nasync = true_count;
|
|
|
|
/* If no ports, don't bother going any further */
|
|
if (!brd->nasync) {
|
|
brd->state = BOARD_FAILED;
|
|
brd->dpastatus = BD_NOFEP;
|
|
return(-ENXIO);
|
|
}
|
|
}
|
|
|
|
/*
|
|
* Allocate channel memory that might not have been allocated
|
|
* when the driver was first loaded.
|
|
*/
|
|
for (i = 0; i < brd->nasync; i++) {
|
|
if (!brd->channels[i]) {
|
|
brd->channels[i] = dgap_driver_kzmalloc(sizeof(struct channel_t), GFP_ATOMIC);
|
|
if (!brd->channels[i]) {
|
|
DPR_CORE(("%s:%d Unable to allocate memory for channel struct\n",
|
|
__FILE__, __LINE__));
|
|
}
|
|
}
|
|
}
|
|
|
|
ch = brd->channels[0];
|
|
vaddr = brd->re_map_membase;
|
|
|
|
bs = (struct bs_t *) ((ulong) vaddr + CHANBUF);
|
|
cm = (struct cm_t *) ((ulong) vaddr + CMDBUF);
|
|
|
|
brd->bd_bs = bs;
|
|
|
|
/* Set up channel variables */
|
|
for (i = 0; i < brd->nasync; i++, ch = brd->channels[i], bs++) {
|
|
|
|
if (!brd->channels[i])
|
|
continue;
|
|
|
|
DGAP_SPINLOCK_INIT(ch->ch_lock);
|
|
|
|
/* Store all our magic numbers */
|
|
ch->magic = DGAP_CHANNEL_MAGIC;
|
|
ch->ch_tun.magic = DGAP_UNIT_MAGIC;
|
|
ch->ch_tun.un_type = DGAP_SERIAL;
|
|
ch->ch_tun.un_ch = ch;
|
|
ch->ch_tun.un_dev = i;
|
|
|
|
ch->ch_pun.magic = DGAP_UNIT_MAGIC;
|
|
ch->ch_pun.un_type = DGAP_PRINT;
|
|
ch->ch_pun.un_ch = ch;
|
|
ch->ch_pun.un_dev = i;
|
|
|
|
ch->ch_vaddr = vaddr;
|
|
ch->ch_bs = bs;
|
|
ch->ch_cm = cm;
|
|
ch->ch_bd = brd;
|
|
ch->ch_portnum = i;
|
|
ch->ch_digi = dgap_digi_init;
|
|
|
|
/*
|
|
* Set up digi dsr and dcd bits based on altpin flag.
|
|
*/
|
|
if (dgap_config_get_altpin(brd)) {
|
|
ch->ch_dsr = DM_CD;
|
|
ch->ch_cd = DM_DSR;
|
|
ch->ch_digi.digi_flags |= DIGI_ALTPIN;
|
|
}
|
|
else {
|
|
ch->ch_cd = DM_CD;
|
|
ch->ch_dsr = DM_DSR;
|
|
}
|
|
|
|
ch->ch_taddr = vaddr + ((ch->ch_bs->tx_seg) << 4);
|
|
ch->ch_raddr = vaddr + ((ch->ch_bs->rx_seg) << 4);
|
|
ch->ch_tx_win = 0;
|
|
ch->ch_rx_win = 0;
|
|
ch->ch_tsize = readw(&(ch->ch_bs->tx_max)) + 1;
|
|
ch->ch_rsize = readw(&(ch->ch_bs->rx_max)) + 1;
|
|
ch->ch_tstart = 0;
|
|
ch->ch_rstart = 0;
|
|
|
|
/* .25 second delay */
|
|
ch->ch_close_delay = 250;
|
|
|
|
/*
|
|
* Set queue water marks, interrupt mask,
|
|
* and general tty parameters.
|
|
*/
|
|
ch->ch_tlw = tlw = ch->ch_tsize >= 2000 ? ((ch->ch_tsize * 5) / 8) : ch->ch_tsize / 2;
|
|
|
|
dgap_cmdw(ch, STLOW, tlw, 0);
|
|
|
|
dgap_cmdw(ch, SRLOW, ch->ch_rsize / 2, 0);
|
|
|
|
dgap_cmdw(ch, SRHIGH, 7 * ch->ch_rsize / 8, 0);
|
|
|
|
ch->ch_mistat = readb(&(ch->ch_bs->m_stat));
|
|
|
|
init_waitqueue_head(&ch->ch_flags_wait);
|
|
init_waitqueue_head(&ch->ch_tun.un_flags_wait);
|
|
init_waitqueue_head(&ch->ch_pun.un_flags_wait);
|
|
init_waitqueue_head(&ch->ch_sniff_wait);
|
|
|
|
/* Turn on all modem interrupts for now */
|
|
modem = (DM_CD | DM_DSR | DM_CTS | DM_RI);
|
|
writeb(modem, &(ch->ch_bs->m_int));
|
|
|
|
/*
|
|
* Set edelay to 0 if interrupts are turned on,
|
|
* otherwise set edelay to the usual 100.
|
|
*/
|
|
if (brd->intr_used)
|
|
writew(0, &(ch->ch_bs->edelay));
|
|
else
|
|
writew(100, &(ch->ch_bs->edelay));
|
|
|
|
writeb(1, &(ch->ch_bs->idata));
|
|
}
|
|
|
|
|
|
DPR_INIT(("dgap_tty_init finish\n"));
|
|
|
|
return (0);
|
|
}
|
|
|
|
|
|
/*
|
|
* dgap_tty_post_uninit()
|
|
*
|
|
* UnInitialize any global tty related data.
|
|
*/
|
|
void dgap_tty_post_uninit(void)
|
|
{
|
|
kfree(dgap_TmpWriteBuf);
|
|
dgap_TmpWriteBuf = NULL;
|
|
}
|
|
|
|
|
|
/*
|
|
* dgap_tty_uninit()
|
|
*
|
|
* Uninitialize the TTY portion of this driver. Free all memory and
|
|
* resources.
|
|
*/
|
|
void dgap_tty_uninit(struct board_t *brd)
|
|
{
|
|
int i = 0;
|
|
|
|
if (brd->dgap_Major_Serial_Registered) {
|
|
dgap_BoardsByMajor[brd->SerialDriver->major] = NULL;
|
|
brd->dgap_Serial_Major = 0;
|
|
for (i = 0; i < brd->nasync; i++) {
|
|
dgap_remove_tty_sysfs(brd->channels[i]->ch_tun.un_sysfs);
|
|
tty_unregister_device(brd->SerialDriver, i);
|
|
}
|
|
tty_unregister_driver(brd->SerialDriver);
|
|
kfree(brd->SerialDriver->ttys);
|
|
brd->SerialDriver->ttys = NULL;
|
|
put_tty_driver(brd->SerialDriver);
|
|
brd->dgap_Major_Serial_Registered = FALSE;
|
|
}
|
|
|
|
if (brd->dgap_Major_TransparentPrint_Registered) {
|
|
dgap_BoardsByMajor[brd->PrintDriver->major] = NULL;
|
|
brd->dgap_TransparentPrint_Major = 0;
|
|
for (i = 0; i < brd->nasync; i++) {
|
|
dgap_remove_tty_sysfs(brd->channels[i]->ch_pun.un_sysfs);
|
|
tty_unregister_device(brd->PrintDriver, i);
|
|
}
|
|
tty_unregister_driver(brd->PrintDriver);
|
|
kfree(brd->PrintDriver->ttys);
|
|
brd->PrintDriver->ttys = NULL;
|
|
put_tty_driver(brd->PrintDriver);
|
|
brd->dgap_Major_TransparentPrint_Registered = FALSE;
|
|
}
|
|
}
|
|
|
|
|
|
#define TMPBUFLEN (1024)
|
|
|
|
/*
|
|
* dgap_sniff - Dump data out to the "sniff" buffer if the
|
|
* proc sniff file is opened...
|
|
*/
|
|
static void dgap_sniff_nowait_nolock(struct channel_t *ch, uchar *text, uchar *buf, int len)
|
|
{
|
|
struct timeval tv;
|
|
int n;
|
|
int r;
|
|
int nbuf;
|
|
int i;
|
|
int tmpbuflen;
|
|
char tmpbuf[TMPBUFLEN];
|
|
char *p = tmpbuf;
|
|
int too_much_data;
|
|
|
|
/* Leave if sniff not open */
|
|
if (!(ch->ch_sniff_flags & SNIFF_OPEN))
|
|
return;
|
|
|
|
do_gettimeofday(&tv);
|
|
|
|
/* Create our header for data dump */
|
|
p += sprintf(p, "<%ld %ld><%s><", tv.tv_sec, tv.tv_usec, text);
|
|
tmpbuflen = p - tmpbuf;
|
|
|
|
do {
|
|
too_much_data = 0;
|
|
|
|
for (i = 0; i < len && tmpbuflen < (TMPBUFLEN - 4); i++) {
|
|
p += sprintf(p, "%02x ", *buf);
|
|
buf++;
|
|
tmpbuflen = p - tmpbuf;
|
|
}
|
|
|
|
if (tmpbuflen < (TMPBUFLEN - 4)) {
|
|
if (i > 0)
|
|
p += sprintf(p - 1, "%s\n", ">");
|
|
else
|
|
p += sprintf(p, "%s\n", ">");
|
|
} else {
|
|
too_much_data = 1;
|
|
len -= i;
|
|
}
|
|
|
|
nbuf = strlen(tmpbuf);
|
|
p = tmpbuf;
|
|
|
|
/*
|
|
* Loop while data remains.
|
|
*/
|
|
while (nbuf > 0 && ch->ch_sniff_buf) {
|
|
/*
|
|
* Determine the amount of available space left in the
|
|
* buffer. If there's none, wait until some appears.
|
|
*/
|
|
n = (ch->ch_sniff_out - ch->ch_sniff_in - 1) & SNIFF_MASK;
|
|
|
|
/*
|
|
* If there is no space left to write to in our sniff buffer,
|
|
* we have no choice but to drop the data.
|
|
* We *cannot* sleep here waiting for space, because this
|
|
* function was probably called by the interrupt/timer routines!
|
|
*/
|
|
if (n == 0) {
|
|
return;
|
|
}
|
|
|
|
/*
|
|
* Copy as much data as will fit.
|
|
*/
|
|
|
|
if (n > nbuf)
|
|
n = nbuf;
|
|
|
|
r = SNIFF_MAX - ch->ch_sniff_in;
|
|
|
|
if (r <= n) {
|
|
memcpy(ch->ch_sniff_buf + ch->ch_sniff_in, p, r);
|
|
|
|
n -= r;
|
|
ch->ch_sniff_in = 0;
|
|
p += r;
|
|
nbuf -= r;
|
|
}
|
|
|
|
memcpy(ch->ch_sniff_buf + ch->ch_sniff_in, p, n);
|
|
|
|
ch->ch_sniff_in += n;
|
|
p += n;
|
|
nbuf -= n;
|
|
|
|
/*
|
|
* Wakeup any thread waiting for data
|
|
*/
|
|
if (ch->ch_sniff_flags & SNIFF_WAIT_DATA) {
|
|
ch->ch_sniff_flags &= ~SNIFF_WAIT_DATA;
|
|
wake_up_interruptible(&ch->ch_sniff_wait);
|
|
}
|
|
}
|
|
|
|
/*
|
|
* If the user sent us too much data to push into our tmpbuf,
|
|
* we need to keep looping around on all the data.
|
|
*/
|
|
if (too_much_data) {
|
|
p = tmpbuf;
|
|
tmpbuflen = 0;
|
|
}
|
|
|
|
} while (too_much_data);
|
|
}
|
|
|
|
|
|
/*=======================================================================
|
|
*
|
|
* dgap_input - Process received data.
|
|
*
|
|
* ch - Pointer to channel structure.
|
|
*
|
|
*=======================================================================*/
|
|
|
|
void dgap_input(struct channel_t *ch)
|
|
{
|
|
struct board_t *bd;
|
|
struct bs_t *bs;
|
|
struct tty_struct *tp;
|
|
struct tty_ldisc *ld;
|
|
uint rmask;
|
|
uint head;
|
|
uint tail;
|
|
int data_len;
|
|
ulong lock_flags;
|
|
ulong lock_flags2;
|
|
int flip_len;
|
|
int len = 0;
|
|
int n = 0;
|
|
uchar *buf;
|
|
uchar tmpchar;
|
|
int s = 0;
|
|
|
|
if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
|
|
return;
|
|
|
|
tp = ch->ch_tun.un_tty;
|
|
|
|
bs = ch->ch_bs;
|
|
if (!bs) {
|
|
return;
|
|
}
|
|
|
|
bd = ch->ch_bd;
|
|
if(!bd || bd->magic != DGAP_BOARD_MAGIC)
|
|
return;
|
|
|
|
DPR_READ(("dgap_input start\n"));
|
|
|
|
DGAP_LOCK(bd->bd_lock, lock_flags);
|
|
DGAP_LOCK(ch->ch_lock, lock_flags2);
|
|
|
|
/*
|
|
* Figure the number of characters in the buffer.
|
|
* Exit immediately if none.
|
|
*/
|
|
|
|
rmask = ch->ch_rsize - 1;
|
|
|
|
head = readw(&(bs->rx_head));
|
|
head &= rmask;
|
|
tail = readw(&(bs->rx_tail));
|
|
tail &= rmask;
|
|
|
|
data_len = (head - tail) & rmask;
|
|
|
|
if (data_len == 0) {
|
|
writeb(1, &(bs->idata));
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
DPR_READ(("No data on port %d\n", ch->ch_portnum));
|
|
return;
|
|
}
|
|
|
|
/*
|
|
* If the device is not open, or CREAD is off, flush
|
|
* input data and return immediately.
|
|
*/
|
|
if ((bd->state != BOARD_READY) || !tp || (tp->magic != TTY_MAGIC) ||
|
|
!(ch->ch_tun.un_flags & UN_ISOPEN) || !(tp->termios.c_cflag & CREAD) ||
|
|
(ch->ch_tun.un_flags & UN_CLOSING)) {
|
|
|
|
DPR_READ(("input. dropping %d bytes on port %d...\n", data_len, ch->ch_portnum));
|
|
DPR_READ(("input. tp: %p tp->magic: %x MAGIC:%x ch flags: %x\n",
|
|
tp, tp ? tp->magic : 0, TTY_MAGIC, ch->ch_tun.un_flags));
|
|
writew(head, &(bs->rx_tail));
|
|
writeb(1, &(bs->idata));
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
return;
|
|
}
|
|
|
|
/*
|
|
* If we are throttled, simply don't read any data.
|
|
*/
|
|
if (ch->ch_flags & CH_RXBLOCK) {
|
|
writeb(1, &(bs->idata));
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
DPR_READ(("Port %d throttled, not reading any data. head: %x tail: %x\n",
|
|
ch->ch_portnum, head, tail));
|
|
return;
|
|
}
|
|
|
|
/*
|
|
* Ignore oruns.
|
|
*/
|
|
tmpchar = readb(&(bs->orun));
|
|
if (tmpchar) {
|
|
ch->ch_err_overrun++;
|
|
writeb(0, &(bs->orun));
|
|
}
|
|
|
|
DPR_READ(("dgap_input start 2\n"));
|
|
|
|
/* Decide how much data we can send into the tty layer */
|
|
flip_len = TTY_FLIPBUF_SIZE;
|
|
|
|
/* Chop down the length, if needed */
|
|
len = min(data_len, flip_len);
|
|
len = min(len, (N_TTY_BUF_SIZE - 1));
|
|
|
|
ld = tty_ldisc_ref(tp);
|
|
|
|
#ifdef TTY_DONT_FLIP
|
|
/*
|
|
* If the DONT_FLIP flag is on, don't flush our buffer, and act
|
|
* like the ld doesn't have any space to put the data right now.
|
|
*/
|
|
if (test_bit(TTY_DONT_FLIP, &tp->flags))
|
|
len = 0;
|
|
#endif
|
|
|
|
/*
|
|
* If we were unable to get a reference to the ld,
|
|
* don't flush our buffer, and act like the ld doesn't
|
|
* have any space to put the data right now.
|
|
*/
|
|
if (!ld) {
|
|
len = 0;
|
|
} else {
|
|
/*
|
|
* If ld doesn't have a pointer to a receive_buf function,
|
|
* flush the data, then act like the ld doesn't have any
|
|
* space to put the data right now.
|
|
*/
|
|
if (!ld->ops->receive_buf) {
|
|
writew(head, &(bs->rx_tail));
|
|
len = 0;
|
|
}
|
|
}
|
|
|
|
if (len <= 0) {
|
|
writeb(1, &(bs->idata));
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
DPR_READ(("dgap_input 1 - finish\n"));
|
|
if (ld)
|
|
tty_ldisc_deref(ld);
|
|
return;
|
|
}
|
|
|
|
buf = ch->ch_bd->flipbuf;
|
|
n = len;
|
|
|
|
/*
|
|
* n now contains the most amount of data we can copy,
|
|
* bounded either by our buffer size or the amount
|
|
* of data the card actually has pending...
|
|
*/
|
|
while (n) {
|
|
|
|
s = ((head >= tail) ? head : ch->ch_rsize) - tail;
|
|
s = min(s, n);
|
|
|
|
if (s <= 0)
|
|
break;
|
|
|
|
memcpy_fromio(buf, (char *) ch->ch_raddr + tail, s);
|
|
dgap_sniff_nowait_nolock(ch, "USER READ", buf, s);
|
|
|
|
tail += s;
|
|
buf += s;
|
|
|
|
n -= s;
|
|
/* Flip queue if needed */
|
|
tail &= rmask;
|
|
}
|
|
|
|
writew(tail, &(bs->rx_tail));
|
|
writeb(1, &(bs->idata));
|
|
ch->ch_rxcount += len;
|
|
|
|
/*
|
|
* If we are completely raw, we don't need to go through a lot
|
|
* of the tty layers that exist.
|
|
* In this case, we take the shortest and fastest route we
|
|
* can to relay the data to the user.
|
|
*
|
|
* On the other hand, if we are not raw, we need to go through
|
|
* the tty layer, which has its API more well defined.
|
|
*/
|
|
if (I_PARMRK(tp) || I_BRKINT(tp) || I_INPCK(tp)) {
|
|
dgap_parity_scan(ch, ch->ch_bd->flipbuf, ch->ch_bd->flipflagbuf, &len);
|
|
|
|
len = tty_buffer_request_room(tp->port, len);
|
|
tty_insert_flip_string_flags(tp->port, ch->ch_bd->flipbuf,
|
|
ch->ch_bd->flipflagbuf, len);
|
|
}
|
|
else {
|
|
len = tty_buffer_request_room(tp->port, len);
|
|
tty_insert_flip_string(tp->port, ch->ch_bd->flipbuf, len);
|
|
}
|
|
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
|
|
/* Tell the tty layer its okay to "eat" the data now */
|
|
tty_flip_buffer_push(tp->port);
|
|
|
|
if (ld)
|
|
tty_ldisc_deref(ld);
|
|
|
|
DPR_READ(("dgap_input - finish\n"));
|
|
}
|
|
|
|
|
|
/************************************************************************
|
|
* Determines when CARRIER changes state and takes appropriate
|
|
* action.
|
|
************************************************************************/
|
|
void dgap_carrier(struct channel_t *ch)
|
|
{
|
|
struct board_t *bd;
|
|
|
|
int virt_carrier = 0;
|
|
int phys_carrier = 0;
|
|
|
|
DPR_CARR(("dgap_carrier called...\n"));
|
|
|
|
if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
|
|
return;
|
|
|
|
bd = ch->ch_bd;
|
|
|
|
if (!bd || bd->magic != DGAP_BOARD_MAGIC)
|
|
return;
|
|
|
|
/* Make sure altpin is always set correctly */
|
|
if (ch->ch_digi.digi_flags & DIGI_ALTPIN) {
|
|
ch->ch_dsr = DM_CD;
|
|
ch->ch_cd = DM_DSR;
|
|
}
|
|
else {
|
|
ch->ch_dsr = DM_DSR;
|
|
ch->ch_cd = DM_CD;
|
|
}
|
|
|
|
if (ch->ch_mistat & D_CD(ch)) {
|
|
DPR_CARR(("mistat: %x D_CD: %x\n", ch->ch_mistat, D_CD(ch)));
|
|
phys_carrier = 1;
|
|
}
|
|
|
|
if (ch->ch_digi.digi_flags & DIGI_FORCEDCD) {
|
|
virt_carrier = 1;
|
|
}
|
|
|
|
if (ch->ch_c_cflag & CLOCAL) {
|
|
virt_carrier = 1;
|
|
}
|
|
|
|
|
|
DPR_CARR(("DCD: physical: %d virt: %d\n", phys_carrier, virt_carrier));
|
|
|
|
/*
|
|
* Test for a VIRTUAL carrier transition to HIGH.
|
|
*/
|
|
if (((ch->ch_flags & CH_FCAR) == 0) && (virt_carrier == 1)) {
|
|
|
|
/*
|
|
* When carrier rises, wake any threads waiting
|
|
* for carrier in the open routine.
|
|
*/
|
|
|
|
DPR_CARR(("carrier: virt DCD rose\n"));
|
|
|
|
if (waitqueue_active(&(ch->ch_flags_wait)))
|
|
wake_up_interruptible(&ch->ch_flags_wait);
|
|
}
|
|
|
|
/*
|
|
* Test for a PHYSICAL carrier transition to HIGH.
|
|
*/
|
|
if (((ch->ch_flags & CH_CD) == 0) && (phys_carrier == 1)) {
|
|
|
|
/*
|
|
* When carrier rises, wake any threads waiting
|
|
* for carrier in the open routine.
|
|
*/
|
|
|
|
DPR_CARR(("carrier: physical DCD rose\n"));
|
|
|
|
if (waitqueue_active(&(ch->ch_flags_wait)))
|
|
wake_up_interruptible(&ch->ch_flags_wait);
|
|
}
|
|
|
|
/*
|
|
* Test for a PHYSICAL transition to low, so long as we aren't
|
|
* currently ignoring physical transitions (which is what "virtual
|
|
* carrier" indicates).
|
|
*
|
|
* The transition of the virtual carrier to low really doesn't
|
|
* matter... it really only means "ignore carrier state", not
|
|
* "make pretend that carrier is there".
|
|
*/
|
|
if ((virt_carrier == 0) && ((ch->ch_flags & CH_CD) != 0) &&
|
|
(phys_carrier == 0))
|
|
{
|
|
|
|
/*
|
|
* When carrier drops:
|
|
*
|
|
* Drop carrier on all open units.
|
|
*
|
|
* Flush queues, waking up any task waiting in the
|
|
* line discipline.
|
|
*
|
|
* Send a hangup to the control terminal.
|
|
*
|
|
* Enable all select calls.
|
|
*/
|
|
if (waitqueue_active(&(ch->ch_flags_wait)))
|
|
wake_up_interruptible(&ch->ch_flags_wait);
|
|
|
|
if (ch->ch_tun.un_open_count > 0) {
|
|
DPR_CARR(("Sending tty hangup\n"));
|
|
tty_hangup(ch->ch_tun.un_tty);
|
|
}
|
|
|
|
if (ch->ch_pun.un_open_count > 0) {
|
|
DPR_CARR(("Sending pr hangup\n"));
|
|
tty_hangup(ch->ch_pun.un_tty);
|
|
}
|
|
}
|
|
|
|
/*
|
|
* Make sure that our cached values reflect the current reality.
|
|
*/
|
|
if (virt_carrier == 1)
|
|
ch->ch_flags |= CH_FCAR;
|
|
else
|
|
ch->ch_flags &= ~CH_FCAR;
|
|
|
|
if (phys_carrier == 1)
|
|
ch->ch_flags |= CH_CD;
|
|
else
|
|
ch->ch_flags &= ~CH_CD;
|
|
}
|
|
|
|
|
|
/************************************************************************
|
|
*
|
|
* TTY Entry points and helper functions
|
|
*
|
|
************************************************************************/
|
|
|
|
/*
|
|
* dgap_tty_open()
|
|
*
|
|
*/
|
|
static int dgap_tty_open(struct tty_struct *tty, struct file *file)
|
|
{
|
|
struct board_t *brd;
|
|
struct channel_t *ch;
|
|
struct un_t *un;
|
|
struct bs_t *bs;
|
|
uint major = 0;
|
|
uint minor = 0;
|
|
int rc = 0;
|
|
ulong lock_flags;
|
|
ulong lock_flags2;
|
|
u16 head;
|
|
|
|
rc = 0;
|
|
|
|
major = MAJOR(tty_devnum(tty));
|
|
minor = MINOR(tty_devnum(tty));
|
|
|
|
if (major > 255) {
|
|
return -ENXIO;
|
|
}
|
|
|
|
/* Get board pointer from our array of majors we have allocated */
|
|
brd = dgap_BoardsByMajor[major];
|
|
if (!brd) {
|
|
return -ENXIO;
|
|
}
|
|
|
|
/*
|
|
* If board is not yet up to a state of READY, go to
|
|
* sleep waiting for it to happen or they cancel the open.
|
|
*/
|
|
rc = wait_event_interruptible(brd->state_wait,
|
|
(brd->state & BOARD_READY));
|
|
|
|
if (rc) {
|
|
return rc;
|
|
}
|
|
|
|
DGAP_LOCK(brd->bd_lock, lock_flags);
|
|
|
|
/* The wait above should guarantee this cannot happen */
|
|
if (brd->state != BOARD_READY) {
|
|
DGAP_UNLOCK(brd->bd_lock, lock_flags);
|
|
return -ENXIO;
|
|
}
|
|
|
|
/* If opened device is greater than our number of ports, bail. */
|
|
if (MINOR(tty_devnum(tty)) > brd->nasync) {
|
|
DGAP_UNLOCK(brd->bd_lock, lock_flags);
|
|
return -ENXIO;
|
|
}
|
|
|
|
ch = brd->channels[minor];
|
|
if (!ch) {
|
|
DGAP_UNLOCK(brd->bd_lock, lock_flags);
|
|
return -ENXIO;
|
|
}
|
|
|
|
/* Grab channel lock */
|
|
DGAP_LOCK(ch->ch_lock, lock_flags2);
|
|
|
|
/* Figure out our type */
|
|
if (major == brd->dgap_Serial_Major) {
|
|
un = &brd->channels[minor]->ch_tun;
|
|
un->un_type = DGAP_SERIAL;
|
|
}
|
|
else if (major == brd->dgap_TransparentPrint_Major) {
|
|
un = &brd->channels[minor]->ch_pun;
|
|
un->un_type = DGAP_PRINT;
|
|
}
|
|
else {
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(brd->bd_lock, lock_flags);
|
|
DPR_OPEN(("%d Unknown TYPE!\n", __LINE__));
|
|
return -ENXIO;
|
|
}
|
|
|
|
/* Store our unit into driver_data, so we always have it available. */
|
|
tty->driver_data = un;
|
|
|
|
DPR_OPEN(("Open called. MAJOR: %d MINOR:%d unit: %p NAME: %s\n",
|
|
MAJOR(tty_devnum(tty)), MINOR(tty_devnum(tty)), un, brd->name));
|
|
|
|
/*
|
|
* Error if channel info pointer is NULL.
|
|
*/
|
|
bs = ch->ch_bs;
|
|
if (!bs) {
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(brd->bd_lock, lock_flags);
|
|
DPR_OPEN(("%d BS is 0!\n", __LINE__));
|
|
return -ENXIO;
|
|
}
|
|
|
|
DPR_OPEN(("%d: tflag=%x pflag=%x\n", __LINE__, ch->ch_tun.un_flags, ch->ch_pun.un_flags));
|
|
|
|
/*
|
|
* Initialize tty's
|
|
*/
|
|
if (!(un->un_flags & UN_ISOPEN)) {
|
|
/* Store important variables. */
|
|
un->un_tty = tty;
|
|
|
|
/* Maybe do something here to the TTY struct as well? */
|
|
}
|
|
|
|
/*
|
|
* Initialize if neither terminal or printer is open.
|
|
*/
|
|
if (!((ch->ch_tun.un_flags | ch->ch_pun.un_flags) & UN_ISOPEN)) {
|
|
|
|
DPR_OPEN(("dgap_open: initializing channel in open...\n"));
|
|
|
|
ch->ch_mforce = 0;
|
|
ch->ch_mval = 0;
|
|
|
|
/*
|
|
* Flush input queue.
|
|
*/
|
|
head = readw(&(bs->rx_head));
|
|
writew(head, &(bs->rx_tail));
|
|
|
|
ch->ch_flags = 0;
|
|
ch->pscan_state = 0;
|
|
ch->pscan_savechar = 0;
|
|
|
|
ch->ch_c_cflag = tty->termios.c_cflag;
|
|
ch->ch_c_iflag = tty->termios.c_iflag;
|
|
ch->ch_c_oflag = tty->termios.c_oflag;
|
|
ch->ch_c_lflag = tty->termios.c_lflag;
|
|
ch->ch_startc = tty->termios.c_cc[VSTART];
|
|
ch->ch_stopc = tty->termios.c_cc[VSTOP];
|
|
|
|
/* TODO: flush our TTY struct here? */
|
|
}
|
|
|
|
dgap_carrier(ch);
|
|
/*
|
|
* Run param in case we changed anything
|
|
*/
|
|
dgap_param(tty);
|
|
|
|
/*
|
|
* follow protocol for opening port
|
|
*/
|
|
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(brd->bd_lock, lock_flags);
|
|
|
|
rc = dgap_block_til_ready(tty, file, ch);
|
|
|
|
if (!un->un_tty) {
|
|
return -ENODEV;
|
|
}
|
|
|
|
if (rc) {
|
|
DPR_OPEN(("dgap_tty_open returning after dgap_block_til_ready "
|
|
"with %d\n", rc));
|
|
}
|
|
|
|
/* No going back now, increment our unit and channel counters */
|
|
DGAP_LOCK(ch->ch_lock, lock_flags);
|
|
ch->ch_open_count++;
|
|
un->un_open_count++;
|
|
un->un_flags |= (UN_ISOPEN);
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags);
|
|
|
|
DPR_OPEN(("dgap_tty_open finished\n"));
|
|
return (rc);
|
|
}
|
|
|
|
|
|
/*
|
|
* dgap_block_til_ready()
|
|
*
|
|
* Wait for DCD, if needed.
|
|
*/
|
|
static int dgap_block_til_ready(struct tty_struct *tty, struct file *file, struct channel_t *ch)
|
|
{
|
|
int retval = 0;
|
|
struct un_t *un = NULL;
|
|
ulong lock_flags;
|
|
uint old_flags = 0;
|
|
int sleep_on_un_flags = 0;
|
|
|
|
if (!tty || tty->magic != TTY_MAGIC || !file || !ch || ch->magic != DGAP_CHANNEL_MAGIC) {
|
|
return (-ENXIO);
|
|
}
|
|
|
|
un = tty->driver_data;
|
|
if (!un || un->magic != DGAP_UNIT_MAGIC) {
|
|
return (-ENXIO);
|
|
}
|
|
|
|
DPR_OPEN(("dgap_block_til_ready - before block.\n"));
|
|
|
|
DGAP_LOCK(ch->ch_lock, lock_flags);
|
|
|
|
ch->ch_wopen++;
|
|
|
|
/* Loop forever */
|
|
while (1) {
|
|
|
|
sleep_on_un_flags = 0;
|
|
|
|
/*
|
|
* If board has failed somehow during our sleep, bail with error.
|
|
*/
|
|
if (ch->ch_bd->state == BOARD_FAILED) {
|
|
retval = -ENXIO;
|
|
break;
|
|
}
|
|
|
|
/* If tty was hung up, break out of loop and set error. */
|
|
if (tty_hung_up_p(file)) {
|
|
retval = -EAGAIN;
|
|
break;
|
|
}
|
|
|
|
/*
|
|
* If either unit is in the middle of the fragile part of close,
|
|
* we just cannot touch the channel safely.
|
|
* Go back to sleep, knowing that when the channel can be
|
|
* touched safely, the close routine will signal the
|
|
* ch_wait_flags to wake us back up.
|
|
*/
|
|
if (!((ch->ch_tun.un_flags | ch->ch_pun.un_flags) & UN_CLOSING)) {
|
|
|
|
/*
|
|
* Our conditions to leave cleanly and happily:
|
|
* 1) NONBLOCKING on the tty is set.
|
|
* 2) CLOCAL is set.
|
|
* 3) DCD (fake or real) is active.
|
|
*/
|
|
|
|
if (file->f_flags & O_NONBLOCK) {
|
|
break;
|
|
}
|
|
|
|
if (tty->flags & (1 << TTY_IO_ERROR)) {
|
|
break;
|
|
}
|
|
|
|
if (ch->ch_flags & CH_CD) {
|
|
DPR_OPEN(("%d: ch_flags: %x\n", __LINE__, ch->ch_flags));
|
|
break;
|
|
}
|
|
|
|
if (ch->ch_flags & CH_FCAR) {
|
|
DPR_OPEN(("%d: ch_flags: %x\n", __LINE__, ch->ch_flags));
|
|
break;
|
|
}
|
|
}
|
|
else {
|
|
sleep_on_un_flags = 1;
|
|
}
|
|
|
|
/*
|
|
* If there is a signal pending, the user probably
|
|
* interrupted (ctrl-c) us.
|
|
* Leave loop with error set.
|
|
*/
|
|
if (signal_pending(current)) {
|
|
DPR_OPEN(("%d: signal pending...\n", __LINE__));
|
|
retval = -ERESTARTSYS;
|
|
break;
|
|
}
|
|
|
|
DPR_OPEN(("dgap_block_til_ready - blocking.\n"));
|
|
|
|
/*
|
|
* Store the flags before we let go of channel lock
|
|
*/
|
|
if (sleep_on_un_flags)
|
|
old_flags = ch->ch_tun.un_flags | ch->ch_pun.un_flags;
|
|
else
|
|
old_flags = ch->ch_flags;
|
|
|
|
/*
|
|
* Let go of channel lock before calling schedule.
|
|
* Our poller will get any FEP events and wake us up when DCD
|
|
* eventually goes active.
|
|
*/
|
|
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags);
|
|
|
|
DPR_OPEN(("Going to sleep on %s flags...\n",
|
|
(sleep_on_un_flags ? "un" : "ch")));
|
|
|
|
/*
|
|
* Wait for something in the flags to change from the current value.
|
|
*/
|
|
if (sleep_on_un_flags) {
|
|
retval = wait_event_interruptible(un->un_flags_wait,
|
|
(old_flags != (ch->ch_tun.un_flags | ch->ch_pun.un_flags)));
|
|
}
|
|
else {
|
|
retval = wait_event_interruptible(ch->ch_flags_wait,
|
|
(old_flags != ch->ch_flags));
|
|
}
|
|
|
|
DPR_OPEN(("After sleep... retval: %x\n", retval));
|
|
|
|
/*
|
|
* We got woken up for some reason.
|
|
* Before looping around, grab our channel lock.
|
|
*/
|
|
DGAP_LOCK(ch->ch_lock, lock_flags);
|
|
}
|
|
|
|
ch->ch_wopen--;
|
|
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags);
|
|
|
|
DPR_OPEN(("dgap_block_til_ready - after blocking.\n"));
|
|
|
|
if (retval) {
|
|
DPR_OPEN(("dgap_block_til_ready - done. error. retval: %x\n", retval));
|
|
return(retval);
|
|
}
|
|
|
|
DPR_OPEN(("dgap_block_til_ready - done no error. jiffies: %lu\n", jiffies));
|
|
|
|
return(0);
|
|
}
|
|
|
|
|
|
/*
|
|
* dgap_tty_hangup()
|
|
*
|
|
* Hangup the port. Like a close, but don't wait for output to drain.
|
|
*/
|
|
static void dgap_tty_hangup(struct tty_struct *tty)
|
|
{
|
|
struct board_t *bd;
|
|
struct channel_t *ch;
|
|
struct un_t *un;
|
|
|
|
if (!tty || tty->magic != TTY_MAGIC)
|
|
return;
|
|
|
|
un = tty->driver_data;
|
|
if (!un || un->magic != DGAP_UNIT_MAGIC)
|
|
return;
|
|
|
|
ch = un->un_ch;
|
|
if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
|
|
return;
|
|
|
|
bd = ch->ch_bd;
|
|
if (!bd || bd->magic != DGAP_BOARD_MAGIC)
|
|
return;
|
|
|
|
DPR_CLOSE(("dgap_hangup called. ch->ch_open_count: %d un->un_open_count: %d\n",
|
|
ch->ch_open_count, un->un_open_count));
|
|
|
|
/* flush the transmit queues */
|
|
dgap_tty_flush_buffer(tty);
|
|
|
|
DPR_CLOSE(("dgap_hangup finished. ch->ch_open_count: %d un->un_open_count: %d\n",
|
|
ch->ch_open_count, un->un_open_count));
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
* dgap_tty_close()
|
|
*
|
|
*/
|
|
static void dgap_tty_close(struct tty_struct *tty, struct file *file)
|
|
{
|
|
struct ktermios *ts;
|
|
struct board_t *bd;
|
|
struct channel_t *ch;
|
|
struct un_t *un;
|
|
ulong lock_flags;
|
|
int rc = 0;
|
|
|
|
if (!tty || tty->magic != TTY_MAGIC)
|
|
return;
|
|
|
|
un = tty->driver_data;
|
|
if (!un || un->magic != DGAP_UNIT_MAGIC)
|
|
return;
|
|
|
|
ch = un->un_ch;
|
|
if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
|
|
return;
|
|
|
|
bd = ch->ch_bd;
|
|
if (!bd || bd->magic != DGAP_BOARD_MAGIC)
|
|
return;
|
|
|
|
ts = &tty->termios;
|
|
|
|
DPR_CLOSE(("Close called\n"));
|
|
|
|
DGAP_LOCK(ch->ch_lock, lock_flags);
|
|
|
|
/*
|
|
* Determine if this is the last close or not - and if we agree about
|
|
* which type of close it is with the Line Discipline
|
|
*/
|
|
if ((tty->count == 1) && (un->un_open_count != 1)) {
|
|
/*
|
|
* Uh, oh. tty->count is 1, which means that the tty
|
|
* structure will be freed. un_open_count should always
|
|
* be one in these conditions. If it's greater than
|
|
* one, we've got real problems, since it means the
|
|
* serial port won't be shutdown.
|
|
*/
|
|
APR(("tty->count is 1, un open count is %d\n", un->un_open_count));
|
|
un->un_open_count = 1;
|
|
}
|
|
|
|
if (--un->un_open_count < 0) {
|
|
APR(("bad serial port open count of %d\n", un->un_open_count));
|
|
un->un_open_count = 0;
|
|
}
|
|
|
|
ch->ch_open_count--;
|
|
|
|
if (ch->ch_open_count && un->un_open_count) {
|
|
DPR_CLOSE(("dgap_tty_close: not last close ch: %d un:%d\n",
|
|
ch->ch_open_count, un->un_open_count));
|
|
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags);
|
|
return;
|
|
}
|
|
|
|
/* OK, its the last close on the unit */
|
|
DPR_CLOSE(("dgap_tty_close - last close on unit procedures\n"));
|
|
|
|
un->un_flags |= UN_CLOSING;
|
|
|
|
tty->closing = 1;
|
|
|
|
/*
|
|
* Only officially close channel if count is 0 and
|
|
* DIGI_PRINTER bit is not set.
|
|
*/
|
|
if ((ch->ch_open_count == 0) && !(ch->ch_digi.digi_flags & DIGI_PRINTER)) {
|
|
|
|
ch->ch_flags &= ~(CH_RXBLOCK);
|
|
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags);
|
|
|
|
/* wait for output to drain */
|
|
/* This will also return if we take an interrupt */
|
|
|
|
DPR_CLOSE(("Calling wait_for_drain\n"));
|
|
rc = dgap_wait_for_drain(tty);
|
|
DPR_CLOSE(("After calling wait_for_drain\n"));
|
|
|
|
if (rc) {
|
|
DPR_BASIC(("dgap_tty_close - bad return: %d ", rc));
|
|
}
|
|
|
|
dgap_tty_flush_buffer(tty);
|
|
tty_ldisc_flush(tty);
|
|
|
|
DGAP_LOCK(ch->ch_lock, lock_flags);
|
|
|
|
tty->closing = 0;
|
|
|
|
/*
|
|
* If we have HUPCL set, lower DTR and RTS
|
|
*/
|
|
if (ch->ch_c_cflag & HUPCL ) {
|
|
DPR_CLOSE(("Close. HUPCL set, dropping DTR/RTS\n"));
|
|
ch->ch_mostat &= ~(D_RTS(ch)|D_DTR(ch));
|
|
dgap_cmdb( ch, SMODEM, 0, D_DTR(ch)|D_RTS(ch), 0 );
|
|
|
|
/*
|
|
* Go to sleep to ensure RTS/DTR
|
|
* have been dropped for modems to see it.
|
|
*/
|
|
if (ch->ch_close_delay) {
|
|
DPR_CLOSE(("Close. Sleeping for RTS/DTR drop\n"));
|
|
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags);
|
|
dgap_ms_sleep(ch->ch_close_delay);
|
|
DGAP_LOCK(ch->ch_lock, lock_flags);
|
|
|
|
DPR_CLOSE(("Close. After sleeping for RTS/DTR drop\n"));
|
|
}
|
|
}
|
|
|
|
ch->pscan_state = 0;
|
|
ch->pscan_savechar = 0;
|
|
ch->ch_baud_info = 0;
|
|
|
|
}
|
|
|
|
/*
|
|
* turn off print device when closing print device.
|
|
*/
|
|
if ((un->un_type == DGAP_PRINT) && (ch->ch_flags & CH_PRON) ) {
|
|
dgap_wmove(ch, ch->ch_digi.digi_offstr,
|
|
(int) ch->ch_digi.digi_offlen);
|
|
ch->ch_flags &= ~CH_PRON;
|
|
}
|
|
|
|
un->un_tty = NULL;
|
|
un->un_flags &= ~(UN_ISOPEN | UN_CLOSING);
|
|
tty->driver_data = NULL;
|
|
|
|
DPR_CLOSE(("Close. Doing wakeups\n"));
|
|
wake_up_interruptible(&ch->ch_flags_wait);
|
|
wake_up_interruptible(&un->un_flags_wait);
|
|
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags);
|
|
|
|
DPR_BASIC(("dgap_tty_close - complete\n"));
|
|
}
|
|
|
|
|
|
/*
|
|
* dgap_tty_chars_in_buffer()
|
|
*
|
|
* Return number of characters that have not been transmitted yet.
|
|
*
|
|
* This routine is used by the line discipline to determine if there
|
|
* is data waiting to be transmitted/drained/flushed or not.
|
|
*/
|
|
static int dgap_tty_chars_in_buffer(struct tty_struct *tty)
|
|
{
|
|
struct board_t *bd = NULL;
|
|
struct channel_t *ch = NULL;
|
|
struct un_t *un = NULL;
|
|
struct bs_t *bs = NULL;
|
|
uchar tbusy;
|
|
uint chars = 0;
|
|
u16 thead, ttail, tmask, chead, ctail;
|
|
ulong lock_flags = 0;
|
|
ulong lock_flags2 = 0;
|
|
|
|
if (tty == NULL)
|
|
return(0);
|
|
|
|
un = tty->driver_data;
|
|
if (!un || un->magic != DGAP_UNIT_MAGIC)
|
|
return (0);
|
|
|
|
ch = un->un_ch;
|
|
if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
|
|
return (0);
|
|
|
|
bd = ch->ch_bd;
|
|
if (!bd || bd->magic != DGAP_BOARD_MAGIC)
|
|
return (0);
|
|
|
|
bs = ch->ch_bs;
|
|
if (!bs)
|
|
return (0);
|
|
|
|
DGAP_LOCK(bd->bd_lock, lock_flags);
|
|
DGAP_LOCK(ch->ch_lock, lock_flags2);
|
|
|
|
tmask = (ch->ch_tsize - 1);
|
|
|
|
/* Get Transmit queue pointers */
|
|
thead = readw(&(bs->tx_head)) & tmask;
|
|
ttail = readw(&(bs->tx_tail)) & tmask;
|
|
|
|
/* Get tbusy flag */
|
|
tbusy = readb(&(bs->tbusy));
|
|
|
|
/* Get Command queue pointers */
|
|
chead = readw(&(ch->ch_cm->cm_head));
|
|
ctail = readw(&(ch->ch_cm->cm_tail));
|
|
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
|
|
/*
|
|
* The only way we know for sure if there is no pending
|
|
* data left to be transferred, is if:
|
|
* 1) Transmit head and tail are equal (empty).
|
|
* 2) Command queue head and tail are equal (empty).
|
|
* 3) The "TBUSY" flag is 0. (Transmitter not busy).
|
|
*/
|
|
|
|
if ((ttail == thead) && (tbusy == 0) && (chead == ctail)) {
|
|
chars = 0;
|
|
}
|
|
else {
|
|
if (thead >= ttail)
|
|
chars = thead - ttail;
|
|
else
|
|
chars = thead - ttail + ch->ch_tsize;
|
|
/*
|
|
* Fudge factor here.
|
|
* If chars is zero, we know that the command queue had
|
|
* something in it or tbusy was set. Because we cannot
|
|
* be sure if there is still some data to be transmitted,
|
|
* lets lie, and tell ld we have 1 byte left.
|
|
*/
|
|
if (chars == 0) {
|
|
/*
|
|
* If TBUSY is still set, and our tx buffers are empty,
|
|
* force the firmware to send me another wakeup after
|
|
* TBUSY has been cleared.
|
|
*/
|
|
if (tbusy != 0) {
|
|
DGAP_LOCK(ch->ch_lock, lock_flags);
|
|
un->un_flags |= UN_EMPTY;
|
|
writeb(1, &(bs->iempty));
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags);
|
|
}
|
|
chars = 1;
|
|
}
|
|
}
|
|
|
|
DPR_WRITE(("dgap_tty_chars_in_buffer. Port: %x - %d (head: %d tail: %d tsize: %d)\n",
|
|
ch->ch_portnum, chars, thead, ttail, ch->ch_tsize));
|
|
return(chars);
|
|
}
|
|
|
|
|
|
static int dgap_wait_for_drain(struct tty_struct *tty)
|
|
{
|
|
struct channel_t *ch;
|
|
struct un_t *un;
|
|
struct bs_t *bs;
|
|
int ret = -EIO;
|
|
uint count = 1;
|
|
ulong lock_flags = 0;
|
|
|
|
if (!tty || tty->magic != TTY_MAGIC)
|
|
return ret;
|
|
|
|
un = tty->driver_data;
|
|
if (!un || un->magic != DGAP_UNIT_MAGIC)
|
|
return ret;
|
|
|
|
ch = un->un_ch;
|
|
if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
|
|
return ret;
|
|
|
|
bs = ch->ch_bs;
|
|
if (!bs)
|
|
return ret;
|
|
|
|
ret = 0;
|
|
|
|
DPR_DRAIN(("dgap_wait_for_drain start\n"));
|
|
|
|
/* Loop until data is drained */
|
|
while (count != 0) {
|
|
|
|
count = dgap_tty_chars_in_buffer(tty);
|
|
|
|
if (count == 0)
|
|
break;
|
|
|
|
/* Set flag waiting for drain */
|
|
DGAP_LOCK(ch->ch_lock, lock_flags);
|
|
un->un_flags |= UN_EMPTY;
|
|
writeb(1, &(bs->iempty));
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags);
|
|
|
|
/* Go to sleep till we get woken up */
|
|
ret = wait_event_interruptible(un->un_flags_wait, ((un->un_flags & UN_EMPTY) == 0));
|
|
/* If ret is non-zero, user ctrl-c'ed us */
|
|
if (ret) {
|
|
break;
|
|
}
|
|
}
|
|
|
|
DGAP_LOCK(ch->ch_lock, lock_flags);
|
|
un->un_flags &= ~(UN_EMPTY);
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags);
|
|
|
|
DPR_DRAIN(("dgap_wait_for_drain finish\n"));
|
|
return (ret);
|
|
}
|
|
|
|
|
|
/*
|
|
* dgap_maxcps_room
|
|
*
|
|
* Reduces bytes_available to the max number of characters
|
|
* that can be sent currently given the maxcps value, and
|
|
* returns the new bytes_available. This only affects printer
|
|
* output.
|
|
*/
|
|
static int dgap_maxcps_room(struct tty_struct *tty, int bytes_available)
|
|
{
|
|
struct channel_t *ch = NULL;
|
|
struct un_t *un = NULL;
|
|
|
|
if (tty == NULL)
|
|
return (bytes_available);
|
|
|
|
un = tty->driver_data;
|
|
if (!un || un->magic != DGAP_UNIT_MAGIC)
|
|
return (bytes_available);
|
|
|
|
ch = un->un_ch;
|
|
if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
|
|
return (bytes_available);
|
|
|
|
/*
|
|
* If its not the Transparent print device, return
|
|
* the full data amount.
|
|
*/
|
|
if (un->un_type != DGAP_PRINT)
|
|
return (bytes_available);
|
|
|
|
if (ch->ch_digi.digi_maxcps > 0 && ch->ch_digi.digi_bufsize > 0 ) {
|
|
int cps_limit = 0;
|
|
unsigned long current_time = jiffies;
|
|
unsigned long buffer_time = current_time +
|
|
(HZ * ch->ch_digi.digi_bufsize) / ch->ch_digi.digi_maxcps;
|
|
|
|
if (ch->ch_cpstime < current_time) {
|
|
/* buffer is empty */
|
|
ch->ch_cpstime = current_time; /* reset ch_cpstime */
|
|
cps_limit = ch->ch_digi.digi_bufsize;
|
|
}
|
|
else if (ch->ch_cpstime < buffer_time) {
|
|
/* still room in the buffer */
|
|
cps_limit = ((buffer_time - ch->ch_cpstime) * ch->ch_digi.digi_maxcps) / HZ;
|
|
}
|
|
else {
|
|
/* no room in the buffer */
|
|
cps_limit = 0;
|
|
}
|
|
|
|
bytes_available = min(cps_limit, bytes_available);
|
|
}
|
|
|
|
return (bytes_available);
|
|
}
|
|
|
|
|
|
static inline void dgap_set_firmware_event(struct un_t *un, unsigned int event)
|
|
{
|
|
struct channel_t *ch = NULL;
|
|
struct bs_t *bs = NULL;
|
|
|
|
if (!un || un->magic != DGAP_UNIT_MAGIC)
|
|
return;
|
|
ch = un->un_ch;
|
|
if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
|
|
return;
|
|
bs = ch->ch_bs;
|
|
if (!bs)
|
|
return;
|
|
|
|
if ((event & UN_LOW) != 0) {
|
|
if ((un->un_flags & UN_LOW) == 0) {
|
|
un->un_flags |= UN_LOW;
|
|
writeb(1, &(bs->ilow));
|
|
}
|
|
}
|
|
if ((event & UN_LOW) != 0) {
|
|
if ((un->un_flags & UN_EMPTY) == 0) {
|
|
un->un_flags |= UN_EMPTY;
|
|
writeb(1, &(bs->iempty));
|
|
}
|
|
}
|
|
}
|
|
|
|
|
|
/*
|
|
* dgap_tty_write_room()
|
|
*
|
|
* Return space available in Tx buffer
|
|
*/
|
|
static int dgap_tty_write_room(struct tty_struct *tty)
|
|
{
|
|
struct channel_t *ch = NULL;
|
|
struct un_t *un = NULL;
|
|
struct bs_t *bs = NULL;
|
|
u16 head, tail, tmask;
|
|
int ret = 0;
|
|
ulong lock_flags = 0;
|
|
|
|
if (tty == NULL || dgap_TmpWriteBuf == NULL)
|
|
return(0);
|
|
|
|
un = tty->driver_data;
|
|
if (!un || un->magic != DGAP_UNIT_MAGIC)
|
|
return (0);
|
|
|
|
ch = un->un_ch;
|
|
if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
|
|
return (0);
|
|
|
|
bs = ch->ch_bs;
|
|
if (!bs)
|
|
return (0);
|
|
|
|
DGAP_LOCK(ch->ch_lock, lock_flags);
|
|
|
|
tmask = ch->ch_tsize - 1;
|
|
head = readw(&(bs->tx_head)) & tmask;
|
|
tail = readw(&(bs->tx_tail)) & tmask;
|
|
|
|
if ((ret = tail - head - 1) < 0)
|
|
ret += ch->ch_tsize;
|
|
|
|
/* Limit printer to maxcps */
|
|
ret = dgap_maxcps_room(tty, ret);
|
|
|
|
/*
|
|
* If we are printer device, leave space for
|
|
* possibly both the on and off strings.
|
|
*/
|
|
if (un->un_type == DGAP_PRINT) {
|
|
if (!(ch->ch_flags & CH_PRON))
|
|
ret -= ch->ch_digi.digi_onlen;
|
|
ret -= ch->ch_digi.digi_offlen;
|
|
}
|
|
else {
|
|
if (ch->ch_flags & CH_PRON)
|
|
ret -= ch->ch_digi.digi_offlen;
|
|
}
|
|
|
|
if (ret < 0)
|
|
ret = 0;
|
|
|
|
/*
|
|
* Schedule FEP to wake us up if needed.
|
|
*
|
|
* TODO: This might be overkill...
|
|
* Do we really need to schedule callbacks from the FEP
|
|
* in every case? Can we get smarter based on ret?
|
|
*/
|
|
dgap_set_firmware_event(un, UN_LOW | UN_EMPTY);
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags);
|
|
|
|
DPR_WRITE(("dgap_tty_write_room - %d tail: %d head: %d\n", ret, tail, head));
|
|
|
|
return(ret);
|
|
}
|
|
|
|
|
|
/*
|
|
* dgap_tty_put_char()
|
|
*
|
|
* Put a character into ch->ch_buf
|
|
*
|
|
* - used by the line discipline for OPOST processing
|
|
*/
|
|
static int dgap_tty_put_char(struct tty_struct *tty, unsigned char c)
|
|
{
|
|
/*
|
|
* Simply call tty_write.
|
|
*/
|
|
DPR_WRITE(("dgap_tty_put_char called\n"));
|
|
dgap_tty_write(tty, &c, 1);
|
|
return 1;
|
|
}
|
|
|
|
|
|
/*
|
|
* dgap_tty_write()
|
|
*
|
|
* Take data from the user or kernel and send it out to the FEP.
|
|
* In here exists all the Transparent Print magic as well.
|
|
*/
|
|
static int dgap_tty_write(struct tty_struct *tty, const unsigned char *buf, int count)
|
|
{
|
|
struct channel_t *ch = NULL;
|
|
struct un_t *un = NULL;
|
|
struct bs_t *bs = NULL;
|
|
char *vaddr = NULL;
|
|
u16 head, tail, tmask, remain;
|
|
int bufcount = 0, n = 0;
|
|
int orig_count = 0;
|
|
ulong lock_flags;
|
|
int from_user = 0;
|
|
|
|
if (tty == NULL || dgap_TmpWriteBuf == NULL)
|
|
return(0);
|
|
|
|
un = tty->driver_data;
|
|
if (!un || un->magic != DGAP_UNIT_MAGIC)
|
|
return (0);
|
|
|
|
ch = un->un_ch;
|
|
if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
|
|
return(0);
|
|
|
|
bs = ch->ch_bs;
|
|
if (!bs)
|
|
return(0);
|
|
|
|
if (!count)
|
|
return(0);
|
|
|
|
DPR_WRITE(("dgap_tty_write: Port: %x tty=%p user=%d len=%d\n",
|
|
ch->ch_portnum, tty, from_user, count));
|
|
|
|
/*
|
|
* Store original amount of characters passed in.
|
|
* This helps to figure out if we should ask the FEP
|
|
* to send us an event when it has more space available.
|
|
*/
|
|
orig_count = count;
|
|
|
|
DGAP_LOCK(ch->ch_lock, lock_flags);
|
|
|
|
/* Get our space available for the channel from the board */
|
|
tmask = ch->ch_tsize - 1;
|
|
head = readw(&(bs->tx_head)) & tmask;
|
|
tail = readw(&(bs->tx_tail)) & tmask;
|
|
|
|
if ((bufcount = tail - head - 1) < 0)
|
|
bufcount += ch->ch_tsize;
|
|
|
|
DPR_WRITE(("%d: bufcount: %x count: %x tail: %x head: %x tmask: %x\n",
|
|
__LINE__, bufcount, count, tail, head, tmask));
|
|
|
|
/*
|
|
* Limit printer output to maxcps overall, with bursts allowed
|
|
* up to bufsize characters.
|
|
*/
|
|
bufcount = dgap_maxcps_room(tty, bufcount);
|
|
|
|
/*
|
|
* Take minimum of what the user wants to send, and the
|
|
* space available in the FEP buffer.
|
|
*/
|
|
count = min(count, bufcount);
|
|
|
|
/*
|
|
* Bail if no space left.
|
|
*/
|
|
if (count <= 0) {
|
|
dgap_set_firmware_event(un, UN_LOW | UN_EMPTY);
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags);
|
|
return(0);
|
|
}
|
|
|
|
/*
|
|
* Output the printer ON string, if we are in terminal mode, but
|
|
* need to be in printer mode.
|
|
*/
|
|
if ((un->un_type == DGAP_PRINT) && !(ch->ch_flags & CH_PRON)) {
|
|
dgap_wmove(ch, ch->ch_digi.digi_onstr,
|
|
(int) ch->ch_digi.digi_onlen);
|
|
head = readw(&(bs->tx_head)) & tmask;
|
|
ch->ch_flags |= CH_PRON;
|
|
}
|
|
|
|
/*
|
|
* On the other hand, output the printer OFF string, if we are
|
|
* currently in printer mode, but need to output to the terminal.
|
|
*/
|
|
if ((un->un_type != DGAP_PRINT) && (ch->ch_flags & CH_PRON)) {
|
|
dgap_wmove(ch, ch->ch_digi.digi_offstr,
|
|
(int) ch->ch_digi.digi_offlen);
|
|
head = readw(&(bs->tx_head)) & tmask;
|
|
ch->ch_flags &= ~CH_PRON;
|
|
}
|
|
|
|
/*
|
|
* If there is nothing left to copy, or I can't handle any more data, leave.
|
|
*/
|
|
if (count <= 0) {
|
|
dgap_set_firmware_event(un, UN_LOW | UN_EMPTY);
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags);
|
|
return(0);
|
|
}
|
|
|
|
if (from_user) {
|
|
|
|
count = min(count, WRITEBUFLEN);
|
|
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags);
|
|
|
|
/*
|
|
* If data is coming from user space, copy it into a temporary
|
|
* buffer so we don't get swapped out while doing the copy to
|
|
* the board.
|
|
*/
|
|
/* we're allowed to block if it's from_user */
|
|
if (down_interruptible(&dgap_TmpWriteSem)) {
|
|
return (-EINTR);
|
|
}
|
|
|
|
if (copy_from_user(dgap_TmpWriteBuf, (const uchar __user *) buf, count)) {
|
|
up(&dgap_TmpWriteSem);
|
|
printk("Write: Copy from user failed!\n");
|
|
return -EFAULT;
|
|
}
|
|
|
|
DGAP_LOCK(ch->ch_lock, lock_flags);
|
|
|
|
buf = dgap_TmpWriteBuf;
|
|
}
|
|
|
|
n = count;
|
|
|
|
/*
|
|
* If the write wraps over the top of the circular buffer,
|
|
* move the portion up to the wrap point, and reset the
|
|
* pointers to the bottom.
|
|
*/
|
|
remain = ch->ch_tstart + ch->ch_tsize - head;
|
|
|
|
if (n >= remain) {
|
|
n -= remain;
|
|
vaddr = ch->ch_taddr + head;
|
|
|
|
memcpy_toio(vaddr, (uchar *) buf, remain);
|
|
dgap_sniff_nowait_nolock(ch, "USER WRITE", (uchar *) buf, remain);
|
|
|
|
head = ch->ch_tstart;
|
|
buf += remain;
|
|
}
|
|
|
|
if (n > 0) {
|
|
|
|
/*
|
|
* Move rest of data.
|
|
*/
|
|
vaddr = ch->ch_taddr + head;
|
|
remain = n;
|
|
|
|
memcpy_toio(vaddr, (uchar *) buf, remain);
|
|
dgap_sniff_nowait_nolock(ch, "USER WRITE", (uchar *) buf, remain);
|
|
|
|
head += remain;
|
|
|
|
}
|
|
|
|
if (count) {
|
|
ch->ch_txcount += count;
|
|
head &= tmask;
|
|
writew(head, &(bs->tx_head));
|
|
}
|
|
|
|
|
|
dgap_set_firmware_event(un, UN_LOW | UN_EMPTY);
|
|
|
|
/*
|
|
* If this is the print device, and the
|
|
* printer is still on, we need to turn it
|
|
* off before going idle. If the buffer is
|
|
* non-empty, wait until it goes empty.
|
|
* Otherwise turn it off right now.
|
|
*/
|
|
if ((un->un_type == DGAP_PRINT) && (ch->ch_flags & CH_PRON)) {
|
|
tail = readw(&(bs->tx_tail)) & tmask;
|
|
|
|
if (tail != head) {
|
|
un->un_flags |= UN_EMPTY;
|
|
writeb(1, &(bs->iempty));
|
|
}
|
|
else {
|
|
dgap_wmove(ch, ch->ch_digi.digi_offstr,
|
|
(int) ch->ch_digi.digi_offlen);
|
|
head = readw(&(bs->tx_head)) & tmask;
|
|
ch->ch_flags &= ~CH_PRON;
|
|
}
|
|
}
|
|
|
|
/* Update printer buffer empty time. */
|
|
if ((un->un_type == DGAP_PRINT) && (ch->ch_digi.digi_maxcps > 0)
|
|
&& (ch->ch_digi.digi_bufsize > 0)) {
|
|
ch->ch_cpstime += (HZ * count) / ch->ch_digi.digi_maxcps;
|
|
}
|
|
|
|
if (from_user) {
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags);
|
|
up(&dgap_TmpWriteSem);
|
|
}
|
|
else {
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags);
|
|
}
|
|
|
|
DPR_WRITE(("Write finished - Write %d bytes of %d.\n", count, orig_count));
|
|
|
|
return (count);
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
* Return modem signals to ld.
|
|
*/
|
|
#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,39)
|
|
static int dgap_tty_tiocmget(struct tty_struct *tty)
|
|
#else
|
|
static int dgap_tty_tiocmget(struct tty_struct *tty, struct file *file)
|
|
#endif
|
|
{
|
|
struct channel_t *ch;
|
|
struct un_t *un;
|
|
int result = -EIO;
|
|
uchar mstat = 0;
|
|
ulong lock_flags;
|
|
|
|
if (!tty || tty->magic != TTY_MAGIC)
|
|
return result;
|
|
|
|
un = tty->driver_data;
|
|
if (!un || un->magic != DGAP_UNIT_MAGIC)
|
|
return result;
|
|
|
|
ch = un->un_ch;
|
|
if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
|
|
return result;
|
|
|
|
DPR_IOCTL(("dgap_tty_tiocmget start\n"));
|
|
|
|
DGAP_LOCK(ch->ch_lock, lock_flags);
|
|
|
|
mstat = readb(&(ch->ch_bs->m_stat));
|
|
/* Append any outbound signals that might be pending... */
|
|
mstat |= ch->ch_mostat;
|
|
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags);
|
|
|
|
result = 0;
|
|
|
|
if (mstat & D_DTR(ch))
|
|
result |= TIOCM_DTR;
|
|
if (mstat & D_RTS(ch))
|
|
result |= TIOCM_RTS;
|
|
if (mstat & D_CTS(ch))
|
|
result |= TIOCM_CTS;
|
|
if (mstat & D_DSR(ch))
|
|
result |= TIOCM_DSR;
|
|
if (mstat & D_RI(ch))
|
|
result |= TIOCM_RI;
|
|
if (mstat & D_CD(ch))
|
|
result |= TIOCM_CD;
|
|
|
|
DPR_IOCTL(("dgap_tty_tiocmget finish\n"));
|
|
|
|
return result;
|
|
}
|
|
|
|
|
|
/*
|
|
* dgap_tty_tiocmset()
|
|
*
|
|
* Set modem signals, called by ld.
|
|
*/
|
|
#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,39)
|
|
static int dgap_tty_tiocmset(struct tty_struct *tty,
|
|
unsigned int set, unsigned int clear)
|
|
#else
|
|
static int dgap_tty_tiocmset(struct tty_struct *tty, struct file *file,
|
|
unsigned int set, unsigned int clear)
|
|
#endif
|
|
{
|
|
struct board_t *bd;
|
|
struct channel_t *ch;
|
|
struct un_t *un;
|
|
int ret = -EIO;
|
|
ulong lock_flags;
|
|
ulong lock_flags2;
|
|
|
|
if (!tty || tty->magic != TTY_MAGIC)
|
|
return ret;
|
|
|
|
un = tty->driver_data;
|
|
if (!un || un->magic != DGAP_UNIT_MAGIC)
|
|
return ret;
|
|
|
|
ch = un->un_ch;
|
|
if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
|
|
return ret;
|
|
|
|
bd = ch->ch_bd;
|
|
if (!bd || bd->magic != DGAP_BOARD_MAGIC)
|
|
return ret;
|
|
|
|
DPR_IOCTL(("dgap_tty_tiocmset start\n"));
|
|
|
|
DGAP_LOCK(bd->bd_lock, lock_flags);
|
|
DGAP_LOCK(ch->ch_lock, lock_flags2);
|
|
|
|
if (set & TIOCM_RTS) {
|
|
ch->ch_mforce |= D_RTS(ch);
|
|
ch->ch_mval |= D_RTS(ch);
|
|
}
|
|
|
|
if (set & TIOCM_DTR) {
|
|
ch->ch_mforce |= D_DTR(ch);
|
|
ch->ch_mval |= D_DTR(ch);
|
|
}
|
|
|
|
if (clear & TIOCM_RTS) {
|
|
ch->ch_mforce |= D_RTS(ch);
|
|
ch->ch_mval &= ~(D_RTS(ch));
|
|
}
|
|
|
|
if (clear & TIOCM_DTR) {
|
|
ch->ch_mforce |= D_DTR(ch);
|
|
ch->ch_mval &= ~(D_DTR(ch));
|
|
}
|
|
|
|
dgap_param(tty);
|
|
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
|
|
DPR_IOCTL(("dgap_tty_tiocmset finish\n"));
|
|
|
|
return (0);
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
* dgap_tty_send_break()
|
|
*
|
|
* Send a Break, called by ld.
|
|
*/
|
|
static int dgap_tty_send_break(struct tty_struct *tty, int msec)
|
|
{
|
|
struct board_t *bd;
|
|
struct channel_t *ch;
|
|
struct un_t *un;
|
|
int ret = -EIO;
|
|
ulong lock_flags;
|
|
ulong lock_flags2;
|
|
|
|
if (!tty || tty->magic != TTY_MAGIC)
|
|
return ret;
|
|
|
|
un = tty->driver_data;
|
|
if (!un || un->magic != DGAP_UNIT_MAGIC)
|
|
return ret;
|
|
|
|
ch = un->un_ch;
|
|
if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
|
|
return ret;
|
|
|
|
bd = ch->ch_bd;
|
|
if (!bd || bd->magic != DGAP_BOARD_MAGIC)
|
|
return ret;
|
|
|
|
switch (msec) {
|
|
case -1:
|
|
msec = 0xFFFF;
|
|
break;
|
|
case 0:
|
|
msec = 1;
|
|
break;
|
|
default:
|
|
msec /= 10;
|
|
break;
|
|
}
|
|
|
|
DPR_IOCTL(("dgap_tty_send_break start 1. %lx\n", jiffies));
|
|
|
|
DGAP_LOCK(bd->bd_lock, lock_flags);
|
|
DGAP_LOCK(ch->ch_lock, lock_flags2);
|
|
#if 0
|
|
dgap_cmdw(ch, SBREAK, (u16) SBREAK_TIME, 0);
|
|
#endif
|
|
dgap_cmdw(ch, SBREAK, (u16) msec, 0);
|
|
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
|
|
DPR_IOCTL(("dgap_tty_send_break finish\n"));
|
|
|
|
return (0);
|
|
}
|
|
|
|
|
|
|
|
|
|
/*
|
|
* dgap_tty_wait_until_sent()
|
|
*
|
|
* wait until data has been transmitted, called by ld.
|
|
*/
|
|
static void dgap_tty_wait_until_sent(struct tty_struct *tty, int timeout)
|
|
{
|
|
int rc;
|
|
rc = dgap_wait_for_drain(tty);
|
|
if (rc) {
|
|
DPR_IOCTL(("dgap_tty_ioctl - bad return: %d ", rc));
|
|
return;
|
|
}
|
|
return;
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
* dgap_send_xchar()
|
|
*
|
|
* send a high priority character, called by ld.
|
|
*/
|
|
static void dgap_tty_send_xchar(struct tty_struct *tty, char c)
|
|
{
|
|
struct board_t *bd;
|
|
struct channel_t *ch;
|
|
struct un_t *un;
|
|
ulong lock_flags;
|
|
ulong lock_flags2;
|
|
|
|
if (!tty || tty->magic != TTY_MAGIC)
|
|
return;
|
|
|
|
un = tty->driver_data;
|
|
if (!un || un->magic != DGAP_UNIT_MAGIC)
|
|
return;
|
|
|
|
ch = un->un_ch;
|
|
if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
|
|
return;
|
|
|
|
bd = ch->ch_bd;
|
|
if (!bd || bd->magic != DGAP_BOARD_MAGIC)
|
|
return;
|
|
|
|
DPR_IOCTL(("dgap_tty_send_xchar start 1. %lx\n", jiffies));
|
|
|
|
DGAP_LOCK(bd->bd_lock, lock_flags);
|
|
DGAP_LOCK(ch->ch_lock, lock_flags2);
|
|
|
|
/*
|
|
* This is technically what we should do.
|
|
* However, the NIST tests specifically want
|
|
* to see each XON or XOFF character that it
|
|
* sends, so lets just send each character
|
|
* by hand...
|
|
*/
|
|
#if 0
|
|
if (c == STOP_CHAR(tty)) {
|
|
dgap_cmdw(ch, RPAUSE, 0, 0);
|
|
}
|
|
else if (c == START_CHAR(tty)) {
|
|
dgap_cmdw(ch, RRESUME, 0, 0);
|
|
}
|
|
else {
|
|
dgap_wmove(ch, &c, 1);
|
|
}
|
|
#else
|
|
dgap_wmove(ch, &c, 1);
|
|
#endif
|
|
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
|
|
DPR_IOCTL(("dgap_tty_send_xchar finish\n"));
|
|
|
|
return;
|
|
}
|
|
|
|
|
|
|
|
|
|
/*
|
|
* Return modem signals to ld.
|
|
*/
|
|
static int dgap_get_modem_info(struct channel_t *ch, unsigned int __user *value)
|
|
{
|
|
int result = 0;
|
|
uchar mstat = 0;
|
|
ulong lock_flags;
|
|
int rc = 0;
|
|
|
|
DPR_IOCTL(("dgap_get_modem_info start\n"));
|
|
|
|
if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
|
|
return(-ENXIO);
|
|
|
|
DGAP_LOCK(ch->ch_lock, lock_flags);
|
|
|
|
mstat = readb(&(ch->ch_bs->m_stat));
|
|
/* Append any outbound signals that might be pending... */
|
|
mstat |= ch->ch_mostat;
|
|
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags);
|
|
|
|
result = 0;
|
|
|
|
if (mstat & D_DTR(ch))
|
|
result |= TIOCM_DTR;
|
|
if (mstat & D_RTS(ch))
|
|
result |= TIOCM_RTS;
|
|
if (mstat & D_CTS(ch))
|
|
result |= TIOCM_CTS;
|
|
if (mstat & D_DSR(ch))
|
|
result |= TIOCM_DSR;
|
|
if (mstat & D_RI(ch))
|
|
result |= TIOCM_RI;
|
|
if (mstat & D_CD(ch))
|
|
result |= TIOCM_CD;
|
|
|
|
rc = put_user(result, value);
|
|
|
|
DPR_IOCTL(("dgap_get_modem_info finish\n"));
|
|
return(rc);
|
|
}
|
|
|
|
|
|
/*
|
|
* dgap_set_modem_info()
|
|
*
|
|
* Set modem signals, called by ld.
|
|
*/
|
|
static int dgap_set_modem_info(struct tty_struct *tty, unsigned int command, unsigned int __user *value)
|
|
{
|
|
struct board_t *bd;
|
|
struct channel_t *ch;
|
|
struct un_t *un;
|
|
int ret = -ENXIO;
|
|
unsigned int arg = 0;
|
|
ulong lock_flags;
|
|
ulong lock_flags2;
|
|
|
|
if (!tty || tty->magic != TTY_MAGIC)
|
|
return ret;
|
|
|
|
un = tty->driver_data;
|
|
if (!un || un->magic != DGAP_UNIT_MAGIC)
|
|
return ret;
|
|
|
|
ch = un->un_ch;
|
|
if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
|
|
return ret;
|
|
|
|
bd = ch->ch_bd;
|
|
if (!bd || bd->magic != DGAP_BOARD_MAGIC)
|
|
return ret;
|
|
|
|
DPR_IOCTL(("dgap_set_modem_info() start\n"));
|
|
|
|
ret = get_user(arg, value);
|
|
if (ret) {
|
|
DPR_IOCTL(("dgap_set_modem_info %d ret: %x. finished.\n", __LINE__, ret));
|
|
return(ret);
|
|
}
|
|
|
|
DPR_IOCTL(("dgap_set_modem_info: command: %x arg: %x\n", command, arg));
|
|
|
|
switch (command) {
|
|
case TIOCMBIS:
|
|
if (arg & TIOCM_RTS) {
|
|
ch->ch_mforce |= D_RTS(ch);
|
|
ch->ch_mval |= D_RTS(ch);
|
|
}
|
|
|
|
if (arg & TIOCM_DTR) {
|
|
ch->ch_mforce |= D_DTR(ch);
|
|
ch->ch_mval |= D_DTR(ch);
|
|
}
|
|
|
|
break;
|
|
|
|
case TIOCMBIC:
|
|
if (arg & TIOCM_RTS) {
|
|
ch->ch_mforce |= D_RTS(ch);
|
|
ch->ch_mval &= ~(D_RTS(ch));
|
|
}
|
|
|
|
if (arg & TIOCM_DTR) {
|
|
ch->ch_mforce |= D_DTR(ch);
|
|
ch->ch_mval &= ~(D_DTR(ch));
|
|
}
|
|
|
|
break;
|
|
|
|
case TIOCMSET:
|
|
ch->ch_mforce = D_DTR(ch)|D_RTS(ch);
|
|
|
|
if (arg & TIOCM_RTS) {
|
|
ch->ch_mval |= D_RTS(ch);
|
|
}
|
|
else {
|
|
ch->ch_mval &= ~(D_RTS(ch));
|
|
}
|
|
|
|
if (arg & TIOCM_DTR) {
|
|
ch->ch_mval |= (D_DTR(ch));
|
|
}
|
|
else {
|
|
ch->ch_mval &= ~(D_DTR(ch));
|
|
}
|
|
|
|
break;
|
|
|
|
default:
|
|
return(-EINVAL);
|
|
}
|
|
|
|
DGAP_LOCK(bd->bd_lock, lock_flags);
|
|
DGAP_LOCK(ch->ch_lock, lock_flags2);
|
|
|
|
dgap_param(tty);
|
|
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
|
|
DPR_IOCTL(("dgap_set_modem_info finish\n"));
|
|
|
|
return (0);
|
|
}
|
|
|
|
|
|
/*
|
|
* dgap_tty_digigeta()
|
|
*
|
|
* Ioctl to get the information for ditty.
|
|
*
|
|
*
|
|
*
|
|
*/
|
|
static int dgap_tty_digigeta(struct tty_struct *tty, struct digi_t __user *retinfo)
|
|
{
|
|
struct channel_t *ch;
|
|
struct un_t *un;
|
|
struct digi_t tmp;
|
|
ulong lock_flags;
|
|
|
|
if (!retinfo)
|
|
return (-EFAULT);
|
|
|
|
if (!tty || tty->magic != TTY_MAGIC)
|
|
return (-EFAULT);
|
|
|
|
un = tty->driver_data;
|
|
if (!un || un->magic != DGAP_UNIT_MAGIC)
|
|
return (-EFAULT);
|
|
|
|
ch = un->un_ch;
|
|
if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
|
|
return (-EFAULT);
|
|
|
|
memset(&tmp, 0, sizeof(tmp));
|
|
|
|
DGAP_LOCK(ch->ch_lock, lock_flags);
|
|
memcpy(&tmp, &ch->ch_digi, sizeof(tmp));
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags);
|
|
|
|
if (copy_to_user(retinfo, &tmp, sizeof(*retinfo)))
|
|
return (-EFAULT);
|
|
|
|
return (0);
|
|
}
|
|
|
|
|
|
/*
|
|
* dgap_tty_digiseta()
|
|
*
|
|
* Ioctl to set the information for ditty.
|
|
*
|
|
*
|
|
*
|
|
*/
|
|
static int dgap_tty_digiseta(struct tty_struct *tty, struct digi_t __user *new_info)
|
|
{
|
|
struct board_t *bd;
|
|
struct channel_t *ch;
|
|
struct un_t *un;
|
|
struct digi_t new_digi;
|
|
ulong lock_flags = 0;
|
|
unsigned long lock_flags2;
|
|
|
|
DPR_IOCTL(("DIGI_SETA start\n"));
|
|
|
|
if (!tty || tty->magic != TTY_MAGIC)
|
|
return (-EFAULT);
|
|
|
|
un = tty->driver_data;
|
|
if (!un || un->magic != DGAP_UNIT_MAGIC)
|
|
return (-EFAULT);
|
|
|
|
ch = un->un_ch;
|
|
if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
|
|
return (-EFAULT);
|
|
|
|
bd = ch->ch_bd;
|
|
if (!bd || bd->magic != DGAP_BOARD_MAGIC)
|
|
return (-EFAULT);
|
|
|
|
if (copy_from_user(&new_digi, new_info, sizeof(struct digi_t))) {
|
|
DPR_IOCTL(("DIGI_SETA failed copy_from_user\n"));
|
|
return(-EFAULT);
|
|
}
|
|
|
|
DGAP_LOCK(bd->bd_lock, lock_flags);
|
|
DGAP_LOCK(ch->ch_lock, lock_flags2);
|
|
|
|
memcpy(&ch->ch_digi, &new_digi, sizeof(struct digi_t));
|
|
|
|
if (ch->ch_digi.digi_maxcps < 1)
|
|
ch->ch_digi.digi_maxcps = 1;
|
|
|
|
if (ch->ch_digi.digi_maxcps > 10000)
|
|
ch->ch_digi.digi_maxcps = 10000;
|
|
|
|
if (ch->ch_digi.digi_bufsize < 10)
|
|
ch->ch_digi.digi_bufsize = 10;
|
|
|
|
if (ch->ch_digi.digi_maxchar < 1)
|
|
ch->ch_digi.digi_maxchar = 1;
|
|
|
|
if (ch->ch_digi.digi_maxchar > ch->ch_digi.digi_bufsize)
|
|
ch->ch_digi.digi_maxchar = ch->ch_digi.digi_bufsize;
|
|
|
|
if (ch->ch_digi.digi_onlen > DIGI_PLEN)
|
|
ch->ch_digi.digi_onlen = DIGI_PLEN;
|
|
|
|
if (ch->ch_digi.digi_offlen > DIGI_PLEN)
|
|
ch->ch_digi.digi_offlen = DIGI_PLEN;
|
|
|
|
dgap_param(tty);
|
|
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
|
|
DPR_IOCTL(("DIGI_SETA finish\n"));
|
|
|
|
return(0);
|
|
}
|
|
|
|
|
|
/*
|
|
* dgap_tty_digigetedelay()
|
|
*
|
|
* Ioctl to get the current edelay setting.
|
|
*
|
|
*
|
|
*
|
|
*/
|
|
static int dgap_tty_digigetedelay(struct tty_struct *tty, int __user *retinfo)
|
|
{
|
|
struct channel_t *ch;
|
|
struct un_t *un;
|
|
int tmp;
|
|
ulong lock_flags;
|
|
|
|
if (!retinfo)
|
|
return (-EFAULT);
|
|
|
|
if (!tty || tty->magic != TTY_MAGIC)
|
|
return (-EFAULT);
|
|
|
|
un = tty->driver_data;
|
|
if (!un || un->magic != DGAP_UNIT_MAGIC)
|
|
return (-EFAULT);
|
|
|
|
ch = un->un_ch;
|
|
if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
|
|
return (-EFAULT);
|
|
|
|
memset(&tmp, 0, sizeof(tmp));
|
|
|
|
DGAP_LOCK(ch->ch_lock, lock_flags);
|
|
tmp = readw(&(ch->ch_bs->edelay));
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags);
|
|
|
|
if (copy_to_user(retinfo, &tmp, sizeof(*retinfo)))
|
|
return (-EFAULT);
|
|
|
|
return (0);
|
|
}
|
|
|
|
|
|
/*
|
|
* dgap_tty_digisetedelay()
|
|
*
|
|
* Ioctl to set the EDELAY setting
|
|
*
|
|
*/
|
|
static int dgap_tty_digisetedelay(struct tty_struct *tty, int __user *new_info)
|
|
{
|
|
struct board_t *bd;
|
|
struct channel_t *ch;
|
|
struct un_t *un;
|
|
int new_digi;
|
|
ulong lock_flags;
|
|
ulong lock_flags2;
|
|
|
|
DPR_IOCTL(("DIGI_SETA start\n"));
|
|
|
|
if (!tty || tty->magic != TTY_MAGIC)
|
|
return (-EFAULT);
|
|
|
|
un = tty->driver_data;
|
|
if (!un || un->magic != DGAP_UNIT_MAGIC)
|
|
return (-EFAULT);
|
|
|
|
ch = un->un_ch;
|
|
if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
|
|
return (-EFAULT);
|
|
|
|
bd = ch->ch_bd;
|
|
if (!bd || bd->magic != DGAP_BOARD_MAGIC)
|
|
return (-EFAULT);
|
|
|
|
if (copy_from_user(&new_digi, new_info, sizeof(int))) {
|
|
DPR_IOCTL(("DIGI_SETEDELAY failed copy_from_user\n"));
|
|
return(-EFAULT);
|
|
}
|
|
|
|
DGAP_LOCK(bd->bd_lock, lock_flags);
|
|
DGAP_LOCK(ch->ch_lock, lock_flags2);
|
|
|
|
writew((u16) new_digi, &(ch->ch_bs->edelay));
|
|
|
|
dgap_param(tty);
|
|
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
|
|
DPR_IOCTL(("DIGI_SETA finish\n"));
|
|
|
|
return(0);
|
|
}
|
|
|
|
|
|
/*
|
|
* dgap_tty_digigetcustombaud()
|
|
*
|
|
* Ioctl to get the current custom baud rate setting.
|
|
*/
|
|
static int dgap_tty_digigetcustombaud(struct tty_struct *tty, int __user *retinfo)
|
|
{
|
|
struct channel_t *ch;
|
|
struct un_t *un;
|
|
int tmp;
|
|
ulong lock_flags;
|
|
|
|
if (!retinfo)
|
|
return (-EFAULT);
|
|
|
|
if (!tty || tty->magic != TTY_MAGIC)
|
|
return (-EFAULT);
|
|
|
|
un = tty->driver_data;
|
|
if (!un || un->magic != DGAP_UNIT_MAGIC)
|
|
return (-EFAULT);
|
|
|
|
ch = un->un_ch;
|
|
if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
|
|
return (-EFAULT);
|
|
|
|
memset(&tmp, 0, sizeof(tmp));
|
|
|
|
DGAP_LOCK(ch->ch_lock, lock_flags);
|
|
tmp = dgap_get_custom_baud(ch);
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags);
|
|
|
|
DPR_IOCTL(("DIGI_GETCUSTOMBAUD. Returning %d\n", tmp));
|
|
|
|
if (copy_to_user(retinfo, &tmp, sizeof(*retinfo)))
|
|
return (-EFAULT);
|
|
|
|
return (0);
|
|
}
|
|
|
|
|
|
/*
|
|
* dgap_tty_digisetcustombaud()
|
|
*
|
|
* Ioctl to set the custom baud rate setting
|
|
*/
|
|
static int dgap_tty_digisetcustombaud(struct tty_struct *tty, int __user *new_info)
|
|
{
|
|
struct board_t *bd;
|
|
struct channel_t *ch;
|
|
struct un_t *un;
|
|
uint new_rate;
|
|
ulong lock_flags;
|
|
ulong lock_flags2;
|
|
|
|
DPR_IOCTL(("DIGI_SETCUSTOMBAUD start\n"));
|
|
|
|
if (!tty || tty->magic != TTY_MAGIC)
|
|
return (-EFAULT);
|
|
|
|
un = tty->driver_data;
|
|
if (!un || un->magic != DGAP_UNIT_MAGIC)
|
|
return (-EFAULT);
|
|
|
|
ch = un->un_ch;
|
|
if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
|
|
return (-EFAULT);
|
|
|
|
bd = ch->ch_bd;
|
|
if (!bd || bd->magic != DGAP_BOARD_MAGIC)
|
|
return (-EFAULT);
|
|
|
|
|
|
if (copy_from_user(&new_rate, new_info, sizeof(unsigned int))) {
|
|
DPR_IOCTL(("DIGI_SETCUSTOMBAUD failed copy_from_user\n"));
|
|
return(-EFAULT);
|
|
}
|
|
|
|
if (bd->bd_flags & BD_FEP5PLUS) {
|
|
|
|
DPR_IOCTL(("DIGI_SETCUSTOMBAUD. Setting %d\n", new_rate));
|
|
|
|
DGAP_LOCK(bd->bd_lock, lock_flags);
|
|
DGAP_LOCK(ch->ch_lock, lock_flags2);
|
|
|
|
ch->ch_custom_speed = new_rate;
|
|
|
|
dgap_param(tty);
|
|
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
}
|
|
|
|
DPR_IOCTL(("DIGI_SETCUSTOMBAUD finish\n"));
|
|
|
|
return(0);
|
|
}
|
|
|
|
|
|
/*
|
|
* dgap_set_termios()
|
|
*/
|
|
static void dgap_tty_set_termios(struct tty_struct *tty, struct ktermios *old_termios)
|
|
{
|
|
struct board_t *bd;
|
|
struct channel_t *ch;
|
|
struct un_t *un;
|
|
unsigned long lock_flags;
|
|
unsigned long lock_flags2;
|
|
|
|
if (!tty || tty->magic != TTY_MAGIC)
|
|
return;
|
|
|
|
un = tty->driver_data;
|
|
if (!un || un->magic != DGAP_UNIT_MAGIC)
|
|
return;
|
|
|
|
ch = un->un_ch;
|
|
if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
|
|
return;
|
|
|
|
bd = ch->ch_bd;
|
|
if (!bd || bd->magic != DGAP_BOARD_MAGIC)
|
|
return;
|
|
|
|
DGAP_LOCK(bd->bd_lock, lock_flags);
|
|
DGAP_LOCK(ch->ch_lock, lock_flags2);
|
|
|
|
ch->ch_c_cflag = tty->termios.c_cflag;
|
|
ch->ch_c_iflag = tty->termios.c_iflag;
|
|
ch->ch_c_oflag = tty->termios.c_oflag;
|
|
ch->ch_c_lflag = tty->termios.c_lflag;
|
|
ch->ch_startc = tty->termios.c_cc[VSTART];
|
|
ch->ch_stopc = tty->termios.c_cc[VSTOP];
|
|
|
|
dgap_carrier(ch);
|
|
dgap_param(tty);
|
|
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
}
|
|
|
|
|
|
static void dgap_tty_throttle(struct tty_struct *tty)
|
|
{
|
|
struct board_t *bd;
|
|
struct channel_t *ch;
|
|
struct un_t *un;
|
|
ulong lock_flags;
|
|
ulong lock_flags2;
|
|
|
|
if (!tty || tty->magic != TTY_MAGIC)
|
|
return;
|
|
|
|
un = tty->driver_data;
|
|
if (!un || un->magic != DGAP_UNIT_MAGIC)
|
|
return;
|
|
|
|
ch = un->un_ch;
|
|
if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
|
|
return;
|
|
|
|
bd = ch->ch_bd;
|
|
if (!bd || bd->magic != DGAP_BOARD_MAGIC)
|
|
return;
|
|
|
|
DPR_IOCTL(("dgap_tty_throttle start\n"));
|
|
|
|
DGAP_LOCK(bd->bd_lock, lock_flags);
|
|
DGAP_LOCK(ch->ch_lock, lock_flags2);
|
|
|
|
ch->ch_flags |= (CH_RXBLOCK);
|
|
#if 1
|
|
dgap_cmdw(ch, RPAUSE, 0, 0);
|
|
#endif
|
|
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
|
|
DPR_IOCTL(("dgap_tty_throttle finish\n"));
|
|
}
|
|
|
|
|
|
static void dgap_tty_unthrottle(struct tty_struct *tty)
|
|
{
|
|
struct board_t *bd;
|
|
struct channel_t *ch;
|
|
struct un_t *un;
|
|
ulong lock_flags;
|
|
ulong lock_flags2;
|
|
|
|
if (!tty || tty->magic != TTY_MAGIC)
|
|
return;
|
|
|
|
un = tty->driver_data;
|
|
if (!un || un->magic != DGAP_UNIT_MAGIC)
|
|
return;
|
|
|
|
ch = un->un_ch;
|
|
if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
|
|
return;
|
|
|
|
bd = ch->ch_bd;
|
|
if (!bd || bd->magic != DGAP_BOARD_MAGIC)
|
|
return;
|
|
|
|
DPR_IOCTL(("dgap_tty_unthrottle start\n"));
|
|
|
|
DGAP_LOCK(bd->bd_lock, lock_flags);
|
|
DGAP_LOCK(ch->ch_lock, lock_flags2);
|
|
|
|
ch->ch_flags &= ~(CH_RXBLOCK);
|
|
|
|
#if 1
|
|
dgap_cmdw(ch, RRESUME, 0, 0);
|
|
#endif
|
|
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
|
|
DPR_IOCTL(("dgap_tty_unthrottle finish\n"));
|
|
}
|
|
|
|
|
|
static void dgap_tty_start(struct tty_struct *tty)
|
|
{
|
|
struct board_t *bd;
|
|
struct channel_t *ch;
|
|
struct un_t *un;
|
|
ulong lock_flags;
|
|
ulong lock_flags2;
|
|
|
|
if (!tty || tty->magic != TTY_MAGIC)
|
|
return;
|
|
|
|
un = tty->driver_data;
|
|
if (!un || un->magic != DGAP_UNIT_MAGIC)
|
|
return;
|
|
|
|
ch = un->un_ch;
|
|
if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
|
|
return;
|
|
|
|
bd = ch->ch_bd;
|
|
if (!bd || bd->magic != DGAP_BOARD_MAGIC)
|
|
return;
|
|
|
|
DPR_IOCTL(("dgap_tty_start start\n"));
|
|
|
|
DGAP_LOCK(bd->bd_lock, lock_flags);
|
|
DGAP_LOCK(ch->ch_lock, lock_flags2);
|
|
|
|
dgap_cmdw(ch, RESUMETX, 0, 0);
|
|
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
|
|
DPR_IOCTL(("dgap_tty_start finish\n"));
|
|
}
|
|
|
|
|
|
static void dgap_tty_stop(struct tty_struct *tty)
|
|
{
|
|
struct board_t *bd;
|
|
struct channel_t *ch;
|
|
struct un_t *un;
|
|
ulong lock_flags;
|
|
ulong lock_flags2;
|
|
|
|
if (!tty || tty->magic != TTY_MAGIC)
|
|
return;
|
|
|
|
un = tty->driver_data;
|
|
if (!un || un->magic != DGAP_UNIT_MAGIC)
|
|
return;
|
|
|
|
ch = un->un_ch;
|
|
if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
|
|
return;
|
|
|
|
bd = ch->ch_bd;
|
|
if (!bd || bd->magic != DGAP_BOARD_MAGIC)
|
|
return;
|
|
|
|
DPR_IOCTL(("dgap_tty_stop start\n"));
|
|
|
|
DGAP_LOCK(bd->bd_lock, lock_flags);
|
|
DGAP_LOCK(ch->ch_lock, lock_flags2);
|
|
|
|
dgap_cmdw(ch, PAUSETX, 0, 0);
|
|
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
|
|
DPR_IOCTL(("dgap_tty_stop finish\n"));
|
|
}
|
|
|
|
|
|
/*
|
|
* dgap_tty_flush_chars()
|
|
*
|
|
* Flush the cook buffer
|
|
*
|
|
* Note to self, and any other poor souls who venture here:
|
|
*
|
|
* flush in this case DOES NOT mean dispose of the data.
|
|
* instead, it means "stop buffering and send it if you
|
|
* haven't already." Just guess how I figured that out... SRW 2-Jun-98
|
|
*
|
|
* It is also always called in interrupt context - JAR 8-Sept-99
|
|
*/
|
|
static void dgap_tty_flush_chars(struct tty_struct *tty)
|
|
{
|
|
struct board_t *bd;
|
|
struct channel_t *ch;
|
|
struct un_t *un;
|
|
ulong lock_flags;
|
|
ulong lock_flags2;
|
|
|
|
if (!tty || tty->magic != TTY_MAGIC)
|
|
return;
|
|
|
|
un = tty->driver_data;
|
|
if (!un || un->magic != DGAP_UNIT_MAGIC)
|
|
return;
|
|
|
|
ch = un->un_ch;
|
|
if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
|
|
return;
|
|
|
|
bd = ch->ch_bd;
|
|
if (!bd || bd->magic != DGAP_BOARD_MAGIC)
|
|
return;
|
|
|
|
DPR_IOCTL(("dgap_tty_flush_chars start\n"));
|
|
|
|
DGAP_LOCK(bd->bd_lock, lock_flags);
|
|
DGAP_LOCK(ch->ch_lock, lock_flags2);
|
|
|
|
/* TODO: Do something here */
|
|
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
|
|
DPR_IOCTL(("dgap_tty_flush_chars finish\n"));
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
* dgap_tty_flush_buffer()
|
|
*
|
|
* Flush Tx buffer (make in == out)
|
|
*/
|
|
static void dgap_tty_flush_buffer(struct tty_struct *tty)
|
|
{
|
|
struct board_t *bd;
|
|
struct channel_t *ch;
|
|
struct un_t *un;
|
|
ulong lock_flags;
|
|
ulong lock_flags2;
|
|
u16 head = 0;
|
|
|
|
if (!tty || tty->magic != TTY_MAGIC)
|
|
return;
|
|
|
|
un = tty->driver_data;
|
|
if (!un || un->magic != DGAP_UNIT_MAGIC)
|
|
return;
|
|
|
|
ch = un->un_ch;
|
|
if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
|
|
return;
|
|
|
|
bd = ch->ch_bd;
|
|
if (!bd || bd->magic != DGAP_BOARD_MAGIC)
|
|
return;
|
|
|
|
DPR_IOCTL(("dgap_tty_flush_buffer on port: %d start\n", ch->ch_portnum));
|
|
|
|
DGAP_LOCK(bd->bd_lock, lock_flags);
|
|
DGAP_LOCK(ch->ch_lock, lock_flags2);
|
|
|
|
ch->ch_flags &= ~CH_STOP;
|
|
head = readw(&(ch->ch_bs->tx_head));
|
|
dgap_cmdw(ch, FLUSHTX, (u16) head, 0);
|
|
dgap_cmdw(ch, RESUMETX, 0, 0);
|
|
if (ch->ch_tun.un_flags & (UN_LOW|UN_EMPTY)) {
|
|
ch->ch_tun.un_flags &= ~(UN_LOW|UN_EMPTY);
|
|
wake_up_interruptible(&ch->ch_tun.un_flags_wait);
|
|
}
|
|
if (ch->ch_pun.un_flags & (UN_LOW|UN_EMPTY)) {
|
|
ch->ch_pun.un_flags &= ~(UN_LOW|UN_EMPTY);
|
|
wake_up_interruptible(&ch->ch_pun.un_flags_wait);
|
|
}
|
|
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
if (waitqueue_active(&tty->write_wait))
|
|
wake_up_interruptible(&tty->write_wait);
|
|
tty_wakeup(tty);
|
|
|
|
DPR_IOCTL(("dgap_tty_flush_buffer finish\n"));
|
|
}
|
|
|
|
|
|
|
|
/*****************************************************************************
|
|
*
|
|
* The IOCTL function and all of its helpers
|
|
*
|
|
*****************************************************************************/
|
|
|
|
/*
|
|
* dgap_tty_ioctl()
|
|
*
|
|
* The usual assortment of ioctl's
|
|
*/
|
|
static int dgap_tty_ioctl(struct tty_struct *tty, unsigned int cmd,
|
|
unsigned long arg)
|
|
{
|
|
struct board_t *bd;
|
|
struct channel_t *ch;
|
|
struct un_t *un;
|
|
int rc;
|
|
u16 head = 0;
|
|
ulong lock_flags = 0;
|
|
ulong lock_flags2 = 0;
|
|
void __user *uarg = (void __user *) arg;
|
|
|
|
if (!tty || tty->magic != TTY_MAGIC)
|
|
return (-ENODEV);
|
|
|
|
un = tty->driver_data;
|
|
if (!un || un->magic != DGAP_UNIT_MAGIC)
|
|
return (-ENODEV);
|
|
|
|
ch = un->un_ch;
|
|
if (!ch || ch->magic != DGAP_CHANNEL_MAGIC)
|
|
return (-ENODEV);
|
|
|
|
bd = ch->ch_bd;
|
|
if (!bd || bd->magic != DGAP_BOARD_MAGIC)
|
|
return (-ENODEV);
|
|
|
|
DPR_IOCTL(("dgap_tty_ioctl start on port %d - cmd %s (%x), arg %lx\n",
|
|
ch->ch_portnum, dgap_ioctl_name(cmd), cmd, arg));
|
|
|
|
DGAP_LOCK(bd->bd_lock, lock_flags);
|
|
DGAP_LOCK(ch->ch_lock, lock_flags2);
|
|
|
|
if (un->un_open_count <= 0) {
|
|
DPR_BASIC(("dgap_tty_ioctl - unit not open.\n"));
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
return(-EIO);
|
|
}
|
|
|
|
switch (cmd) {
|
|
|
|
/* Here are all the standard ioctl's that we MUST implement */
|
|
|
|
case TCSBRK:
|
|
/*
|
|
* TCSBRK is SVID version: non-zero arg --> no break
|
|
* this behaviour is exploited by tcdrain().
|
|
*
|
|
* According to POSIX.1 spec (7.2.2.1.2) breaks should be
|
|
* between 0.25 and 0.5 seconds so we'll ask for something
|
|
* in the middle: 0.375 seconds.
|
|
*/
|
|
rc = tty_check_change(tty);
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
if (rc) {
|
|
return(rc);
|
|
}
|
|
|
|
rc = dgap_wait_for_drain(tty);
|
|
|
|
if (rc) {
|
|
DPR_IOCTL(("dgap_tty_ioctl - bad return: %d ", rc));
|
|
return(-EINTR);
|
|
}
|
|
|
|
DGAP_LOCK(bd->bd_lock, lock_flags);
|
|
DGAP_LOCK(ch->ch_lock, lock_flags2);
|
|
|
|
if(((cmd == TCSBRK) && (!arg)) || (cmd == TCSBRKP)) {
|
|
dgap_cmdw(ch, SBREAK, (u16) SBREAK_TIME, 0);
|
|
}
|
|
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
|
|
DPR_IOCTL(("dgap_tty_ioctl finish on port %d - cmd %s (%x), arg %lx\n",
|
|
ch->ch_portnum, dgap_ioctl_name(cmd), cmd, arg));
|
|
|
|
return(0);
|
|
|
|
|
|
case TCSBRKP:
|
|
/* support for POSIX tcsendbreak()
|
|
|
|
* According to POSIX.1 spec (7.2.2.1.2) breaks should be
|
|
* between 0.25 and 0.5 seconds so we'll ask for something
|
|
* in the middle: 0.375 seconds.
|
|
*/
|
|
rc = tty_check_change(tty);
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
if (rc) {
|
|
return(rc);
|
|
}
|
|
|
|
rc = dgap_wait_for_drain(tty);
|
|
if (rc) {
|
|
DPR_IOCTL(("dgap_tty_ioctl - bad return: %d ", rc));
|
|
return(-EINTR);
|
|
}
|
|
|
|
DGAP_LOCK(bd->bd_lock, lock_flags);
|
|
DGAP_LOCK(ch->ch_lock, lock_flags2);
|
|
|
|
dgap_cmdw(ch, SBREAK, (u16) SBREAK_TIME, 0);
|
|
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
|
|
DPR_IOCTL(("dgap_tty_ioctl finish on port %d - cmd %s (%x), arg %lx\n",
|
|
ch->ch_portnum, dgap_ioctl_name(cmd), cmd, arg));
|
|
|
|
return(0);
|
|
|
|
case TIOCSBRK:
|
|
/*
|
|
* FEP5 doesn't support turning on a break unconditionally.
|
|
* The FEP5 device will stop sending a break automatically
|
|
* after the specified time value that was sent when turning on
|
|
* the break.
|
|
*/
|
|
rc = tty_check_change(tty);
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
if (rc) {
|
|
return(rc);
|
|
}
|
|
|
|
rc = dgap_wait_for_drain(tty);
|
|
if (rc) {
|
|
DPR_IOCTL(("dgap_tty_ioctl - bad return: %d ", rc));
|
|
return(-EINTR);
|
|
}
|
|
|
|
DGAP_LOCK(bd->bd_lock, lock_flags);
|
|
DGAP_LOCK(ch->ch_lock, lock_flags2);
|
|
|
|
dgap_cmdw(ch, SBREAK, (u16) SBREAK_TIME, 0);
|
|
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
|
|
DPR_IOCTL(("dgap_tty_ioctl finish on port %d - cmd %s (%x), arg %lx\n",
|
|
ch->ch_portnum, dgap_ioctl_name(cmd), cmd, arg));
|
|
|
|
return 0;
|
|
|
|
case TIOCCBRK:
|
|
/*
|
|
* FEP5 doesn't support turning off a break unconditionally.
|
|
* The FEP5 device will stop sending a break automatically
|
|
* after the specified time value that was sent when turning on
|
|
* the break.
|
|
*/
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
return 0;
|
|
|
|
case TIOCGSOFTCAR:
|
|
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
|
|
rc = put_user(C_CLOCAL(tty) ? 1 : 0, (unsigned long __user *) arg);
|
|
return(rc);
|
|
|
|
case TIOCSSOFTCAR:
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
|
|
rc = get_user(arg, (unsigned long __user *) arg);
|
|
if (rc)
|
|
return(rc);
|
|
|
|
DGAP_LOCK(bd->bd_lock, lock_flags);
|
|
DGAP_LOCK(ch->ch_lock, lock_flags2);
|
|
tty->termios.c_cflag = ((tty->termios.c_cflag & ~CLOCAL) | (arg ? CLOCAL : 0));
|
|
dgap_param(tty);
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
|
|
return(0);
|
|
|
|
case TIOCMGET:
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
return(dgap_get_modem_info(ch, uarg));
|
|
|
|
case TIOCMBIS:
|
|
case TIOCMBIC:
|
|
case TIOCMSET:
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
return(dgap_set_modem_info(tty, cmd, uarg));
|
|
|
|
/*
|
|
* Here are any additional ioctl's that we want to implement
|
|
*/
|
|
|
|
case TCFLSH:
|
|
/*
|
|
* The linux tty driver doesn't have a flush
|
|
* input routine for the driver, assuming all backed
|
|
* up data is in the line disc. buffers. However,
|
|
* we all know that's not the case. Here, we
|
|
* act on the ioctl, but then lie and say we didn't
|
|
* so the line discipline will process the flush
|
|
* also.
|
|
*/
|
|
rc = tty_check_change(tty);
|
|
if (rc) {
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
return(rc);
|
|
}
|
|
|
|
if ((arg == TCIFLUSH) || (arg == TCIOFLUSH)) {
|
|
if (!(un->un_type == DGAP_PRINT)) {
|
|
head = readw(&(ch->ch_bs->rx_head));
|
|
writew(head, &(ch->ch_bs->rx_tail));
|
|
writeb(0, &(ch->ch_bs->orun));
|
|
}
|
|
}
|
|
|
|
if ((arg == TCOFLUSH) || (arg == TCIOFLUSH)) {
|
|
ch->ch_flags &= ~CH_STOP;
|
|
head = readw(&(ch->ch_bs->tx_head));
|
|
dgap_cmdw(ch, FLUSHTX, (u16) head, 0 );
|
|
dgap_cmdw(ch, RESUMETX, 0, 0);
|
|
if (ch->ch_tun.un_flags & (UN_LOW|UN_EMPTY)) {
|
|
ch->ch_tun.un_flags &= ~(UN_LOW|UN_EMPTY);
|
|
wake_up_interruptible(&ch->ch_tun.un_flags_wait);
|
|
}
|
|
if (ch->ch_pun.un_flags & (UN_LOW|UN_EMPTY)) {
|
|
ch->ch_pun.un_flags &= ~(UN_LOW|UN_EMPTY);
|
|
wake_up_interruptible(&ch->ch_pun.un_flags_wait);
|
|
}
|
|
if (waitqueue_active(&tty->write_wait))
|
|
wake_up_interruptible(&tty->write_wait);
|
|
|
|
/* Can't hold any locks when calling tty_wakeup! */
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
tty_wakeup(tty);
|
|
DGAP_LOCK(bd->bd_lock, lock_flags);
|
|
DGAP_LOCK(ch->ch_lock, lock_flags2);
|
|
}
|
|
|
|
/* pretend we didn't recognize this IOCTL */
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
|
|
DPR_IOCTL(("dgap_tty_ioctl (LINE:%d) finish on port %d - cmd %s (%x), arg %lx\n",
|
|
__LINE__, ch->ch_portnum, dgap_ioctl_name(cmd), cmd, arg));
|
|
|
|
return(-ENOIOCTLCMD);
|
|
|
|
case TCSETSF:
|
|
case TCSETSW:
|
|
/*
|
|
* The linux tty driver doesn't have a flush
|
|
* input routine for the driver, assuming all backed
|
|
* up data is in the line disc. buffers. However,
|
|
* we all know that's not the case. Here, we
|
|
* act on the ioctl, but then lie and say we didn't
|
|
* so the line discipline will process the flush
|
|
* also.
|
|
*/
|
|
if (cmd == TCSETSF) {
|
|
/* flush rx */
|
|
ch->ch_flags &= ~CH_STOP;
|
|
head = readw(&(ch->ch_bs->rx_head));
|
|
writew(head, &(ch->ch_bs->rx_tail));
|
|
}
|
|
|
|
/* now wait for all the output to drain */
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
rc = dgap_wait_for_drain(tty);
|
|
if (rc) {
|
|
DPR_IOCTL(("dgap_tty_ioctl - bad return: %d ", rc));
|
|
return(-EINTR);
|
|
}
|
|
|
|
DPR_IOCTL(("dgap_tty_ioctl finish on port %d - cmd %s (%x), arg %lx\n",
|
|
ch->ch_portnum, dgap_ioctl_name(cmd), cmd, arg));
|
|
|
|
/* pretend we didn't recognize this */
|
|
return(-ENOIOCTLCMD);
|
|
|
|
case TCSETAW:
|
|
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
rc = dgap_wait_for_drain(tty);
|
|
if (rc) {
|
|
DPR_IOCTL(("dgap_tty_ioctl - bad return: %d ", rc));
|
|
return(-EINTR);
|
|
}
|
|
|
|
/* pretend we didn't recognize this */
|
|
return(-ENOIOCTLCMD);
|
|
|
|
case TCXONC:
|
|
/*
|
|
* The Linux Line Discipline (LD) would do this for us if we
|
|
* let it, but we have the special firmware options to do this
|
|
* the "right way" regardless of hardware or software flow
|
|
* control so we'll do it outselves instead of letting the LD
|
|
* do it.
|
|
*/
|
|
rc = tty_check_change(tty);
|
|
if (rc) {
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
return(rc);
|
|
}
|
|
|
|
DPR_IOCTL(("dgap_ioctl - in TCXONC - %d\n", cmd));
|
|
switch (arg) {
|
|
|
|
case TCOON:
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
dgap_tty_start(tty);
|
|
return(0);
|
|
case TCOOFF:
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
dgap_tty_stop(tty);
|
|
return(0);
|
|
case TCION:
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
/* Make the ld do it */
|
|
return(-ENOIOCTLCMD);
|
|
case TCIOFF:
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
/* Make the ld do it */
|
|
return(-ENOIOCTLCMD);
|
|
default:
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
return(-EINVAL);
|
|
}
|
|
|
|
case DIGI_GETA:
|
|
/* get information for ditty */
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
return(dgap_tty_digigeta(tty, uarg));
|
|
|
|
case DIGI_SETAW:
|
|
case DIGI_SETAF:
|
|
|
|
/* set information for ditty */
|
|
if (cmd == (DIGI_SETAW)) {
|
|
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
rc = dgap_wait_for_drain(tty);
|
|
if (rc) {
|
|
DPR_IOCTL(("dgap_tty_ioctl - bad return: %d ", rc));
|
|
return(-EINTR);
|
|
}
|
|
DGAP_LOCK(bd->bd_lock, lock_flags);
|
|
DGAP_LOCK(ch->ch_lock, lock_flags2);
|
|
}
|
|
else {
|
|
tty_ldisc_flush(tty);
|
|
}
|
|
/* fall thru */
|
|
|
|
case DIGI_SETA:
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
return(dgap_tty_digiseta(tty, uarg));
|
|
|
|
case DIGI_GEDELAY:
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
return(dgap_tty_digigetedelay(tty, uarg));
|
|
|
|
case DIGI_SEDELAY:
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
return(dgap_tty_digisetedelay(tty, uarg));
|
|
|
|
case DIGI_GETCUSTOMBAUD:
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
return(dgap_tty_digigetcustombaud(tty, uarg));
|
|
|
|
case DIGI_SETCUSTOMBAUD:
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
return(dgap_tty_digisetcustombaud(tty, uarg));
|
|
|
|
case DIGI_RESET_PORT:
|
|
dgap_firmware_reset_port(ch);
|
|
dgap_param(tty);
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
return 0;
|
|
|
|
default:
|
|
DGAP_UNLOCK(ch->ch_lock, lock_flags2);
|
|
DGAP_UNLOCK(bd->bd_lock, lock_flags);
|
|
|
|
DPR_IOCTL(("dgap_tty_ioctl - in default\n"));
|
|
DPR_IOCTL(("dgap_tty_ioctl end - cmd %s (%x), arg %lx\n",
|
|
dgap_ioctl_name(cmd), cmd, arg));
|
|
|
|
return(-ENOIOCTLCMD);
|
|
}
|
|
}
|