2895 lines
		
	
	
		
			75 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			2895 lines
		
	
	
		
			75 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
/* sx.c -- driver for the Specialix SX series cards. 
 | 
						|
 *
 | 
						|
 *  This driver will also support the older SI, and XIO cards.
 | 
						|
 *
 | 
						|
 *
 | 
						|
 *   (C) 1998 - 2004  R.E.Wolff@BitWizard.nl
 | 
						|
 *
 | 
						|
 *  Simon Allen (simonallen@cix.compulink.co.uk) wrote a previous
 | 
						|
 *  version of this driver. Some fragments may have been copied. (none
 | 
						|
 *  yet :-)
 | 
						|
 *
 | 
						|
 * Specialix pays for the development and support of this driver.
 | 
						|
 * Please DO contact support@specialix.co.uk if you require
 | 
						|
 * support. But please read the documentation (sx.txt) first.
 | 
						|
 *
 | 
						|
 *
 | 
						|
 *
 | 
						|
 *      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 of
 | 
						|
 *      the License, or (at your option) any later version.
 | 
						|
 *
 | 
						|
 *      This program is distributed in the hope that it will be
 | 
						|
 *      useful, but WITHOUT ANY WARRANTY; without even the implied
 | 
						|
 *      warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR
 | 
						|
 *      PURPOSE.  See the GNU General Public License for more details.
 | 
						|
 *
 | 
						|
 *      You should have received a copy of the GNU General Public
 | 
						|
 *      License along with this program; if not, write to the Free
 | 
						|
 *      Software Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139,
 | 
						|
 *      USA.
 | 
						|
 *
 | 
						|
 * Revision history:
 | 
						|
 * Revision 1.33  2000/03/09 10:00:00  pvdl,wolff
 | 
						|
 * - Fixed module and port counting
 | 
						|
 * - Fixed signal handling
 | 
						|
 * - Fixed an Ooops
 | 
						|
 * 
 | 
						|
 * Revision 1.32  2000/03/07 09:00:00  wolff,pvdl
 | 
						|
 * - Fixed some sx_dprintk typos
 | 
						|
 * - added detection for an invalid board/module configuration
 | 
						|
 *
 | 
						|
 * Revision 1.31  2000/03/06 12:00:00  wolff,pvdl
 | 
						|
 * - Added support for EISA
 | 
						|
 *
 | 
						|
 * Revision 1.30  2000/01/21 17:43:06  wolff
 | 
						|
 * - Added support for SX+
 | 
						|
 *
 | 
						|
 * Revision 1.26  1999/08/05 15:22:14  wolff
 | 
						|
 * - Port to 2.3.x
 | 
						|
 * - Reformatted to Linus' liking.
 | 
						|
 *
 | 
						|
 * Revision 1.25  1999/07/30 14:24:08  wolff
 | 
						|
 * Had accidentally left "gs_debug" set to "-1" instead of "off" (=0).
 | 
						|
 *
 | 
						|
 * Revision 1.24  1999/07/28 09:41:52  wolff
 | 
						|
 * - I noticed the remark about use-count straying in sx.txt. I checked
 | 
						|
 *   sx_open, and found a few places where that could happen. I hope it's
 | 
						|
 *   fixed now.
 | 
						|
 *
 | 
						|
 * Revision 1.23  1999/07/28 08:56:06  wolff
 | 
						|
 * - Fixed crash when sx_firmware run twice.
 | 
						|
 * - Added sx_slowpoll as a module parameter (I guess nobody really wanted
 | 
						|
 *   to change it from the default... )
 | 
						|
 * - Fixed a stupid editing problem I introduced in 1.22.
 | 
						|
 * - Fixed dropping characters on a termios change.
 | 
						|
 *
 | 
						|
 * Revision 1.22  1999/07/26 21:01:43  wolff
 | 
						|
 * Russell Brown noticed that I had overlooked 4 out of six modem control
 | 
						|
 * signals in sx_getsignals. Ooops.
 | 
						|
 *
 | 
						|
 * Revision 1.21  1999/07/23 09:11:33  wolff
 | 
						|
 * I forgot to free dynamically allocated memory when the driver is unloaded.
 | 
						|
 *
 | 
						|
 * Revision 1.20  1999/07/20 06:25:26  wolff
 | 
						|
 * The "closing wait" wasn't honoured. Thanks to James Griffiths for
 | 
						|
 * reporting this.
 | 
						|
 *
 | 
						|
 * Revision 1.19  1999/07/11 08:59:59  wolff
 | 
						|
 * Fixed an oops in close, when an open was pending. Changed the memtest
 | 
						|
 * a bit. Should also test the board in word-mode, however my card fails the
 | 
						|
 * memtest then. I still have to figure out what is wrong...
 | 
						|
 *
 | 
						|
 * Revision 1.18  1999/06/10 09:38:42  wolff
 | 
						|
 * Changed the format of the firmware revision from %04x to %x.%02x .
 | 
						|
 *
 | 
						|
 * Revision 1.17  1999/06/04 09:44:35  wolff
 | 
						|
 * fixed problem: reference to pci stuff when config_pci was off...
 | 
						|
 * Thanks to Jorge Novo for noticing this.
 | 
						|
 *
 | 
						|
 * Revision 1.16  1999/06/02 08:30:15  wolff
 | 
						|
 * added/removed the workaround for the DCD bug in the Firmware.
 | 
						|
 * A bit more debugging code to locate that...
 | 
						|
 *
 | 
						|
 * Revision 1.15  1999/06/01 11:35:30  wolff
 | 
						|
 * when DCD is left low (floating?), on TA's the firmware first tells us
 | 
						|
 * that DCD is high, but after a short while suddenly comes to the
 | 
						|
 * conclusion that it is low. All this would be fine, if it weren't that
 | 
						|
 * Unix requires us to send a "hangup" signal in that case. This usually
 | 
						|
 * all happens BEFORE the program has had a chance to ioctl the device
 | 
						|
 * into clocal mode..
 | 
						|
 *
 | 
						|
 * Revision 1.14  1999/05/25 11:18:59  wolff
 | 
						|
 * Added PCI-fix.
 | 
						|
 * Added checks for return code of sx_sendcommand.
 | 
						|
 * Don't issue "reconfig" if port isn't open yet. (bit us on TA modules...)
 | 
						|
 *
 | 
						|
 * Revision 1.13  1999/04/29 15:18:01  wolff
 | 
						|
 * Fixed an "oops" that showed on SuSE 6.0 systems.
 | 
						|
 * Activate DTR again after stty 0.
 | 
						|
 *
 | 
						|
 * Revision 1.12  1999/04/29 07:49:52  wolff
 | 
						|
 * Improved "stty 0" handling a bit. (used to change baud to 9600 assuming
 | 
						|
 *     the connection would be dropped anyway. That is not always the case,
 | 
						|
 *     and confuses people).
 | 
						|
 * Told the card to always monitor the modem signals.
 | 
						|
 * Added support for dynamic  gs_debug adjustments.
 | 
						|
 * Now tells the rest of the system the number of ports.
 | 
						|
 *
 | 
						|
 * Revision 1.11  1999/04/24 11:11:30  wolff
 | 
						|
 * Fixed two stupid typos in the memory test.
 | 
						|
 *
 | 
						|
 * Revision 1.10  1999/04/24 10:53:39  wolff
 | 
						|
 * Added some of Christian's suggestions.
 | 
						|
 * Fixed an HW_COOK_IN bug (ISIG was not in I_OTHER. We used to trust the
 | 
						|
 * card to send the signal to the process.....)
 | 
						|
 *
 | 
						|
 * Revision 1.9  1999/04/23 07:26:38  wolff
 | 
						|
 * Included Christian Lademann's 2.0 compile-warning fixes and interrupt
 | 
						|
 *    assignment redesign.
 | 
						|
 * Cleanup of some other stuff.
 | 
						|
 *
 | 
						|
 * Revision 1.8  1999/04/16 13:05:30  wolff
 | 
						|
 * fixed a DCD change unnoticed bug.
 | 
						|
 *
 | 
						|
 * Revision 1.7  1999/04/14 22:19:51  wolff
 | 
						|
 * Fixed typo that showed up in 2.0.x builds (get_user instead of Get_user!)
 | 
						|
 *
 | 
						|
 * Revision 1.6  1999/04/13 18:40:20  wolff
 | 
						|
 * changed misc-minor to 161, as assigned by HPA.
 | 
						|
 *
 | 
						|
 * Revision 1.5  1999/04/13 15:12:25  wolff
 | 
						|
 * Fixed use-count leak when "hangup" occurred.
 | 
						|
 * Added workaround for a stupid-PCIBIOS bug.
 | 
						|
 *
 | 
						|
 *
 | 
						|
 * Revision 1.4  1999/04/01 22:47:40  wolff
 | 
						|
 * Fixed < 1M linux-2.0 problem.
 | 
						|
 * (vremap isn't compatible with ioremap in that case)
 | 
						|
 *
 | 
						|
 * Revision 1.3  1999/03/31 13:45:45  wolff
 | 
						|
 * Firmware loading is now done through a separate IOCTL.
 | 
						|
 *
 | 
						|
 * Revision 1.2  1999/03/28 12:22:29  wolff
 | 
						|
 * rcs cleanup
 | 
						|
 *
 | 
						|
 * Revision 1.1  1999/03/28 12:10:34  wolff
 | 
						|
 * Readying for release on 2.0.x (sorry David, 1.01 becomes 1.1 for RCS). 
 | 
						|
 *
 | 
						|
 * Revision 0.12  1999/03/28 09:20:10  wolff
 | 
						|
 * Fixed problem in 0.11, continueing cleanup.
 | 
						|
 *
 | 
						|
 * Revision 0.11  1999/03/28 08:46:44  wolff
 | 
						|
 * cleanup. Not good.
 | 
						|
 *
 | 
						|
 * Revision 0.10  1999/03/28 08:09:43  wolff
 | 
						|
 * Fixed loosing characters on close.
 | 
						|
 *
 | 
						|
 * Revision 0.9  1999/03/21 22:52:01  wolff
 | 
						|
 * Ported back to 2.2.... (minor things)
 | 
						|
 *
 | 
						|
 * Revision 0.8  1999/03/21 22:40:33  wolff
 | 
						|
 * Port to 2.0
 | 
						|
 *
 | 
						|
 * Revision 0.7  1999/03/21 19:06:34  wolff
 | 
						|
 * Fixed hangup processing.
 | 
						|
 *
 | 
						|
 * Revision 0.6  1999/02/05 08:45:14  wolff
 | 
						|
 * fixed real_raw problems. Inclusion into kernel imminent.
 | 
						|
 *
 | 
						|
 * Revision 0.5  1998/12/21 23:51:06  wolff
 | 
						|
 * Snatched a nasty bug: sx_transmit_chars was getting re-entered, and it
 | 
						|
 * shouldn't have. THATs why I want to have transmit interrupts even when
 | 
						|
 * the buffer is empty.
 | 
						|
 *
 | 
						|
 * Revision 0.4  1998/12/17 09:34:46  wolff
 | 
						|
 * PPP works. ioctl works. Basically works!
 | 
						|
 *
 | 
						|
 * Revision 0.3  1998/12/15 13:05:18  wolff
 | 
						|
 * It works! Wow! Gotta start implementing IOCTL and stuff....
 | 
						|
 *
 | 
						|
 * Revision 0.2  1998/12/01 08:33:53  wolff
 | 
						|
 * moved over to 2.1.130
 | 
						|
 *
 | 
						|
 * Revision 0.1  1998/11/03 21:23:51  wolff
 | 
						|
 * Initial revision. Detects SX card.
 | 
						|
 *
 | 
						|
 * */
 | 
						|
 | 
						|
#define SX_VERSION	1.33
 | 
						|
 | 
						|
#include <linux/module.h>
 | 
						|
#include <linux/kdev_t.h>
 | 
						|
#include <linux/kernel.h>
 | 
						|
#include <linux/sched.h>
 | 
						|
#include <linux/ioport.h>
 | 
						|
#include <linux/interrupt.h>
 | 
						|
#include <linux/errno.h>
 | 
						|
#include <linux/tty.h>
 | 
						|
#include <linux/tty_flip.h>
 | 
						|
#include <linux/mm.h>
 | 
						|
#include <linux/serial.h>
 | 
						|
#include <linux/fcntl.h>
 | 
						|
#include <linux/major.h>
 | 
						|
#include <linux/delay.h>
 | 
						|
#include <linux/eisa.h>
 | 
						|
#include <linux/pci.h>
 | 
						|
#include <linux/slab.h>
 | 
						|
#include <linux/smp_lock.h>
 | 
						|
#include <linux/init.h>
 | 
						|
#include <linux/miscdevice.h>
 | 
						|
#include <linux/bitops.h>
 | 
						|
 | 
						|
#include <asm/io.h>
 | 
						|
#include <asm/uaccess.h>
 | 
						|
 | 
						|
/* The 3.0.0 version of sxboards/sxwindow.h  uses BYTE and WORD.... */
 | 
						|
#define BYTE u8
 | 
						|
#define WORD u16
 | 
						|
 | 
						|
/* .... but the 3.0.4 version uses _u8 and _u16. */
 | 
						|
#define _u8 u8
 | 
						|
#define _u16 u16
 | 
						|
 | 
						|
#include "sxboards.h"
 | 
						|
#include "sxwindow.h"
 | 
						|
 | 
						|
#include <linux/generic_serial.h>
 | 
						|
#include "sx.h"
 | 
						|
 | 
						|
/* I don't think that this driver can handle more than 256 ports on
 | 
						|
   one machine. You'll have to increase the number of boards in sx.h
 | 
						|
   if you want more than 4 boards.  */
 | 
						|
 | 
						|
#ifndef PCI_DEVICE_ID_SPECIALIX_SX_XIO_IO8
 | 
						|
#define PCI_DEVICE_ID_SPECIALIX_SX_XIO_IO8 0x2000
 | 
						|
#endif
 | 
						|
 | 
						|
/* Configurable options: 
 | 
						|
   (Don't be too sure that it'll work if you toggle them) */
 | 
						|
 | 
						|
/* Am I paranoid or not ? ;-) */
 | 
						|
#undef SX_PARANOIA_CHECK
 | 
						|
 | 
						|
/* 20 -> 2000 per second. The card should rate-limit interrupts at 100
 | 
						|
   Hz, but it is user configurable. I don't recommend going above 1000
 | 
						|
   Hz. The interrupt ratelimit might trigger if the interrupt is
 | 
						|
   shared with a very active other device. */
 | 
						|
#define IRQ_RATE_LIMIT 20
 | 
						|
 | 
						|
/* Sharing interrupts is possible now. If the other device wants more
 | 
						|
   than 2000 interrupts per second, we'd gracefully decline further
 | 
						|
   interrupts. That's not what we want. On the other hand, if the
 | 
						|
   other device interrupts 2000 times a second, don't use the SX
 | 
						|
   interrupt. Use polling. */
 | 
						|
#undef IRQ_RATE_LIMIT
 | 
						|
 | 
						|
#if 0
 | 
						|
/* Not implemented */
 | 
						|
/* 
 | 
						|
 * The following defines are mostly for testing purposes. But if you need
 | 
						|
 * some nice reporting in your syslog, you can define them also.
 | 
						|
 */
 | 
						|
#define SX_REPORT_FIFO
 | 
						|
#define SX_REPORT_OVERRUN
 | 
						|
#endif
 | 
						|
 | 
						|
/* Function prototypes */
 | 
						|
static void sx_disable_tx_interrupts(void *ptr);
 | 
						|
static void sx_enable_tx_interrupts(void *ptr);
 | 
						|
static void sx_disable_rx_interrupts(void *ptr);
 | 
						|
static void sx_enable_rx_interrupts(void *ptr);
 | 
						|
static int sx_carrier_raised(struct tty_port *port);
 | 
						|
static void sx_shutdown_port(void *ptr);
 | 
						|
static int sx_set_real_termios(void *ptr);
 | 
						|
static void sx_close(void *ptr);
 | 
						|
static int sx_chars_in_buffer(void *ptr);
 | 
						|
static int sx_init_board(struct sx_board *board);
 | 
						|
static int sx_init_portstructs(int nboards, int nports);
 | 
						|
static long sx_fw_ioctl(struct file *filp, unsigned int cmd,
 | 
						|
						unsigned long arg);
 | 
						|
static int sx_init_drivers(void);
 | 
						|
 | 
						|
static struct tty_driver *sx_driver;
 | 
						|
 | 
						|
static DEFINE_MUTEX(sx_boards_lock);
 | 
						|
static struct sx_board boards[SX_NBOARDS];
 | 
						|
static struct sx_port *sx_ports;
 | 
						|
static int sx_initialized;
 | 
						|
static int sx_nports;
 | 
						|
static int sx_debug;
 | 
						|
 | 
						|
/* You can have the driver poll your card. 
 | 
						|
    - Set sx_poll to 1 to poll every timer tick (10ms on Intel). 
 | 
						|
      This is used when the card cannot use an interrupt for some reason.
 | 
						|
 | 
						|
    - set sx_slowpoll to 100 to do an extra poll once a second (on Intel). If 
 | 
						|
      the driver misses an interrupt (report this if it DOES happen to you!)
 | 
						|
      everything will continue to work.... 
 | 
						|
 */
 | 
						|
static int sx_poll = 1;
 | 
						|
static int sx_slowpoll;
 | 
						|
 | 
						|
/* The card limits the number of interrupts per second. 
 | 
						|
   At 115k2 "100" should be sufficient. 
 | 
						|
   If you're using higher baudrates, you can increase this...
 | 
						|
 */
 | 
						|
 | 
						|
static int sx_maxints = 100;
 | 
						|
 | 
						|
#ifdef CONFIG_ISA
 | 
						|
 | 
						|
/* These are the only open spaces in my computer. Yours may have more
 | 
						|
   or less.... -- REW 
 | 
						|
   duh: Card at 0xa0000 is possible on HP Netserver?? -- pvdl
 | 
						|
*/
 | 
						|
static int sx_probe_addrs[] = {
 | 
						|
	0xc0000, 0xd0000, 0xe0000,
 | 
						|
	0xc8000, 0xd8000, 0xe8000
 | 
						|
};
 | 
						|
static int si_probe_addrs[] = {
 | 
						|
	0xc0000, 0xd0000, 0xe0000,
 | 
						|
	0xc8000, 0xd8000, 0xe8000, 0xa0000
 | 
						|
};
 | 
						|
static int si1_probe_addrs[] = {
 | 
						|
	0xd0000
 | 
						|
};
 | 
						|
 | 
						|
#define NR_SX_ADDRS ARRAY_SIZE(sx_probe_addrs)
 | 
						|
#define NR_SI_ADDRS ARRAY_SIZE(si_probe_addrs)
 | 
						|
#define NR_SI1_ADDRS ARRAY_SIZE(si1_probe_addrs)
 | 
						|
 | 
						|
module_param_array(sx_probe_addrs, int, NULL, 0);
 | 
						|
module_param_array(si_probe_addrs, int, NULL, 0);
 | 
						|
#endif
 | 
						|
 | 
						|
/* Set the mask to all-ones. This alas, only supports 32 interrupts. 
 | 
						|
   Some architectures may need more. */
 | 
						|
static int sx_irqmask = -1;
 | 
						|
 | 
						|
module_param(sx_poll, int, 0);
 | 
						|
module_param(sx_slowpoll, int, 0);
 | 
						|
module_param(sx_maxints, int, 0);
 | 
						|
module_param(sx_debug, int, 0);
 | 
						|
module_param(sx_irqmask, int, 0);
 | 
						|
 | 
						|
MODULE_LICENSE("GPL");
 | 
						|
 | 
						|
static struct real_driver sx_real_driver = {
 | 
						|
	sx_disable_tx_interrupts,
 | 
						|
	sx_enable_tx_interrupts,
 | 
						|
	sx_disable_rx_interrupts,
 | 
						|
	sx_enable_rx_interrupts,
 | 
						|
	sx_shutdown_port,
 | 
						|
	sx_set_real_termios,
 | 
						|
	sx_chars_in_buffer,
 | 
						|
	sx_close,
 | 
						|
};
 | 
						|
 | 
						|
/* 
 | 
						|
   This driver can spew a whole lot of debugging output at you. If you
 | 
						|
   need maximum performance, you should disable the DEBUG define. To
 | 
						|
   aid in debugging in the field, I'm leaving the compile-time debug
 | 
						|
   features enabled, and disable them "runtime". That allows me to
 | 
						|
   instruct people with problems to enable debugging without requiring
 | 
						|
   them to recompile... 
 | 
						|
*/
 | 
						|
#define DEBUG
 | 
						|
 | 
						|
#ifdef DEBUG
 | 
						|
#define sx_dprintk(f, str...)	if (sx_debug & f) printk (str)
 | 
						|
#else
 | 
						|
#define sx_dprintk(f, str...)	/* nothing */
 | 
						|
#endif
 | 
						|
 | 
						|
#define func_enter()	sx_dprintk(SX_DEBUG_FLOW, "sx: enter %s\n",__func__)
 | 
						|
#define func_exit()	sx_dprintk(SX_DEBUG_FLOW, "sx: exit  %s\n",__func__)
 | 
						|
 | 
						|
#define func_enter2()	sx_dprintk(SX_DEBUG_FLOW, "sx: enter %s (port %d)\n", \
 | 
						|
				__func__, port->line)
 | 
						|
 | 
						|
/* 
 | 
						|
 *  Firmware loader driver specific routines
 | 
						|
 *
 | 
						|
 */
 | 
						|
 | 
						|
static const struct file_operations sx_fw_fops = {
 | 
						|
	.owner = THIS_MODULE,
 | 
						|
	.unlocked_ioctl = sx_fw_ioctl,
 | 
						|
};
 | 
						|
 | 
						|
static struct miscdevice sx_fw_device = {
 | 
						|
	SXCTL_MISC_MINOR, "sxctl", &sx_fw_fops
 | 
						|
};
 | 
						|
 | 
						|
#ifdef SX_PARANOIA_CHECK
 | 
						|
 | 
						|
/* This doesn't work. Who's paranoid around here? Not me! */
 | 
						|
 | 
						|
static inline int sx_paranoia_check(struct sx_port const *port,
 | 
						|
				    char *name, const char *routine)
 | 
						|
{
 | 
						|
	static const char *badmagic = KERN_ERR "sx: Warning: bad sx port magic "
 | 
						|
			"number for device %s in %s\n";
 | 
						|
	static const char *badinfo = KERN_ERR "sx: Warning: null sx port for "
 | 
						|
			"device %s in %s\n";
 | 
						|
 | 
						|
	if (!port) {
 | 
						|
		printk(badinfo, name, routine);
 | 
						|
		return 1;
 | 
						|
	}
 | 
						|
	if (port->magic != SX_MAGIC) {
 | 
						|
		printk(badmagic, name, routine);
 | 
						|
		return 1;
 | 
						|
	}
 | 
						|
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
#else
 | 
						|
#define sx_paranoia_check(a,b,c) 0
 | 
						|
#endif
 | 
						|
 | 
						|
/* The timeouts. First try 30 times as fast as possible. Then give
 | 
						|
   the card some time to breathe between accesses. (Otherwise the
 | 
						|
   processor on the card might not be able to access its OWN bus... */
 | 
						|
 | 
						|
#define TIMEOUT_1 30
 | 
						|
#define TIMEOUT_2 1000000
 | 
						|
 | 
						|
#ifdef DEBUG
 | 
						|
static void my_hd_io(void __iomem *p, int len)
 | 
						|
{
 | 
						|
	int i, j, ch;
 | 
						|
	unsigned char __iomem *addr = p;
 | 
						|
 | 
						|
	for (i = 0; i < len; i += 16) {
 | 
						|
		printk("%p ", addr + i);
 | 
						|
		for (j = 0; j < 16; j++) {
 | 
						|
			printk("%02x %s", readb(addr + j + i),
 | 
						|
					(j == 7) ? " " : "");
 | 
						|
		}
 | 
						|
		for (j = 0; j < 16; j++) {
 | 
						|
			ch = readb(addr + j + i);
 | 
						|
			printk("%c", (ch < 0x20) ? '.' :
 | 
						|
					((ch > 0x7f) ? '.' : ch));
 | 
						|
		}
 | 
						|
		printk("\n");
 | 
						|
	}
 | 
						|
}
 | 
						|
static void my_hd(void *p, int len)
 | 
						|
{
 | 
						|
	int i, j, ch;
 | 
						|
	unsigned char *addr = p;
 | 
						|
 | 
						|
	for (i = 0; i < len; i += 16) {
 | 
						|
		printk("%p ", addr + i);
 | 
						|
		for (j = 0; j < 16; j++) {
 | 
						|
			printk("%02x %s", addr[j + i], (j == 7) ? " " : "");
 | 
						|
		}
 | 
						|
		for (j = 0; j < 16; j++) {
 | 
						|
			ch = addr[j + i];
 | 
						|
			printk("%c", (ch < 0x20) ? '.' :
 | 
						|
					((ch > 0x7f) ? '.' : ch));
 | 
						|
		}
 | 
						|
		printk("\n");
 | 
						|
	}
 | 
						|
}
 | 
						|
#endif
 | 
						|
 | 
						|
/* This needs redoing for Alpha -- REW -- Done. */
 | 
						|
 | 
						|
static inline void write_sx_byte(struct sx_board *board, int offset, u8 byte)
 | 
						|
{
 | 
						|
	writeb(byte, board->base + offset);
 | 
						|
}
 | 
						|
 | 
						|
static inline u8 read_sx_byte(struct sx_board *board, int offset)
 | 
						|
{
 | 
						|
	return readb(board->base + offset);
 | 
						|
}
 | 
						|
 | 
						|
static inline void write_sx_word(struct sx_board *board, int offset, u16 word)
 | 
						|
{
 | 
						|
	writew(word, board->base + offset);
 | 
						|
}
 | 
						|
 | 
						|
static inline u16 read_sx_word(struct sx_board *board, int offset)
 | 
						|
{
 | 
						|
	return readw(board->base + offset);
 | 
						|
}
 | 
						|
 | 
						|
static int sx_busy_wait_eq(struct sx_board *board,
 | 
						|
		int offset, int mask, int correctval)
 | 
						|
{
 | 
						|
	int i;
 | 
						|
 | 
						|
	func_enter();
 | 
						|
 | 
						|
	for (i = 0; i < TIMEOUT_1; i++)
 | 
						|
		if ((read_sx_byte(board, offset) & mask) == correctval) {
 | 
						|
			func_exit();
 | 
						|
			return 1;
 | 
						|
		}
 | 
						|
 | 
						|
	for (i = 0; i < TIMEOUT_2; i++) {
 | 
						|
		if ((read_sx_byte(board, offset) & mask) == correctval) {
 | 
						|
			func_exit();
 | 
						|
			return 1;
 | 
						|
		}
 | 
						|
		udelay(1);
 | 
						|
	}
 | 
						|
 | 
						|
	func_exit();
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
static int sx_busy_wait_neq(struct sx_board *board,
 | 
						|
		int offset, int mask, int badval)
 | 
						|
{
 | 
						|
	int i;
 | 
						|
 | 
						|
	func_enter();
 | 
						|
 | 
						|
	for (i = 0; i < TIMEOUT_1; i++)
 | 
						|
		if ((read_sx_byte(board, offset) & mask) != badval) {
 | 
						|
			func_exit();
 | 
						|
			return 1;
 | 
						|
		}
 | 
						|
 | 
						|
	for (i = 0; i < TIMEOUT_2; i++) {
 | 
						|
		if ((read_sx_byte(board, offset) & mask) != badval) {
 | 
						|
			func_exit();
 | 
						|
			return 1;
 | 
						|
		}
 | 
						|
		udelay(1);
 | 
						|
	}
 | 
						|
 | 
						|
	func_exit();
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
/* 5.6.4 of 6210028 r2.3 */
 | 
						|
static int sx_reset(struct sx_board *board)
 | 
						|
{
 | 
						|
	func_enter();
 | 
						|
 | 
						|
	if (IS_SX_BOARD(board)) {
 | 
						|
 | 
						|
		write_sx_byte(board, SX_CONFIG, 0);
 | 
						|
		write_sx_byte(board, SX_RESET, 1); /* Value doesn't matter */
 | 
						|
 | 
						|
		if (!sx_busy_wait_eq(board, SX_RESET_STATUS, 1, 0)) {
 | 
						|
			printk(KERN_INFO "sx: Card doesn't respond to "
 | 
						|
					"reset...\n");
 | 
						|
			return 0;
 | 
						|
		}
 | 
						|
	} else if (IS_EISA_BOARD(board)) {
 | 
						|
		outb(board->irq << 4, board->eisa_base + 0xc02);
 | 
						|
	} else if (IS_SI1_BOARD(board)) {
 | 
						|
		write_sx_byte(board, SI1_ISA_RESET, 0);	/*value doesn't matter*/
 | 
						|
	} else {
 | 
						|
		/* Gory details of the SI/ISA board */
 | 
						|
		write_sx_byte(board, SI2_ISA_RESET, SI2_ISA_RESET_SET);
 | 
						|
		write_sx_byte(board, SI2_ISA_IRQ11, SI2_ISA_IRQ11_CLEAR);
 | 
						|
		write_sx_byte(board, SI2_ISA_IRQ12, SI2_ISA_IRQ12_CLEAR);
 | 
						|
		write_sx_byte(board, SI2_ISA_IRQ15, SI2_ISA_IRQ15_CLEAR);
 | 
						|
		write_sx_byte(board, SI2_ISA_INTCLEAR, SI2_ISA_INTCLEAR_CLEAR);
 | 
						|
		write_sx_byte(board, SI2_ISA_IRQSET, SI2_ISA_IRQSET_CLEAR);
 | 
						|
	}
 | 
						|
 | 
						|
	func_exit();
 | 
						|
	return 1;
 | 
						|
}
 | 
						|
 | 
						|
/* This doesn't work on machines where "NULL" isn't 0 */
 | 
						|
/* If you have one of those, someone will need to write 
 | 
						|
   the equivalent of this, which will amount to about 3 lines. I don't
 | 
						|
   want to complicate this right now. -- REW
 | 
						|
   (See, I do write comments every now and then :-) */
 | 
						|
#define OFFSETOF(strct, elem)	((long)&(((struct strct *)NULL)->elem))
 | 
						|
 | 
						|
#define CHAN_OFFSET(port,elem)	(port->ch_base + OFFSETOF (_SXCHANNEL, elem))
 | 
						|
#define MODU_OFFSET(board,addr,elem)	(addr + OFFSETOF (_SXMODULE, elem))
 | 
						|
#define  BRD_OFFSET(board,elem)	(OFFSETOF (_SXCARD, elem))
 | 
						|
 | 
						|
#define sx_write_channel_byte(port, elem, val) \
 | 
						|
	write_sx_byte (port->board, CHAN_OFFSET (port, elem), val)
 | 
						|
 | 
						|
#define sx_read_channel_byte(port, elem) \
 | 
						|
	read_sx_byte (port->board, CHAN_OFFSET (port, elem))
 | 
						|
 | 
						|
#define sx_write_channel_word(port, elem, val) \
 | 
						|
	write_sx_word (port->board, CHAN_OFFSET (port, elem), val)
 | 
						|
 | 
						|
#define sx_read_channel_word(port, elem) \
 | 
						|
	read_sx_word (port->board, CHAN_OFFSET (port, elem))
 | 
						|
 | 
						|
#define sx_write_module_byte(board, addr, elem, val) \
 | 
						|
	write_sx_byte (board, MODU_OFFSET (board, addr, elem), val)
 | 
						|
 | 
						|
#define sx_read_module_byte(board, addr, elem) \
 | 
						|
	read_sx_byte (board, MODU_OFFSET (board, addr, elem))
 | 
						|
 | 
						|
#define sx_write_module_word(board, addr, elem, val) \
 | 
						|
	write_sx_word (board, MODU_OFFSET (board, addr, elem), val)
 | 
						|
 | 
						|
#define sx_read_module_word(board, addr, elem) \
 | 
						|
	read_sx_word (board, MODU_OFFSET (board, addr, elem))
 | 
						|
 | 
						|
#define sx_write_board_byte(board, elem, val) \
 | 
						|
	write_sx_byte (board, BRD_OFFSET (board, elem), val)
 | 
						|
 | 
						|
#define sx_read_board_byte(board, elem) \
 | 
						|
	read_sx_byte (board, BRD_OFFSET (board, elem))
 | 
						|
 | 
						|
#define sx_write_board_word(board, elem, val) \
 | 
						|
	write_sx_word (board, BRD_OFFSET (board, elem), val)
 | 
						|
 | 
						|
#define sx_read_board_word(board, elem) \
 | 
						|
	read_sx_word (board, BRD_OFFSET (board, elem))
 | 
						|
 | 
						|
static int sx_start_board(struct sx_board *board)
 | 
						|
{
 | 
						|
	if (IS_SX_BOARD(board)) {
 | 
						|
		write_sx_byte(board, SX_CONFIG, SX_CONF_BUSEN);
 | 
						|
	} else if (IS_EISA_BOARD(board)) {
 | 
						|
		write_sx_byte(board, SI2_EISA_OFF, SI2_EISA_VAL);
 | 
						|
		outb((board->irq << 4) | 4, board->eisa_base + 0xc02);
 | 
						|
	} else if (IS_SI1_BOARD(board)) {
 | 
						|
		write_sx_byte(board, SI1_ISA_RESET_CLEAR, 0);
 | 
						|
		write_sx_byte(board, SI1_ISA_INTCL, 0);
 | 
						|
	} else {
 | 
						|
		/* Don't bug me about the clear_set. 
 | 
						|
		   I haven't the foggiest idea what it's about -- REW */
 | 
						|
		write_sx_byte(board, SI2_ISA_RESET, SI2_ISA_RESET_CLEAR);
 | 
						|
		write_sx_byte(board, SI2_ISA_INTCLEAR, SI2_ISA_INTCLEAR_SET);
 | 
						|
	}
 | 
						|
	return 1;
 | 
						|
}
 | 
						|
 | 
						|
#define SX_IRQ_REG_VAL(board) \
 | 
						|
	((board->flags & SX_ISA_BOARD) ? (board->irq << 4) : 0)
 | 
						|
 | 
						|
/* Note. The SX register is write-only. Therefore, we have to enable the
 | 
						|
   bus too. This is a no-op, if you don't mess with this driver... */
 | 
						|
static int sx_start_interrupts(struct sx_board *board)
 | 
						|
{
 | 
						|
 | 
						|
	/* Don't call this with board->irq == 0 */
 | 
						|
 | 
						|
	if (IS_SX_BOARD(board)) {
 | 
						|
		write_sx_byte(board, SX_CONFIG, SX_IRQ_REG_VAL(board) |
 | 
						|
				SX_CONF_BUSEN | SX_CONF_HOSTIRQ);
 | 
						|
	} else if (IS_EISA_BOARD(board)) {
 | 
						|
		inb(board->eisa_base + 0xc03);
 | 
						|
	} else if (IS_SI1_BOARD(board)) {
 | 
						|
		write_sx_byte(board, SI1_ISA_INTCL, 0);
 | 
						|
		write_sx_byte(board, SI1_ISA_INTCL_CLEAR, 0);
 | 
						|
	} else {
 | 
						|
		switch (board->irq) {
 | 
						|
		case 11:
 | 
						|
			write_sx_byte(board, SI2_ISA_IRQ11, SI2_ISA_IRQ11_SET);
 | 
						|
			break;
 | 
						|
		case 12:
 | 
						|
			write_sx_byte(board, SI2_ISA_IRQ12, SI2_ISA_IRQ12_SET);
 | 
						|
			break;
 | 
						|
		case 15:
 | 
						|
			write_sx_byte(board, SI2_ISA_IRQ15, SI2_ISA_IRQ15_SET);
 | 
						|
			break;
 | 
						|
		default:
 | 
						|
			printk(KERN_INFO "sx: SI/XIO card doesn't support "
 | 
						|
					"interrupt %d.\n", board->irq);
 | 
						|
			return 0;
 | 
						|
		}
 | 
						|
		write_sx_byte(board, SI2_ISA_INTCLEAR, SI2_ISA_INTCLEAR_SET);
 | 
						|
	}
 | 
						|
 | 
						|
	return 1;
 | 
						|
}
 | 
						|
 | 
						|
static int sx_send_command(struct sx_port *port,
 | 
						|
		int command, int mask, int newstat)
 | 
						|
{
 | 
						|
	func_enter2();
 | 
						|
	write_sx_byte(port->board, CHAN_OFFSET(port, hi_hstat), command);
 | 
						|
	func_exit();
 | 
						|
	return sx_busy_wait_eq(port->board, CHAN_OFFSET(port, hi_hstat), mask,
 | 
						|
			newstat);
 | 
						|
}
 | 
						|
 | 
						|
static char *mod_type_s(int module_type)
 | 
						|
{
 | 
						|
	switch (module_type) {
 | 
						|
	case TA4:
 | 
						|
		return "TA4";
 | 
						|
	case TA8:
 | 
						|
		return "TA8";
 | 
						|
	case TA4_ASIC:
 | 
						|
		return "TA4_ASIC";
 | 
						|
	case TA8_ASIC:
 | 
						|
		return "TA8_ASIC";
 | 
						|
	case MTA_CD1400:
 | 
						|
		return "MTA_CD1400";
 | 
						|
	case SXDC:
 | 
						|
		return "SXDC";
 | 
						|
	default:
 | 
						|
		return "Unknown/invalid";
 | 
						|
	}
 | 
						|
}
 | 
						|
 | 
						|
static char *pan_type_s(int pan_type)
 | 
						|
{
 | 
						|
	switch (pan_type) {
 | 
						|
	case MOD_RS232DB25:
 | 
						|
		return "MOD_RS232DB25";
 | 
						|
	case MOD_RS232RJ45:
 | 
						|
		return "MOD_RS232RJ45";
 | 
						|
	case MOD_RS422DB25:
 | 
						|
		return "MOD_RS422DB25";
 | 
						|
	case MOD_PARALLEL:
 | 
						|
		return "MOD_PARALLEL";
 | 
						|
	case MOD_2_RS232DB25:
 | 
						|
		return "MOD_2_RS232DB25";
 | 
						|
	case MOD_2_RS232RJ45:
 | 
						|
		return "MOD_2_RS232RJ45";
 | 
						|
	case MOD_2_RS422DB25:
 | 
						|
		return "MOD_2_RS422DB25";
 | 
						|
	case MOD_RS232DB25MALE:
 | 
						|
		return "MOD_RS232DB25MALE";
 | 
						|
	case MOD_2_PARALLEL:
 | 
						|
		return "MOD_2_PARALLEL";
 | 
						|
	case MOD_BLANK:
 | 
						|
		return "empty";
 | 
						|
	default:
 | 
						|
		return "invalid";
 | 
						|
	}
 | 
						|
}
 | 
						|
 | 
						|
static int mod_compat_type(int module_type)
 | 
						|
{
 | 
						|
	return module_type >> 4;
 | 
						|
}
 | 
						|
 | 
						|
static void sx_reconfigure_port(struct sx_port *port)
 | 
						|
{
 | 
						|
	if (sx_read_channel_byte(port, hi_hstat) == HS_IDLE_OPEN) {
 | 
						|
		if (sx_send_command(port, HS_CONFIG, -1, HS_IDLE_OPEN) != 1) {
 | 
						|
			printk(KERN_WARNING "sx: Sent reconfigure command, but "
 | 
						|
					"card didn't react.\n");
 | 
						|
		}
 | 
						|
	} else {
 | 
						|
		sx_dprintk(SX_DEBUG_TERMIOS, "sx: Not sending reconfigure: "
 | 
						|
				"port isn't open (%02x).\n",
 | 
						|
				sx_read_channel_byte(port, hi_hstat));
 | 
						|
	}
 | 
						|
}
 | 
						|
 | 
						|
static void sx_setsignals(struct sx_port *port, int dtr, int rts)
 | 
						|
{
 | 
						|
	int t;
 | 
						|
	func_enter2();
 | 
						|
 | 
						|
	t = sx_read_channel_byte(port, hi_op);
 | 
						|
	if (dtr >= 0)
 | 
						|
		t = dtr ? (t | OP_DTR) : (t & ~OP_DTR);
 | 
						|
	if (rts >= 0)
 | 
						|
		t = rts ? (t | OP_RTS) : (t & ~OP_RTS);
 | 
						|
	sx_write_channel_byte(port, hi_op, t);
 | 
						|
	sx_dprintk(SX_DEBUG_MODEMSIGNALS, "setsignals: %d/%d\n", dtr, rts);
 | 
						|
 | 
						|
	func_exit();
 | 
						|
}
 | 
						|
 | 
						|
static int sx_getsignals(struct sx_port *port)
 | 
						|
{
 | 
						|
	int i_stat, o_stat;
 | 
						|
 | 
						|
	o_stat = sx_read_channel_byte(port, hi_op);
 | 
						|
	i_stat = sx_read_channel_byte(port, hi_ip);
 | 
						|
 | 
						|
	sx_dprintk(SX_DEBUG_MODEMSIGNALS, "getsignals: %d/%d  (%d/%d) "
 | 
						|
			"%02x/%02x\n",
 | 
						|
			(o_stat & OP_DTR) != 0, (o_stat & OP_RTS) != 0,
 | 
						|
			port->c_dcd, tty_port_carrier_raised(&port->gs.port),
 | 
						|
			sx_read_channel_byte(port, hi_ip),
 | 
						|
			sx_read_channel_byte(port, hi_state));
 | 
						|
 | 
						|
	return (((o_stat & OP_DTR) ? TIOCM_DTR : 0) |
 | 
						|
		((o_stat & OP_RTS) ? TIOCM_RTS : 0) |
 | 
						|
		((i_stat & IP_CTS) ? TIOCM_CTS : 0) |
 | 
						|
		((i_stat & IP_DCD) ? TIOCM_CAR : 0) |
 | 
						|
		((i_stat & IP_DSR) ? TIOCM_DSR : 0) |
 | 
						|
		((i_stat & IP_RI) ? TIOCM_RNG : 0));
 | 
						|
}
 | 
						|
 | 
						|
static void sx_set_baud(struct sx_port *port)
 | 
						|
{
 | 
						|
	int t;
 | 
						|
 | 
						|
	if (port->board->ta_type == MOD_SXDC) {
 | 
						|
		switch (port->gs.baud) {
 | 
						|
			/* Save some typing work... */
 | 
						|
#define e(x) case x: t = BAUD_ ## x; break
 | 
						|
			e(50);
 | 
						|
			e(75);
 | 
						|
			e(110);
 | 
						|
			e(150);
 | 
						|
			e(200);
 | 
						|
			e(300);
 | 
						|
			e(600);
 | 
						|
			e(1200);
 | 
						|
			e(1800);
 | 
						|
			e(2000);
 | 
						|
			e(2400);
 | 
						|
			e(4800);
 | 
						|
			e(7200);
 | 
						|
			e(9600);
 | 
						|
			e(14400);
 | 
						|
			e(19200);
 | 
						|
			e(28800);
 | 
						|
			e(38400);
 | 
						|
			e(56000);
 | 
						|
			e(57600);
 | 
						|
			e(64000);
 | 
						|
			e(76800);
 | 
						|
			e(115200);
 | 
						|
			e(128000);
 | 
						|
			e(150000);
 | 
						|
			e(230400);
 | 
						|
			e(256000);
 | 
						|
			e(460800);
 | 
						|
			e(921600);
 | 
						|
		case 134:
 | 
						|
			t = BAUD_134_5;
 | 
						|
			break;
 | 
						|
		case 0:
 | 
						|
			t = -1;
 | 
						|
			break;
 | 
						|
		default:
 | 
						|
			/* Can I return "invalid"? */
 | 
						|
			t = BAUD_9600;
 | 
						|
			printk(KERN_INFO "sx: unsupported baud rate: %d.\n",
 | 
						|
					port->gs.baud);
 | 
						|
			break;
 | 
						|
		}
 | 
						|
#undef e
 | 
						|
		if (t > 0) {
 | 
						|
/* The baud rate is not set to 0, so we're enabeling DTR... -- REW */
 | 
						|
			sx_setsignals(port, 1, -1);
 | 
						|
			/* XXX This is not TA & MTA compatible */
 | 
						|
			sx_write_channel_byte(port, hi_csr, 0xff);
 | 
						|
 | 
						|
			sx_write_channel_byte(port, hi_txbaud, t);
 | 
						|
			sx_write_channel_byte(port, hi_rxbaud, t);
 | 
						|
		} else {
 | 
						|
			sx_setsignals(port, 0, -1);
 | 
						|
		}
 | 
						|
	} else {
 | 
						|
		switch (port->gs.baud) {
 | 
						|
#define e(x) case x: t = CSR_ ## x; break
 | 
						|
			e(75);
 | 
						|
			e(150);
 | 
						|
			e(300);
 | 
						|
			e(600);
 | 
						|
			e(1200);
 | 
						|
			e(2400);
 | 
						|
			e(4800);
 | 
						|
			e(1800);
 | 
						|
			e(9600);
 | 
						|
			e(19200);
 | 
						|
			e(57600);
 | 
						|
			e(38400);
 | 
						|
/* TA supports 110, but not 115200, MTA supports 115200, but not 110 */
 | 
						|
		case 110:
 | 
						|
			if (port->board->ta_type == MOD_TA) {
 | 
						|
				t = CSR_110;
 | 
						|
				break;
 | 
						|
			} else {
 | 
						|
				t = CSR_9600;
 | 
						|
				printk(KERN_INFO "sx: Unsupported baud rate: "
 | 
						|
						"%d.\n", port->gs.baud);
 | 
						|
				break;
 | 
						|
			}
 | 
						|
		case 115200:
 | 
						|
			if (port->board->ta_type == MOD_TA) {
 | 
						|
				t = CSR_9600;
 | 
						|
				printk(KERN_INFO "sx: Unsupported baud rate: "
 | 
						|
						"%d.\n", port->gs.baud);
 | 
						|
				break;
 | 
						|
			} else {
 | 
						|
				t = CSR_110;
 | 
						|
				break;
 | 
						|
			}
 | 
						|
		case 0:
 | 
						|
			t = -1;
 | 
						|
			break;
 | 
						|
		default:
 | 
						|
			t = CSR_9600;
 | 
						|
			printk(KERN_INFO "sx: Unsupported baud rate: %d.\n",
 | 
						|
					port->gs.baud);
 | 
						|
			break;
 | 
						|
		}
 | 
						|
#undef e
 | 
						|
		if (t >= 0) {
 | 
						|
			sx_setsignals(port, 1, -1);
 | 
						|
			sx_write_channel_byte(port, hi_csr, t * 0x11);
 | 
						|
		} else {
 | 
						|
			sx_setsignals(port, 0, -1);
 | 
						|
		}
 | 
						|
	}
 | 
						|
}
 | 
						|
 | 
						|
/* Simon Allen's version of this routine was 225 lines long. 85 is a lot
 | 
						|
   better. -- REW */
 | 
						|
 | 
						|
static int sx_set_real_termios(void *ptr)
 | 
						|
{
 | 
						|
	struct sx_port *port = ptr;
 | 
						|
 | 
						|
	func_enter2();
 | 
						|
 | 
						|
	if (!port->gs.port.tty)
 | 
						|
		return 0;
 | 
						|
 | 
						|
	/* What is this doing here? -- REW
 | 
						|
	   Ha! figured it out. It is to allow you to get DTR active again
 | 
						|
	   if you've dropped it with stty 0. Moved to set_baud, where it
 | 
						|
	   belongs (next to the drop dtr if baud == 0) -- REW */
 | 
						|
	/* sx_setsignals (port, 1, -1); */
 | 
						|
 | 
						|
	sx_set_baud(port);
 | 
						|
 | 
						|
#define CFLAG port->gs.port.tty->termios->c_cflag
 | 
						|
	sx_write_channel_byte(port, hi_mr1,
 | 
						|
			(C_PARENB(port->gs.port.tty) ? MR1_WITH : MR1_NONE) |
 | 
						|
			(C_PARODD(port->gs.port.tty) ? MR1_ODD : MR1_EVEN) |
 | 
						|
			(C_CRTSCTS(port->gs.port.tty) ? MR1_RTS_RXFLOW : 0) |
 | 
						|
			(((CFLAG & CSIZE) == CS8) ? MR1_8_BITS : 0) |
 | 
						|
			(((CFLAG & CSIZE) == CS7) ? MR1_7_BITS : 0) |
 | 
						|
			(((CFLAG & CSIZE) == CS6) ? MR1_6_BITS : 0) |
 | 
						|
			(((CFLAG & CSIZE) == CS5) ? MR1_5_BITS : 0));
 | 
						|
 | 
						|
	sx_write_channel_byte(port, hi_mr2,
 | 
						|
			(C_CRTSCTS(port->gs.port.tty) ? MR2_CTS_TXFLOW : 0) |
 | 
						|
			(C_CSTOPB(port->gs.port.tty) ? MR2_2_STOP :
 | 
						|
			MR2_1_STOP));
 | 
						|
 | 
						|
	switch (CFLAG & CSIZE) {
 | 
						|
	case CS8:
 | 
						|
		sx_write_channel_byte(port, hi_mask, 0xff);
 | 
						|
		break;
 | 
						|
	case CS7:
 | 
						|
		sx_write_channel_byte(port, hi_mask, 0x7f);
 | 
						|
		break;
 | 
						|
	case CS6:
 | 
						|
		sx_write_channel_byte(port, hi_mask, 0x3f);
 | 
						|
		break;
 | 
						|
	case CS5:
 | 
						|
		sx_write_channel_byte(port, hi_mask, 0x1f);
 | 
						|
		break;
 | 
						|
	default:
 | 
						|
		printk(KERN_INFO "sx: Invalid wordsize: %u\n",
 | 
						|
			(unsigned int)CFLAG & CSIZE);
 | 
						|
		break;
 | 
						|
	}
 | 
						|
 | 
						|
	sx_write_channel_byte(port, hi_prtcl,
 | 
						|
			(I_IXON(port->gs.port.tty) ? SP_TXEN : 0) |
 | 
						|
			(I_IXOFF(port->gs.port.tty) ? SP_RXEN : 0) |
 | 
						|
			(I_IXANY(port->gs.port.tty) ? SP_TANY : 0) | SP_DCEN);
 | 
						|
 | 
						|
	sx_write_channel_byte(port, hi_break,
 | 
						|
			(I_IGNBRK(port->gs.port.tty) ? BR_IGN : 0 |
 | 
						|
			I_BRKINT(port->gs.port.tty) ? BR_INT : 0));
 | 
						|
 | 
						|
	sx_write_channel_byte(port, hi_txon, START_CHAR(port->gs.port.tty));
 | 
						|
	sx_write_channel_byte(port, hi_rxon, START_CHAR(port->gs.port.tty));
 | 
						|
	sx_write_channel_byte(port, hi_txoff, STOP_CHAR(port->gs.port.tty));
 | 
						|
	sx_write_channel_byte(port, hi_rxoff, STOP_CHAR(port->gs.port.tty));
 | 
						|
 | 
						|
	sx_reconfigure_port(port);
 | 
						|
 | 
						|
	/* Tell line discipline whether we will do input cooking */
 | 
						|
	if (I_OTHER(port->gs.port.tty)) {
 | 
						|
		clear_bit(TTY_HW_COOK_IN, &port->gs.port.tty->flags);
 | 
						|
	} else {
 | 
						|
		set_bit(TTY_HW_COOK_IN, &port->gs.port.tty->flags);
 | 
						|
	}
 | 
						|
	sx_dprintk(SX_DEBUG_TERMIOS, "iflags: %x(%d) ",
 | 
						|
			(unsigned int)port->gs.port.tty->termios->c_iflag,
 | 
						|
			I_OTHER(port->gs.port.tty));
 | 
						|
 | 
						|
/* Tell line discipline whether we will do output cooking.
 | 
						|
 * If OPOST is set and no other output flags are set then we can do output
 | 
						|
 * processing.  Even if only *one* other flag in the O_OTHER group is set
 | 
						|
 * we do cooking in software.
 | 
						|
 */
 | 
						|
	if (O_OPOST(port->gs.port.tty) && !O_OTHER(port->gs.port.tty)) {
 | 
						|
		set_bit(TTY_HW_COOK_OUT, &port->gs.port.tty->flags);
 | 
						|
	} else {
 | 
						|
		clear_bit(TTY_HW_COOK_OUT, &port->gs.port.tty->flags);
 | 
						|
	}
 | 
						|
	sx_dprintk(SX_DEBUG_TERMIOS, "oflags: %x(%d)\n",
 | 
						|
			(unsigned int)port->gs.port.tty->termios->c_oflag,
 | 
						|
			O_OTHER(port->gs.port.tty));
 | 
						|
	/* port->c_dcd = sx_get_CD (port); */
 | 
						|
	func_exit();
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
/* ********************************************************************** *
 | 
						|
 *                   the interrupt related routines                       *
 | 
						|
 * ********************************************************************** */
 | 
						|
 | 
						|
/* Note:
 | 
						|
   Other drivers use the macro "MIN" to calculate how much to copy.
 | 
						|
   This has the disadvantage that it will evaluate parts twice. That's
 | 
						|
   expensive when it's IO (and the compiler cannot optimize those away!).
 | 
						|
   Moreover, I'm not sure that you're race-free. 
 | 
						|
 | 
						|
   I assign a value, and then only allow the value to decrease. This
 | 
						|
   is always safe. This makes the code a few lines longer, and you
 | 
						|
   know I'm dead against that, but I think it is required in this
 | 
						|
   case.  */
 | 
						|
 | 
						|
static void sx_transmit_chars(struct sx_port *port)
 | 
						|
{
 | 
						|
	int c;
 | 
						|
	int tx_ip;
 | 
						|
	int txroom;
 | 
						|
 | 
						|
	func_enter2();
 | 
						|
	sx_dprintk(SX_DEBUG_TRANSMIT, "Port %p: transmit %d chars\n",
 | 
						|
			port, port->gs.xmit_cnt);
 | 
						|
 | 
						|
	if (test_and_set_bit(SX_PORT_TRANSMIT_LOCK, &port->locks)) {
 | 
						|
		return;
 | 
						|
	}
 | 
						|
 | 
						|
	while (1) {
 | 
						|
		c = port->gs.xmit_cnt;
 | 
						|
 | 
						|
		sx_dprintk(SX_DEBUG_TRANSMIT, "Copying %d ", c);
 | 
						|
		tx_ip = sx_read_channel_byte(port, hi_txipos);
 | 
						|
 | 
						|
		/* Took me 5 minutes to deduce this formula. 
 | 
						|
		   Luckily it is literally in the manual in section 6.5.4.3.5 */
 | 
						|
		txroom = (sx_read_channel_byte(port, hi_txopos) - tx_ip - 1) &
 | 
						|
				0xff;
 | 
						|
 | 
						|
		/* Don't copy more bytes than there is room for in the buffer */
 | 
						|
		if (c > txroom)
 | 
						|
			c = txroom;
 | 
						|
		sx_dprintk(SX_DEBUG_TRANSMIT, " %d(%d) ", c, txroom);
 | 
						|
 | 
						|
		/* Don't copy past the end of the hardware transmit buffer */
 | 
						|
		if (c > 0x100 - tx_ip)
 | 
						|
			c = 0x100 - tx_ip;
 | 
						|
 | 
						|
		sx_dprintk(SX_DEBUG_TRANSMIT, " %d(%d) ", c, 0x100 - tx_ip);
 | 
						|
 | 
						|
		/* Don't copy pas the end of the source buffer */
 | 
						|
		if (c > SERIAL_XMIT_SIZE - port->gs.xmit_tail)
 | 
						|
			c = SERIAL_XMIT_SIZE - port->gs.xmit_tail;
 | 
						|
 | 
						|
		sx_dprintk(SX_DEBUG_TRANSMIT, " %d(%ld) \n",
 | 
						|
				c, SERIAL_XMIT_SIZE - port->gs.xmit_tail);
 | 
						|
 | 
						|
		/* If for one reason or another, we can't copy more data, we're
 | 
						|
		   done! */
 | 
						|
		if (c == 0)
 | 
						|
			break;
 | 
						|
 | 
						|
		memcpy_toio(port->board->base + CHAN_OFFSET(port, hi_txbuf) +
 | 
						|
			tx_ip, port->gs.xmit_buf + port->gs.xmit_tail, c);
 | 
						|
 | 
						|
		/* Update the pointer in the card */
 | 
						|
		sx_write_channel_byte(port, hi_txipos, (tx_ip + c) & 0xff);
 | 
						|
 | 
						|
		/* Update the kernel buffer end */
 | 
						|
		port->gs.xmit_tail = (port->gs.xmit_tail + c) &
 | 
						|
				(SERIAL_XMIT_SIZE - 1);
 | 
						|
 | 
						|
		/* This one last. (this is essential)
 | 
						|
		   It would allow others to start putting more data into the
 | 
						|
		   buffer! */
 | 
						|
		port->gs.xmit_cnt -= c;
 | 
						|
	}
 | 
						|
 | 
						|
	if (port->gs.xmit_cnt == 0) {
 | 
						|
		sx_disable_tx_interrupts(port);
 | 
						|
	}
 | 
						|
 | 
						|
	if ((port->gs.xmit_cnt <= port->gs.wakeup_chars) && port->gs.port.tty) {
 | 
						|
		tty_wakeup(port->gs.port.tty);
 | 
						|
		sx_dprintk(SX_DEBUG_TRANSMIT, "Waking up.... ldisc (%d)....\n",
 | 
						|
				port->gs.wakeup_chars);
 | 
						|
	}
 | 
						|
 | 
						|
	clear_bit(SX_PORT_TRANSMIT_LOCK, &port->locks);
 | 
						|
	func_exit();
 | 
						|
}
 | 
						|
 | 
						|
/* Note the symmetry between receiving chars and transmitting them!
 | 
						|
   Note: The kernel should have implemented both a receive buffer and
 | 
						|
   a transmit buffer. */
 | 
						|
 | 
						|
/* Inlined: Called only once. Remove the inline when you add another call */
 | 
						|
static inline void sx_receive_chars(struct sx_port *port)
 | 
						|
{
 | 
						|
	int c;
 | 
						|
	int rx_op;
 | 
						|
	struct tty_struct *tty;
 | 
						|
	int copied = 0;
 | 
						|
	unsigned char *rp;
 | 
						|
 | 
						|
	func_enter2();
 | 
						|
	tty = port->gs.port.tty;
 | 
						|
	while (1) {
 | 
						|
		rx_op = sx_read_channel_byte(port, hi_rxopos);
 | 
						|
		c = (sx_read_channel_byte(port, hi_rxipos) - rx_op) & 0xff;
 | 
						|
 | 
						|
		sx_dprintk(SX_DEBUG_RECEIVE, "rxop=%d, c = %d.\n", rx_op, c);
 | 
						|
 | 
						|
		/* Don't copy past the end of the hardware receive buffer */
 | 
						|
		if (rx_op + c > 0x100)
 | 
						|
			c = 0x100 - rx_op;
 | 
						|
 | 
						|
		sx_dprintk(SX_DEBUG_RECEIVE, "c = %d.\n", c);
 | 
						|
 | 
						|
		/* Don't copy more bytes than there is room for in the buffer */
 | 
						|
 | 
						|
		c = tty_prepare_flip_string(tty, &rp, c);
 | 
						|
 | 
						|
		sx_dprintk(SX_DEBUG_RECEIVE, "c = %d.\n", c);
 | 
						|
 | 
						|
		/* If for one reason or another, we can't copy more data, we're done! */
 | 
						|
		if (c == 0)
 | 
						|
			break;
 | 
						|
 | 
						|
		sx_dprintk(SX_DEBUG_RECEIVE, "Copying over %d chars. First is "
 | 
						|
				"%d at %lx\n", c, read_sx_byte(port->board,
 | 
						|
					CHAN_OFFSET(port, hi_rxbuf) + rx_op),
 | 
						|
				CHAN_OFFSET(port, hi_rxbuf));
 | 
						|
		memcpy_fromio(rp, port->board->base +
 | 
						|
				CHAN_OFFSET(port, hi_rxbuf) + rx_op, c);
 | 
						|
 | 
						|
		/* This one last. ( Not essential.)
 | 
						|
		   It allows the card to start putting more data into the
 | 
						|
		   buffer!
 | 
						|
		   Update the pointer in the card */
 | 
						|
		sx_write_channel_byte(port, hi_rxopos, (rx_op + c) & 0xff);
 | 
						|
 | 
						|
		copied += c;
 | 
						|
	}
 | 
						|
	if (copied) {
 | 
						|
		struct timeval tv;
 | 
						|
 | 
						|
		do_gettimeofday(&tv);
 | 
						|
		sx_dprintk(SX_DEBUG_RECEIVE, "pushing flipq port %d (%3d "
 | 
						|
				"chars): %d.%06d  (%d/%d)\n", port->line,
 | 
						|
				copied, (int)(tv.tv_sec % 60), (int)tv.tv_usec,
 | 
						|
				tty->raw, tty->real_raw);
 | 
						|
 | 
						|
		/* Tell the rest of the system the news. Great news. New
 | 
						|
		   characters! */
 | 
						|
		tty_flip_buffer_push(tty);
 | 
						|
		/*    tty_schedule_flip (tty); */
 | 
						|
	}
 | 
						|
 | 
						|
	func_exit();
 | 
						|
}
 | 
						|
 | 
						|
/* Inlined: it is called only once. Remove the inline if you add another 
 | 
						|
   call */
 | 
						|
static inline void sx_check_modem_signals(struct sx_port *port)
 | 
						|
{
 | 
						|
	int hi_state;
 | 
						|
	int c_dcd;
 | 
						|
 | 
						|
	hi_state = sx_read_channel_byte(port, hi_state);
 | 
						|
	sx_dprintk(SX_DEBUG_MODEMSIGNALS, "Checking modem signals (%d/%d)\n",
 | 
						|
			port->c_dcd, tty_port_carrier_raised(&port->gs.port));
 | 
						|
 | 
						|
	if (hi_state & ST_BREAK) {
 | 
						|
		hi_state &= ~ST_BREAK;
 | 
						|
		sx_dprintk(SX_DEBUG_MODEMSIGNALS, "got a break.\n");
 | 
						|
		sx_write_channel_byte(port, hi_state, hi_state);
 | 
						|
		gs_got_break(&port->gs);
 | 
						|
	}
 | 
						|
	if (hi_state & ST_DCD) {
 | 
						|
		hi_state &= ~ST_DCD;
 | 
						|
		sx_dprintk(SX_DEBUG_MODEMSIGNALS, "got a DCD change.\n");
 | 
						|
		sx_write_channel_byte(port, hi_state, hi_state);
 | 
						|
		c_dcd = tty_port_carrier_raised(&port->gs.port);
 | 
						|
		sx_dprintk(SX_DEBUG_MODEMSIGNALS, "DCD is now %d\n", c_dcd);
 | 
						|
		if (c_dcd != port->c_dcd) {
 | 
						|
			port->c_dcd = c_dcd;
 | 
						|
			if (tty_port_carrier_raised(&port->gs.port)) {
 | 
						|
				/* DCD went UP */
 | 
						|
				if ((sx_read_channel_byte(port, hi_hstat) !=
 | 
						|
						HS_IDLE_CLOSED) &&
 | 
						|
						!(port->gs.port.tty->termios->
 | 
						|
							c_cflag & CLOCAL)) {
 | 
						|
					/* Are we blocking in open? */
 | 
						|
					sx_dprintk(SX_DEBUG_MODEMSIGNALS, "DCD "
 | 
						|
						"active, unblocking open\n");
 | 
						|
					wake_up_interruptible(&port->gs.port.
 | 
						|
							open_wait);
 | 
						|
				} else {
 | 
						|
					sx_dprintk(SX_DEBUG_MODEMSIGNALS, "DCD "
 | 
						|
						"raised. Ignoring.\n");
 | 
						|
				}
 | 
						|
			} else {
 | 
						|
				/* DCD went down! */
 | 
						|
				if (!(port->gs.port.tty->termios->c_cflag & CLOCAL)){
 | 
						|
					sx_dprintk(SX_DEBUG_MODEMSIGNALS, "DCD "
 | 
						|
						"dropped. hanging up....\n");
 | 
						|
					tty_hangup(port->gs.port.tty);
 | 
						|
				} else {
 | 
						|
					sx_dprintk(SX_DEBUG_MODEMSIGNALS, "DCD "
 | 
						|
						"dropped. ignoring.\n");
 | 
						|
				}
 | 
						|
			}
 | 
						|
		} else {
 | 
						|
			sx_dprintk(SX_DEBUG_MODEMSIGNALS, "Hmmm. card told us "
 | 
						|
				"DCD changed, but it didn't.\n");
 | 
						|
		}
 | 
						|
	}
 | 
						|
}
 | 
						|
 | 
						|
/* This is what an interrupt routine should look like. 
 | 
						|
 * Small, elegant, clear.
 | 
						|
 */
 | 
						|
 | 
						|
static irqreturn_t sx_interrupt(int irq, void *ptr)
 | 
						|
{
 | 
						|
	struct sx_board *board = ptr;
 | 
						|
	struct sx_port *port;
 | 
						|
	int i;
 | 
						|
 | 
						|
	func_enter();
 | 
						|
	sx_dprintk(SX_DEBUG_FLOW, "sx: enter sx_interrupt (%d/%d)\n", irq,
 | 
						|
			board->irq);
 | 
						|
 | 
						|
	/* AAargh! The order in which to do these things is essential and
 | 
						|
	   not trivial. 
 | 
						|
 | 
						|
	   - Rate limit goes before "recursive". Otherwise a series of
 | 
						|
	   recursive calls will hang the machine in the interrupt routine.
 | 
						|
 | 
						|
	   - hardware twiddling goes before "recursive". Otherwise when we
 | 
						|
	   poll the card, and a recursive interrupt happens, we won't
 | 
						|
	   ack the card, so it might keep on interrupting us. (especially
 | 
						|
	   level sensitive interrupt systems like PCI).
 | 
						|
 | 
						|
	   - Rate limit goes before hardware twiddling. Otherwise we won't
 | 
						|
	   catch a card that has gone bonkers.
 | 
						|
 | 
						|
	   - The "initialized" test goes after the hardware twiddling. Otherwise
 | 
						|
	   the card will stick us in the interrupt routine again.
 | 
						|
 | 
						|
	   - The initialized test goes before recursive. 
 | 
						|
	 */
 | 
						|
 | 
						|
#ifdef IRQ_RATE_LIMIT
 | 
						|
	/* Aaargh! I'm ashamed. This costs more lines-of-code than the
 | 
						|
	   actual interrupt routine!. (Well, used to when I wrote that
 | 
						|
	   comment) */
 | 
						|
	{
 | 
						|
		static int lastjif;
 | 
						|
		static int nintr = 0;
 | 
						|
 | 
						|
		if (lastjif == jiffies) {
 | 
						|
			if (++nintr > IRQ_RATE_LIMIT) {
 | 
						|
				free_irq(board->irq, board);
 | 
						|
				printk(KERN_ERR "sx: Too many interrupts. "
 | 
						|
						"Turning off interrupt %d.\n",
 | 
						|
						board->irq);
 | 
						|
			}
 | 
						|
		} else {
 | 
						|
			lastjif = jiffies;
 | 
						|
			nintr = 0;
 | 
						|
		}
 | 
						|
	}
 | 
						|
#endif
 | 
						|
 | 
						|
	if (board->irq == irq) {
 | 
						|
		/* Tell the card we've noticed the interrupt. */
 | 
						|
 | 
						|
		sx_write_board_word(board, cc_int_pending, 0);
 | 
						|
		if (IS_SX_BOARD(board)) {
 | 
						|
			write_sx_byte(board, SX_RESET_IRQ, 1);
 | 
						|
		} else if (IS_EISA_BOARD(board)) {
 | 
						|
			inb(board->eisa_base + 0xc03);
 | 
						|
			write_sx_word(board, 8, 0);
 | 
						|
		} else {
 | 
						|
			write_sx_byte(board, SI2_ISA_INTCLEAR,
 | 
						|
					SI2_ISA_INTCLEAR_CLEAR);
 | 
						|
			write_sx_byte(board, SI2_ISA_INTCLEAR,
 | 
						|
					SI2_ISA_INTCLEAR_SET);
 | 
						|
		}
 | 
						|
	}
 | 
						|
 | 
						|
	if (!sx_initialized)
 | 
						|
		return IRQ_HANDLED;
 | 
						|
	if (!(board->flags & SX_BOARD_INITIALIZED))
 | 
						|
		return IRQ_HANDLED;
 | 
						|
 | 
						|
	if (test_and_set_bit(SX_BOARD_INTR_LOCK, &board->locks)) {
 | 
						|
		printk(KERN_ERR "Recursive interrupt! (%d)\n", board->irq);
 | 
						|
		return IRQ_HANDLED;
 | 
						|
	}
 | 
						|
 | 
						|
	for (i = 0; i < board->nports; i++) {
 | 
						|
		port = &board->ports[i];
 | 
						|
		if (port->gs.port.flags & GS_ACTIVE) {
 | 
						|
			if (sx_read_channel_byte(port, hi_state)) {
 | 
						|
				sx_dprintk(SX_DEBUG_INTERRUPTS, "Port %d: "
 | 
						|
						"modem signal change?... \n",i);
 | 
						|
				sx_check_modem_signals(port);
 | 
						|
			}
 | 
						|
			if (port->gs.xmit_cnt) {
 | 
						|
				sx_transmit_chars(port);
 | 
						|
			}
 | 
						|
			if (!(port->gs.port.flags & SX_RX_THROTTLE)) {
 | 
						|
				sx_receive_chars(port);
 | 
						|
			}
 | 
						|
		}
 | 
						|
	}
 | 
						|
 | 
						|
	clear_bit(SX_BOARD_INTR_LOCK, &board->locks);
 | 
						|
 | 
						|
	sx_dprintk(SX_DEBUG_FLOW, "sx: exit sx_interrupt (%d/%d)\n", irq,
 | 
						|
			board->irq);
 | 
						|
	func_exit();
 | 
						|
	return IRQ_HANDLED;
 | 
						|
}
 | 
						|
 | 
						|
static void sx_pollfunc(unsigned long data)
 | 
						|
{
 | 
						|
	struct sx_board *board = (struct sx_board *)data;
 | 
						|
 | 
						|
	func_enter();
 | 
						|
 | 
						|
	sx_interrupt(0, board);
 | 
						|
 | 
						|
	mod_timer(&board->timer, jiffies + sx_poll);
 | 
						|
	func_exit();
 | 
						|
}
 | 
						|
 | 
						|
/* ********************************************************************** *
 | 
						|
 *                Here are the routines that actually                     *
 | 
						|
 *              interface with the generic_serial driver                  *
 | 
						|
 * ********************************************************************** */
 | 
						|
 | 
						|
/* Ehhm. I don't know how to fiddle with interrupts on the SX card. --REW */
 | 
						|
/* Hmm. Ok I figured it out. You don't.  */
 | 
						|
 | 
						|
static void sx_disable_tx_interrupts(void *ptr)
 | 
						|
{
 | 
						|
	struct sx_port *port = ptr;
 | 
						|
	func_enter2();
 | 
						|
 | 
						|
	port->gs.port.flags &= ~GS_TX_INTEN;
 | 
						|
 | 
						|
	func_exit();
 | 
						|
}
 | 
						|
 | 
						|
static void sx_enable_tx_interrupts(void *ptr)
 | 
						|
{
 | 
						|
	struct sx_port *port = ptr;
 | 
						|
	int data_in_buffer;
 | 
						|
	func_enter2();
 | 
						|
 | 
						|
	/* First transmit the characters that we're supposed to */
 | 
						|
	sx_transmit_chars(port);
 | 
						|
 | 
						|
	/* The sx card will never interrupt us if we don't fill the buffer
 | 
						|
	   past 25%. So we keep considering interrupts off if that's the case. */
 | 
						|
	data_in_buffer = (sx_read_channel_byte(port, hi_txipos) -
 | 
						|
			  sx_read_channel_byte(port, hi_txopos)) & 0xff;
 | 
						|
 | 
						|
	/* XXX Must be "HIGH_WATER" for SI card according to doc. */
 | 
						|
	if (data_in_buffer < LOW_WATER)
 | 
						|
		port->gs.port.flags &= ~GS_TX_INTEN;
 | 
						|
 | 
						|
	func_exit();
 | 
						|
}
 | 
						|
 | 
						|
static void sx_disable_rx_interrupts(void *ptr)
 | 
						|
{
 | 
						|
	/*  struct sx_port *port = ptr; */
 | 
						|
	func_enter();
 | 
						|
 | 
						|
	func_exit();
 | 
						|
}
 | 
						|
 | 
						|
static void sx_enable_rx_interrupts(void *ptr)
 | 
						|
{
 | 
						|
	/*  struct sx_port *port = ptr; */
 | 
						|
	func_enter();
 | 
						|
 | 
						|
	func_exit();
 | 
						|
}
 | 
						|
 | 
						|
/* Jeez. Isn't this simple? */
 | 
						|
static int sx_carrier_raised(struct tty_port *port)
 | 
						|
{
 | 
						|
	struct sx_port *sp = container_of(port, struct sx_port, gs.port);
 | 
						|
	return ((sx_read_channel_byte(sp, hi_ip) & IP_DCD) != 0);
 | 
						|
}
 | 
						|
 | 
						|
/* Jeez. Isn't this simple? */
 | 
						|
static int sx_chars_in_buffer(void *ptr)
 | 
						|
{
 | 
						|
	struct sx_port *port = ptr;
 | 
						|
	func_enter2();
 | 
						|
 | 
						|
	func_exit();
 | 
						|
	return ((sx_read_channel_byte(port, hi_txipos) -
 | 
						|
		 sx_read_channel_byte(port, hi_txopos)) & 0xff);
 | 
						|
}
 | 
						|
 | 
						|
static void sx_shutdown_port(void *ptr)
 | 
						|
{
 | 
						|
	struct sx_port *port = ptr;
 | 
						|
 | 
						|
	func_enter();
 | 
						|
 | 
						|
	port->gs.port.flags &= ~GS_ACTIVE;
 | 
						|
	if (port->gs.port.tty && (port->gs.port.tty->termios->c_cflag & HUPCL)) {
 | 
						|
		sx_setsignals(port, 0, 0);
 | 
						|
		sx_reconfigure_port(port);
 | 
						|
	}
 | 
						|
 | 
						|
	func_exit();
 | 
						|
}
 | 
						|
 | 
						|
/* ********************************************************************** *
 | 
						|
 *                Here are the routines that actually                     *
 | 
						|
 *               interface with the rest of the system                    *
 | 
						|
 * ********************************************************************** */
 | 
						|
 | 
						|
static int sx_open(struct tty_struct *tty, struct file *filp)
 | 
						|
{
 | 
						|
	struct sx_port *port;
 | 
						|
	int retval, line;
 | 
						|
	unsigned long flags;
 | 
						|
 | 
						|
	func_enter();
 | 
						|
 | 
						|
	if (!sx_initialized) {
 | 
						|
		return -EIO;
 | 
						|
	}
 | 
						|
 | 
						|
	line = tty->index;
 | 
						|
	sx_dprintk(SX_DEBUG_OPEN, "%d: opening line %d. tty=%p ctty=%p, "
 | 
						|
			"np=%d)\n", task_pid_nr(current), line, tty,
 | 
						|
			current->signal->tty, sx_nports);
 | 
						|
 | 
						|
	if ((line < 0) || (line >= SX_NPORTS) || (line >= sx_nports))
 | 
						|
		return -ENODEV;
 | 
						|
 | 
						|
	port = &sx_ports[line];
 | 
						|
	port->c_dcd = 0; /* Make sure that the first interrupt doesn't detect a
 | 
						|
			    1 -> 0 transition. */
 | 
						|
 | 
						|
	sx_dprintk(SX_DEBUG_OPEN, "port = %p c_dcd = %d\n", port, port->c_dcd);
 | 
						|
 | 
						|
	spin_lock_irqsave(&port->gs.driver_lock, flags);
 | 
						|
 | 
						|
	tty->driver_data = port;
 | 
						|
	port->gs.port.tty = tty;
 | 
						|
	port->gs.port.count++;
 | 
						|
	spin_unlock_irqrestore(&port->gs.driver_lock, flags);
 | 
						|
 | 
						|
	sx_dprintk(SX_DEBUG_OPEN, "starting port\n");
 | 
						|
 | 
						|
	/*
 | 
						|
	 * Start up serial port
 | 
						|
	 */
 | 
						|
	retval = gs_init_port(&port->gs);
 | 
						|
	sx_dprintk(SX_DEBUG_OPEN, "done gs_init\n");
 | 
						|
	if (retval) {
 | 
						|
		port->gs.port.count--;
 | 
						|
		return retval;
 | 
						|
	}
 | 
						|
 | 
						|
	port->gs.port.flags |= GS_ACTIVE;
 | 
						|
	if (port->gs.port.count <= 1)
 | 
						|
		sx_setsignals(port, 1, 1);
 | 
						|
 | 
						|
#if 0
 | 
						|
	if (sx_debug & SX_DEBUG_OPEN)
 | 
						|
		my_hd(port, sizeof(*port));
 | 
						|
#else
 | 
						|
	if (sx_debug & SX_DEBUG_OPEN)
 | 
						|
		my_hd_io(port->board->base + port->ch_base, sizeof(*port));
 | 
						|
#endif
 | 
						|
 | 
						|
	if (port->gs.port.count <= 1) {
 | 
						|
		if (sx_send_command(port, HS_LOPEN, -1, HS_IDLE_OPEN) != 1) {
 | 
						|
			printk(KERN_ERR "sx: Card didn't respond to LOPEN "
 | 
						|
					"command.\n");
 | 
						|
			spin_lock_irqsave(&port->gs.driver_lock, flags);
 | 
						|
			port->gs.port.count--;
 | 
						|
			spin_unlock_irqrestore(&port->gs.driver_lock, flags);
 | 
						|
			return -EIO;
 | 
						|
		}
 | 
						|
	}
 | 
						|
 | 
						|
	retval = gs_block_til_ready(port, filp);
 | 
						|
	sx_dprintk(SX_DEBUG_OPEN, "Block til ready returned %d. Count=%d\n",
 | 
						|
			retval, port->gs.port.count);
 | 
						|
 | 
						|
	if (retval) {
 | 
						|
/*
 | 
						|
 * Don't lower gs.port.count here because sx_close() will be called later
 | 
						|
 */
 | 
						|
 | 
						|
		return retval;
 | 
						|
	}
 | 
						|
	/* tty->low_latency = 1; */
 | 
						|
 | 
						|
	port->c_dcd = sx_carrier_raised(&port->gs.port);
 | 
						|
	sx_dprintk(SX_DEBUG_OPEN, "at open: cd=%d\n", port->c_dcd);
 | 
						|
 | 
						|
	func_exit();
 | 
						|
	return 0;
 | 
						|
 | 
						|
}
 | 
						|
 | 
						|
static void sx_close(void *ptr)
 | 
						|
{
 | 
						|
	struct sx_port *port = ptr;
 | 
						|
	/* Give the port 5 seconds to close down. */
 | 
						|
	int to = 5 * HZ;
 | 
						|
 | 
						|
	func_enter();
 | 
						|
 | 
						|
	sx_setsignals(port, 0, 0);
 | 
						|
	sx_reconfigure_port(port);
 | 
						|
	sx_send_command(port, HS_CLOSE, 0, 0);
 | 
						|
 | 
						|
	while (to-- && (sx_read_channel_byte(port, hi_hstat) != HS_IDLE_CLOSED))
 | 
						|
		if (msleep_interruptible(10))
 | 
						|
			break;
 | 
						|
	if (sx_read_channel_byte(port, hi_hstat) != HS_IDLE_CLOSED) {
 | 
						|
		if (sx_send_command(port, HS_FORCE_CLOSED, -1, HS_IDLE_CLOSED)
 | 
						|
				!= 1) {
 | 
						|
			printk(KERN_ERR "sx: sent the force_close command, but "
 | 
						|
					"card didn't react\n");
 | 
						|
		} else
 | 
						|
			sx_dprintk(SX_DEBUG_CLOSE, "sent the force_close "
 | 
						|
					"command.\n");
 | 
						|
	}
 | 
						|
 | 
						|
	sx_dprintk(SX_DEBUG_CLOSE, "waited %d jiffies for close. count=%d\n",
 | 
						|
			5 * HZ - to - 1, port->gs.port.count);
 | 
						|
 | 
						|
	if (port->gs.port.count) {
 | 
						|
		sx_dprintk(SX_DEBUG_CLOSE, "WARNING port count:%d\n",
 | 
						|
				port->gs.port.count);
 | 
						|
		/*printk("%s SETTING port count to zero: %p count: %d\n",
 | 
						|
				__func__, port, port->gs.port.count);
 | 
						|
		port->gs.port.count = 0;*/
 | 
						|
	}
 | 
						|
 | 
						|
	func_exit();
 | 
						|
}
 | 
						|
 | 
						|
/* This is relatively thorough. But then again it is only 20 lines. */
 | 
						|
#define MARCHUP		for (i = min; i < max; i++)
 | 
						|
#define MARCHDOWN	for (i = max - 1; i >= min; i--)
 | 
						|
#define W0		write_sx_byte(board, i, 0x55)
 | 
						|
#define W1		write_sx_byte(board, i, 0xaa)
 | 
						|
#define R0		if (read_sx_byte(board, i) != 0x55) return 1
 | 
						|
#define R1		if (read_sx_byte(board, i) != 0xaa) return 1
 | 
						|
 | 
						|
/* This memtest takes a human-noticable time. You normally only do it
 | 
						|
   once a boot, so I guess that it is worth it. */
 | 
						|
static int do_memtest(struct sx_board *board, int min, int max)
 | 
						|
{
 | 
						|
	int i;
 | 
						|
 | 
						|
	/* This is a marchb. Theoretically, marchb catches much more than
 | 
						|
	   simpler tests. In practise, the longer test just catches more
 | 
						|
	   intermittent errors. -- REW
 | 
						|
	   (For the theory behind memory testing see: 
 | 
						|
	   Testing Semiconductor Memories by A.J. van de Goor.) */
 | 
						|
	MARCHUP {
 | 
						|
		W0;
 | 
						|
	}
 | 
						|
	MARCHUP {
 | 
						|
		R0;
 | 
						|
		W1;
 | 
						|
		R1;
 | 
						|
		W0;
 | 
						|
		R0;
 | 
						|
		W1;
 | 
						|
	}
 | 
						|
	MARCHUP {
 | 
						|
		R1;
 | 
						|
		W0;
 | 
						|
		W1;
 | 
						|
	}
 | 
						|
	MARCHDOWN {
 | 
						|
		R1;
 | 
						|
		W0;
 | 
						|
		W1;
 | 
						|
		W0;
 | 
						|
	}
 | 
						|
	MARCHDOWN {
 | 
						|
		R0;
 | 
						|
		W1;
 | 
						|
		W0;
 | 
						|
	}
 | 
						|
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
#undef MARCHUP
 | 
						|
#undef MARCHDOWN
 | 
						|
#undef W0
 | 
						|
#undef W1
 | 
						|
#undef R0
 | 
						|
#undef R1
 | 
						|
 | 
						|
#define MARCHUP		for (i = min; i < max; i += 2)
 | 
						|
#define MARCHDOWN	for (i = max - 1; i >= min; i -= 2)
 | 
						|
#define W0		write_sx_word(board, i, 0x55aa)
 | 
						|
#define W1		write_sx_word(board, i, 0xaa55)
 | 
						|
#define R0		if (read_sx_word(board, i) != 0x55aa) return 1
 | 
						|
#define R1		if (read_sx_word(board, i) != 0xaa55) return 1
 | 
						|
 | 
						|
#if 0
 | 
						|
/* This memtest takes a human-noticable time. You normally only do it
 | 
						|
   once a boot, so I guess that it is worth it. */
 | 
						|
static int do_memtest_w(struct sx_board *board, int min, int max)
 | 
						|
{
 | 
						|
	int i;
 | 
						|
 | 
						|
	MARCHUP {
 | 
						|
		W0;
 | 
						|
	}
 | 
						|
	MARCHUP {
 | 
						|
		R0;
 | 
						|
		W1;
 | 
						|
		R1;
 | 
						|
		W0;
 | 
						|
		R0;
 | 
						|
		W1;
 | 
						|
	}
 | 
						|
	MARCHUP {
 | 
						|
		R1;
 | 
						|
		W0;
 | 
						|
		W1;
 | 
						|
	}
 | 
						|
	MARCHDOWN {
 | 
						|
		R1;
 | 
						|
		W0;
 | 
						|
		W1;
 | 
						|
		W0;
 | 
						|
	}
 | 
						|
	MARCHDOWN {
 | 
						|
		R0;
 | 
						|
		W1;
 | 
						|
		W0;
 | 
						|
	}
 | 
						|
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
#endif
 | 
						|
 | 
						|
static long sx_fw_ioctl(struct file *filp, unsigned int cmd,
 | 
						|
							unsigned long arg)
 | 
						|
{
 | 
						|
	long rc = 0;
 | 
						|
	int __user *descr = (int __user *)arg;
 | 
						|
	int i;
 | 
						|
	static struct sx_board *board = NULL;
 | 
						|
	int nbytes, offset;
 | 
						|
	unsigned long data;
 | 
						|
	char *tmp;
 | 
						|
 | 
						|
	func_enter();
 | 
						|
 | 
						|
	if (!capable(CAP_SYS_RAWIO))
 | 
						|
		return -EPERM;
 | 
						|
 | 
						|
	lock_kernel();
 | 
						|
 | 
						|
	sx_dprintk(SX_DEBUG_FIRMWARE, "IOCTL %x: %lx\n", cmd, arg);
 | 
						|
 | 
						|
	if (!board)
 | 
						|
		board = &boards[0];
 | 
						|
	if (board->flags & SX_BOARD_PRESENT) {
 | 
						|
		sx_dprintk(SX_DEBUG_FIRMWARE, "Board present! (%x)\n",
 | 
						|
				board->flags);
 | 
						|
	} else {
 | 
						|
		sx_dprintk(SX_DEBUG_FIRMWARE, "Board not present! (%x) all:",
 | 
						|
				board->flags);
 | 
						|
		for (i = 0; i < SX_NBOARDS; i++)
 | 
						|
			sx_dprintk(SX_DEBUG_FIRMWARE, "<%x> ", boards[i].flags);
 | 
						|
		sx_dprintk(SX_DEBUG_FIRMWARE, "\n");
 | 
						|
		rc = -EIO;
 | 
						|
		goto out;
 | 
						|
	}
 | 
						|
 | 
						|
	switch (cmd) {
 | 
						|
	case SXIO_SET_BOARD:
 | 
						|
		sx_dprintk(SX_DEBUG_FIRMWARE, "set board to %ld\n", arg);
 | 
						|
		rc = -EIO;
 | 
						|
		if (arg >= SX_NBOARDS)
 | 
						|
			break;
 | 
						|
		sx_dprintk(SX_DEBUG_FIRMWARE, "not out of range\n");
 | 
						|
		if (!(boards[arg].flags & SX_BOARD_PRESENT))
 | 
						|
			break;
 | 
						|
		sx_dprintk(SX_DEBUG_FIRMWARE, ".. and present!\n");
 | 
						|
		board = &boards[arg];
 | 
						|
		rc = 0;
 | 
						|
		/* FIXME: And this does ... nothing?? */
 | 
						|
		break;
 | 
						|
	case SXIO_GET_TYPE:
 | 
						|
		rc = -ENOENT;	/* If we manage to miss one, return error. */
 | 
						|
		if (IS_SX_BOARD(board))
 | 
						|
			rc = SX_TYPE_SX;
 | 
						|
		if (IS_CF_BOARD(board))
 | 
						|
			rc = SX_TYPE_CF;
 | 
						|
		if (IS_SI_BOARD(board))
 | 
						|
			rc = SX_TYPE_SI;
 | 
						|
		if (IS_SI1_BOARD(board))
 | 
						|
			rc = SX_TYPE_SI;
 | 
						|
		if (IS_EISA_BOARD(board))
 | 
						|
			rc = SX_TYPE_SI;
 | 
						|
		sx_dprintk(SX_DEBUG_FIRMWARE, "returning type= %ld\n", rc);
 | 
						|
		break;
 | 
						|
	case SXIO_DO_RAMTEST:
 | 
						|
		if (sx_initialized) {	/* Already initialized: better not ramtest the board.  */
 | 
						|
			rc = -EPERM;
 | 
						|
			break;
 | 
						|
		}
 | 
						|
		if (IS_SX_BOARD(board)) {
 | 
						|
			rc = do_memtest(board, 0, 0x7000);
 | 
						|
			if (!rc)
 | 
						|
				rc = do_memtest(board, 0, 0x7000);
 | 
						|
			/*if (!rc) rc = do_memtest_w (board, 0, 0x7000); */
 | 
						|
		} else {
 | 
						|
			rc = do_memtest(board, 0, 0x7ff8);
 | 
						|
			/* if (!rc) rc = do_memtest_w (board, 0, 0x7ff8); */
 | 
						|
		}
 | 
						|
		sx_dprintk(SX_DEBUG_FIRMWARE,
 | 
						|
				"returning memtest result= %ld\n", rc);
 | 
						|
		break;
 | 
						|
	case SXIO_DOWNLOAD:
 | 
						|
		if (sx_initialized) {/* Already initialized */
 | 
						|
			rc = -EEXIST;
 | 
						|
			break;
 | 
						|
		}
 | 
						|
		if (!sx_reset(board)) {
 | 
						|
			rc = -EIO;
 | 
						|
			break;
 | 
						|
		}
 | 
						|
		sx_dprintk(SX_DEBUG_INIT, "reset the board...\n");
 | 
						|
 | 
						|
		tmp = kmalloc(SX_CHUNK_SIZE, GFP_USER);
 | 
						|
		if (!tmp) {
 | 
						|
			rc = -ENOMEM;
 | 
						|
			break;
 | 
						|
		}
 | 
						|
		/* FIXME: check returns */
 | 
						|
		get_user(nbytes, descr++);
 | 
						|
		get_user(offset, descr++);
 | 
						|
		get_user(data, descr++);
 | 
						|
		while (nbytes && data) {
 | 
						|
			for (i = 0; i < nbytes; i += SX_CHUNK_SIZE) {
 | 
						|
				if (copy_from_user(tmp, (char __user *)data + i,
 | 
						|
						(i + SX_CHUNK_SIZE > nbytes) ?
 | 
						|
						nbytes - i : SX_CHUNK_SIZE)) {
 | 
						|
					kfree(tmp);
 | 
						|
					rc = -EFAULT;
 | 
						|
					goto out;
 | 
						|
				}
 | 
						|
				memcpy_toio(board->base2 + offset + i, tmp,
 | 
						|
						(i + SX_CHUNK_SIZE > nbytes) ?
 | 
						|
						nbytes - i : SX_CHUNK_SIZE);
 | 
						|
			}
 | 
						|
 | 
						|
			get_user(nbytes, descr++);
 | 
						|
			get_user(offset, descr++);
 | 
						|
			get_user(data, descr++);
 | 
						|
		}
 | 
						|
		kfree(tmp);
 | 
						|
		sx_nports += sx_init_board(board);
 | 
						|
		rc = sx_nports;
 | 
						|
		break;
 | 
						|
	case SXIO_INIT:
 | 
						|
		if (sx_initialized) {	/* Already initialized */
 | 
						|
			rc = -EEXIST;
 | 
						|
			break;
 | 
						|
		}
 | 
						|
		/* This is not allowed until all boards are initialized... */
 | 
						|
		for (i = 0; i < SX_NBOARDS; i++) {
 | 
						|
			if ((boards[i].flags & SX_BOARD_PRESENT) &&
 | 
						|
				!(boards[i].flags & SX_BOARD_INITIALIZED)) {
 | 
						|
				rc = -EIO;
 | 
						|
				break;
 | 
						|
			}
 | 
						|
		}
 | 
						|
		for (i = 0; i < SX_NBOARDS; i++)
 | 
						|
			if (!(boards[i].flags & SX_BOARD_PRESENT))
 | 
						|
				break;
 | 
						|
 | 
						|
		sx_dprintk(SX_DEBUG_FIRMWARE, "initing portstructs, %d boards, "
 | 
						|
				"%d channels, first board: %d ports\n",
 | 
						|
				i, sx_nports, boards[0].nports);
 | 
						|
		rc = sx_init_portstructs(i, sx_nports);
 | 
						|
		sx_init_drivers();
 | 
						|
		if (rc >= 0)
 | 
						|
			sx_initialized++;
 | 
						|
		break;
 | 
						|
	case SXIO_SETDEBUG:
 | 
						|
		sx_debug = arg;
 | 
						|
		break;
 | 
						|
	case SXIO_GETDEBUG:
 | 
						|
		rc = sx_debug;
 | 
						|
		break;
 | 
						|
	case SXIO_GETGSDEBUG:
 | 
						|
	case SXIO_SETGSDEBUG:
 | 
						|
		rc = -EINVAL;
 | 
						|
		break;
 | 
						|
	case SXIO_GETNPORTS:
 | 
						|
		rc = sx_nports;
 | 
						|
		break;
 | 
						|
	default:
 | 
						|
		rc = -ENOTTY;
 | 
						|
		break;
 | 
						|
	}
 | 
						|
out:
 | 
						|
	unlock_kernel();
 | 
						|
	func_exit();
 | 
						|
	return rc;
 | 
						|
}
 | 
						|
 | 
						|
static int sx_break(struct tty_struct *tty, int flag)
 | 
						|
{
 | 
						|
	struct sx_port *port = tty->driver_data;
 | 
						|
	int rv;
 | 
						|
 | 
						|
	func_enter();
 | 
						|
	lock_kernel();
 | 
						|
 | 
						|
	if (flag)
 | 
						|
		rv = sx_send_command(port, HS_START, -1, HS_IDLE_BREAK);
 | 
						|
	else
 | 
						|
		rv = sx_send_command(port, HS_STOP, -1, HS_IDLE_OPEN);
 | 
						|
	if (rv != 1)
 | 
						|
		printk(KERN_ERR "sx: couldn't send break (%x).\n",
 | 
						|
			read_sx_byte(port->board, CHAN_OFFSET(port, hi_hstat)));
 | 
						|
	unlock_kernel();
 | 
						|
	func_exit();
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
static int sx_tiocmget(struct tty_struct *tty, struct file *file)
 | 
						|
{
 | 
						|
	struct sx_port *port = tty->driver_data;
 | 
						|
	return sx_getsignals(port);
 | 
						|
}
 | 
						|
 | 
						|
static int sx_tiocmset(struct tty_struct *tty, struct file *file,
 | 
						|
		unsigned int set, unsigned int clear)
 | 
						|
{
 | 
						|
	struct sx_port *port = tty->driver_data;
 | 
						|
	int rts = -1, dtr = -1;
 | 
						|
 | 
						|
	if (set & TIOCM_RTS)
 | 
						|
		rts = 1;
 | 
						|
	if (set & TIOCM_DTR)
 | 
						|
		dtr = 1;
 | 
						|
	if (clear & TIOCM_RTS)
 | 
						|
		rts = 0;
 | 
						|
	if (clear & TIOCM_DTR)
 | 
						|
		dtr = 0;
 | 
						|
 | 
						|
	sx_setsignals(port, dtr, rts);
 | 
						|
	sx_reconfigure_port(port);
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
static int sx_ioctl(struct tty_struct *tty, struct file *filp,
 | 
						|
		unsigned int cmd, unsigned long arg)
 | 
						|
{
 | 
						|
	int rc;
 | 
						|
	struct sx_port *port = tty->driver_data;
 | 
						|
	void __user *argp = (void __user *)arg;
 | 
						|
 | 
						|
	/* func_enter2(); */
 | 
						|
 | 
						|
	rc = 0;
 | 
						|
	lock_kernel();
 | 
						|
	switch (cmd) {
 | 
						|
	case TIOCGSERIAL:
 | 
						|
		rc = gs_getserial(&port->gs, argp);
 | 
						|
		break;
 | 
						|
	case TIOCSSERIAL:
 | 
						|
		rc = gs_setserial(&port->gs, argp);
 | 
						|
		break;
 | 
						|
	default:
 | 
						|
		rc = -ENOIOCTLCMD;
 | 
						|
		break;
 | 
						|
	}
 | 
						|
	unlock_kernel();
 | 
						|
 | 
						|
	/* func_exit(); */
 | 
						|
	return rc;
 | 
						|
}
 | 
						|
 | 
						|
/* The throttle/unthrottle scheme for the Specialix card is different
 | 
						|
 * from other drivers and deserves some explanation. 
 | 
						|
 * The Specialix hardware takes care of XON/XOFF
 | 
						|
 * and CTS/RTS flow control itself.  This means that all we have to
 | 
						|
 * do when signalled by the upper tty layer to throttle/unthrottle is
 | 
						|
 * to make a note of it here.  When we come to read characters from the
 | 
						|
 * rx buffers on the card (sx_receive_chars()) we look to see if the
 | 
						|
 * upper layer can accept more (as noted here in sx_rx_throt[]). 
 | 
						|
 * If it can't we simply don't remove chars from the cards buffer. 
 | 
						|
 * When the tty layer can accept chars, we again note that here and when
 | 
						|
 * sx_receive_chars() is called it will remove them from the cards buffer.
 | 
						|
 * The card will notice that a ports buffer has drained below some low
 | 
						|
 * water mark and will unflow control the line itself, using whatever
 | 
						|
 * flow control scheme is in use for that port. -- Simon Allen
 | 
						|
 */
 | 
						|
 | 
						|
static void sx_throttle(struct tty_struct *tty)
 | 
						|
{
 | 
						|
	struct sx_port *port = tty->driver_data;
 | 
						|
 | 
						|
	func_enter2();
 | 
						|
	/* If the port is using any type of input flow
 | 
						|
	 * control then throttle the port.
 | 
						|
	 */
 | 
						|
	if ((tty->termios->c_cflag & CRTSCTS) || (I_IXOFF(tty))) {
 | 
						|
		port->gs.port.flags |= SX_RX_THROTTLE;
 | 
						|
	}
 | 
						|
	func_exit();
 | 
						|
}
 | 
						|
 | 
						|
static void sx_unthrottle(struct tty_struct *tty)
 | 
						|
{
 | 
						|
	struct sx_port *port = tty->driver_data;
 | 
						|
 | 
						|
	func_enter2();
 | 
						|
	/* Always unthrottle even if flow control is not enabled on
 | 
						|
	 * this port in case we disabled flow control while the port
 | 
						|
	 * was throttled
 | 
						|
	 */
 | 
						|
	port->gs.port.flags &= ~SX_RX_THROTTLE;
 | 
						|
	func_exit();
 | 
						|
	return;
 | 
						|
}
 | 
						|
 | 
						|
/* ********************************************************************** *
 | 
						|
 *                    Here are the initialization routines.               *
 | 
						|
 * ********************************************************************** */
 | 
						|
 | 
						|
static int sx_init_board(struct sx_board *board)
 | 
						|
{
 | 
						|
	int addr;
 | 
						|
	int chans;
 | 
						|
	int type;
 | 
						|
 | 
						|
	func_enter();
 | 
						|
 | 
						|
	/* This is preceded by downloading the download code. */
 | 
						|
 | 
						|
	board->flags |= SX_BOARD_INITIALIZED;
 | 
						|
 | 
						|
	if (read_sx_byte(board, 0))
 | 
						|
		/* CF boards may need this. */
 | 
						|
		write_sx_byte(board, 0, 0);
 | 
						|
 | 
						|
	/* This resets the processor again, to make sure it didn't do any
 | 
						|
	   foolish things while we were downloading the image */
 | 
						|
	if (!sx_reset(board))
 | 
						|
		return 0;
 | 
						|
 | 
						|
	sx_start_board(board);
 | 
						|
	udelay(10);
 | 
						|
	if (!sx_busy_wait_neq(board, 0, 0xff, 0)) {
 | 
						|
		printk(KERN_ERR "sx: Ooops. Board won't initialize.\n");
 | 
						|
		return 0;
 | 
						|
	}
 | 
						|
 | 
						|
	/* Ok. So now the processor on the card is running. It gathered
 | 
						|
	   some info for us... */
 | 
						|
	sx_dprintk(SX_DEBUG_INIT, "The sxcard structure:\n");
 | 
						|
	if (sx_debug & SX_DEBUG_INIT)
 | 
						|
		my_hd_io(board->base, 0x10);
 | 
						|
	sx_dprintk(SX_DEBUG_INIT, "the first sx_module structure:\n");
 | 
						|
	if (sx_debug & SX_DEBUG_INIT)
 | 
						|
		my_hd_io(board->base + 0x80, 0x30);
 | 
						|
 | 
						|
	sx_dprintk(SX_DEBUG_INIT, "init_status: %x, %dk memory, firmware "
 | 
						|
			"V%x.%02x,\n",
 | 
						|
			read_sx_byte(board, 0), read_sx_byte(board, 1),
 | 
						|
			read_sx_byte(board, 5), read_sx_byte(board, 4));
 | 
						|
 | 
						|
	if (read_sx_byte(board, 0) == 0xff) {
 | 
						|
		printk(KERN_INFO "sx: No modules found. Sorry.\n");
 | 
						|
		board->nports = 0;
 | 
						|
		return 0;
 | 
						|
	}
 | 
						|
 | 
						|
	chans = 0;
 | 
						|
 | 
						|
	if (IS_SX_BOARD(board)) {
 | 
						|
		sx_write_board_word(board, cc_int_count, sx_maxints);
 | 
						|
	} else {
 | 
						|
		if (sx_maxints)
 | 
						|
			sx_write_board_word(board, cc_int_count,
 | 
						|
					SI_PROCESSOR_CLOCK / 8 / sx_maxints);
 | 
						|
	}
 | 
						|
 | 
						|
	/* grab the first module type... */
 | 
						|
	/* board->ta_type = mod_compat_type (read_sx_byte (board, 0x80 + 0x08)); */
 | 
						|
	board->ta_type = mod_compat_type(sx_read_module_byte(board, 0x80,
 | 
						|
				mc_chip));
 | 
						|
 | 
						|
	/* XXX byteorder */
 | 
						|
	for (addr = 0x80; addr != 0; addr = read_sx_word(board, addr) & 0x7fff){
 | 
						|
		type = sx_read_module_byte(board, addr, mc_chip);
 | 
						|
		sx_dprintk(SX_DEBUG_INIT, "Module at %x: %d channels\n",
 | 
						|
				addr, read_sx_byte(board, addr + 2));
 | 
						|
 | 
						|
		chans += sx_read_module_byte(board, addr, mc_type);
 | 
						|
 | 
						|
		sx_dprintk(SX_DEBUG_INIT, "module is an %s, which has %s/%s "
 | 
						|
				"panels\n",
 | 
						|
				mod_type_s(type),
 | 
						|
				pan_type_s(sx_read_module_byte(board, addr,
 | 
						|
						mc_mods) & 0xf),
 | 
						|
				pan_type_s(sx_read_module_byte(board, addr,
 | 
						|
						mc_mods) >> 4));
 | 
						|
 | 
						|
		sx_dprintk(SX_DEBUG_INIT, "CD1400 versions: %x/%x, ASIC "
 | 
						|
			"version: %x\n",
 | 
						|
			sx_read_module_byte(board, addr, mc_rev1),
 | 
						|
			sx_read_module_byte(board, addr, mc_rev2),
 | 
						|
			sx_read_module_byte(board, addr, mc_mtaasic_rev));
 | 
						|
 | 
						|
		/* The following combinations are illegal: It should theoretically
 | 
						|
		   work, but timing problems make the bus HANG. */
 | 
						|
 | 
						|
		if (mod_compat_type(type) != board->ta_type) {
 | 
						|
			printk(KERN_ERR "sx: This is an invalid "
 | 
						|
				"configuration.\nDon't mix TA/MTA/SXDC on the "
 | 
						|
				"same hostadapter.\n");
 | 
						|
			chans = 0;
 | 
						|
			break;
 | 
						|
		}
 | 
						|
		if ((IS_EISA_BOARD(board) ||
 | 
						|
				IS_SI_BOARD(board)) &&
 | 
						|
				(mod_compat_type(type) == 4)) {
 | 
						|
			printk(KERN_ERR	"sx: This is an invalid "
 | 
						|
				"configuration.\nDon't use SXDCs on an SI/XIO "
 | 
						|
				"adapter.\n");
 | 
						|
			chans = 0;
 | 
						|
			break;
 | 
						|
		}
 | 
						|
#if 0				/* Problem fixed: firmware 3.05 */
 | 
						|
		if (IS_SX_BOARD(board) && (type == TA8)) {
 | 
						|
			/* There are some issues with the firmware and the DCD/RTS
 | 
						|
			   lines. It might work if you tie them together or something.
 | 
						|
			   It might also work if you get a newer sx_firmware.   Therefore
 | 
						|
			   this is just a warning. */
 | 
						|
			printk(KERN_WARNING
 | 
						|
			       "sx: The SX host doesn't work too well "
 | 
						|
			       "with the TA8 adapters.\nSpecialix is working on it.\n");
 | 
						|
		}
 | 
						|
#endif
 | 
						|
	}
 | 
						|
 | 
						|
	if (chans) {
 | 
						|
		if (board->irq > 0) {
 | 
						|
			/* fixed irq, probably PCI */
 | 
						|
			if (sx_irqmask & (1 << board->irq)) {	/* may we use this irq? */
 | 
						|
				if (request_irq(board->irq, sx_interrupt,
 | 
						|
						IRQF_SHARED | IRQF_DISABLED,
 | 
						|
						"sx", board)) {
 | 
						|
					printk(KERN_ERR "sx: Cannot allocate "
 | 
						|
						"irq %d.\n", board->irq);
 | 
						|
					board->irq = 0;
 | 
						|
				}
 | 
						|
			} else
 | 
						|
				board->irq = 0;
 | 
						|
		} else if (board->irq < 0 && sx_irqmask) {
 | 
						|
			/* auto-allocate irq */
 | 
						|
			int irqnr;
 | 
						|
			int irqmask = sx_irqmask & (IS_SX_BOARD(board) ?
 | 
						|
					SX_ISA_IRQ_MASK : SI2_ISA_IRQ_MASK);
 | 
						|
			for (irqnr = 15; irqnr > 0; irqnr--)
 | 
						|
				if (irqmask & (1 << irqnr))
 | 
						|
					if (!request_irq(irqnr, sx_interrupt,
 | 
						|
						IRQF_SHARED | IRQF_DISABLED,
 | 
						|
						"sx", board))
 | 
						|
						break;
 | 
						|
			if (!irqnr)
 | 
						|
				printk(KERN_ERR "sx: Cannot allocate IRQ.\n");
 | 
						|
			board->irq = irqnr;
 | 
						|
		} else
 | 
						|
			board->irq = 0;
 | 
						|
 | 
						|
		if (board->irq) {
 | 
						|
			/* Found a valid interrupt, start up interrupts! */
 | 
						|
			sx_dprintk(SX_DEBUG_INIT, "Using irq %d.\n",
 | 
						|
					board->irq);
 | 
						|
			sx_start_interrupts(board);
 | 
						|
			board->poll = sx_slowpoll;
 | 
						|
			board->flags |= SX_IRQ_ALLOCATED;
 | 
						|
		} else {
 | 
						|
			/* no irq: setup board for polled operation */
 | 
						|
			board->poll = sx_poll;
 | 
						|
			sx_dprintk(SX_DEBUG_INIT, "Using poll-interval %d.\n",
 | 
						|
					board->poll);
 | 
						|
		}
 | 
						|
 | 
						|
		/* The timer should be initialized anyway: That way we can
 | 
						|
		   safely del_timer it when the module is unloaded. */
 | 
						|
		setup_timer(&board->timer, sx_pollfunc, (unsigned long)board);
 | 
						|
 | 
						|
		if (board->poll)
 | 
						|
			mod_timer(&board->timer, jiffies + board->poll);
 | 
						|
	} else {
 | 
						|
		board->irq = 0;
 | 
						|
	}
 | 
						|
 | 
						|
	board->nports = chans;
 | 
						|
	sx_dprintk(SX_DEBUG_INIT, "returning %d ports.", board->nports);
 | 
						|
 | 
						|
	func_exit();
 | 
						|
	return chans;
 | 
						|
}
 | 
						|
 | 
						|
static void __devinit printheader(void)
 | 
						|
{
 | 
						|
	static int header_printed;
 | 
						|
 | 
						|
	if (!header_printed) {
 | 
						|
		printk(KERN_INFO "Specialix SX driver "
 | 
						|
			"(C) 1998/1999 R.E.Wolff@BitWizard.nl\n");
 | 
						|
		printk(KERN_INFO "sx: version " __stringify(SX_VERSION) "\n");
 | 
						|
		header_printed = 1;
 | 
						|
	}
 | 
						|
}
 | 
						|
 | 
						|
static int __devinit probe_sx(struct sx_board *board)
 | 
						|
{
 | 
						|
	struct vpd_prom vpdp;
 | 
						|
	char *p;
 | 
						|
	int i;
 | 
						|
 | 
						|
	func_enter();
 | 
						|
 | 
						|
	if (!IS_CF_BOARD(board)) {
 | 
						|
		sx_dprintk(SX_DEBUG_PROBE, "Going to verify vpd prom at %p.\n",
 | 
						|
				board->base + SX_VPD_ROM);
 | 
						|
 | 
						|
		if (sx_debug & SX_DEBUG_PROBE)
 | 
						|
			my_hd_io(board->base + SX_VPD_ROM, 0x40);
 | 
						|
 | 
						|
		p = (char *)&vpdp;
 | 
						|
		for (i = 0; i < sizeof(struct vpd_prom); i++)
 | 
						|
			*p++ = read_sx_byte(board, SX_VPD_ROM + i * 2);
 | 
						|
 | 
						|
		if (sx_debug & SX_DEBUG_PROBE)
 | 
						|
			my_hd(&vpdp, 0x20);
 | 
						|
 | 
						|
		sx_dprintk(SX_DEBUG_PROBE, "checking identifier...\n");
 | 
						|
 | 
						|
		if (strncmp(vpdp.identifier, SX_VPD_IDENT_STRING, 16) != 0) {
 | 
						|
			sx_dprintk(SX_DEBUG_PROBE, "Got non-SX identifier: "
 | 
						|
					"'%s'\n", vpdp.identifier);
 | 
						|
			return 0;
 | 
						|
		}
 | 
						|
	}
 | 
						|
 | 
						|
	printheader();
 | 
						|
 | 
						|
	if (!IS_CF_BOARD(board)) {
 | 
						|
		printk(KERN_DEBUG "sx: Found an SX board at %lx\n",
 | 
						|
			board->hw_base);
 | 
						|
		printk(KERN_DEBUG "sx: hw_rev: %d, assembly level: %d, "
 | 
						|
				"uniq ID:%08x, ",
 | 
						|
				vpdp.hwrev, vpdp.hwass, vpdp.uniqid);
 | 
						|
		printk("Manufactured: %d/%d\n", 1970 + vpdp.myear, vpdp.mweek);
 | 
						|
 | 
						|
		if ((((vpdp.uniqid >> 24) & SX_UNIQUEID_MASK) !=
 | 
						|
				SX_PCI_UNIQUEID1) && (((vpdp.uniqid >> 24) &
 | 
						|
				SX_UNIQUEID_MASK) != SX_ISA_UNIQUEID1)) {
 | 
						|
			/* This might be a bit harsh. This was the primary
 | 
						|
			   reason the SX/ISA card didn't work at first... */
 | 
						|
			printk(KERN_ERR "sx: Hmm. Not an SX/PCI or SX/ISA "
 | 
						|
					"card. Sorry: giving up.\n");
 | 
						|
			return (0);
 | 
						|
		}
 | 
						|
 | 
						|
		if (((vpdp.uniqid >> 24) & SX_UNIQUEID_MASK) ==
 | 
						|
				SX_ISA_UNIQUEID1) {
 | 
						|
			if (((unsigned long)board->hw_base) & 0x8000) {
 | 
						|
				printk(KERN_WARNING "sx: Warning: There may be "
 | 
						|
					"hardware problems with the card at "
 | 
						|
					"%lx.\n", board->hw_base);
 | 
						|
				printk(KERN_WARNING "sx: Read sx.txt for more "
 | 
						|
						"info.\n");
 | 
						|
			}
 | 
						|
		}
 | 
						|
	}
 | 
						|
 | 
						|
	board->nports = -1;
 | 
						|
 | 
						|
	/* This resets the processor, and keeps it off the bus. */
 | 
						|
	if (!sx_reset(board))
 | 
						|
		return 0;
 | 
						|
	sx_dprintk(SX_DEBUG_INIT, "reset the board...\n");
 | 
						|
 | 
						|
	func_exit();
 | 
						|
	return 1;
 | 
						|
}
 | 
						|
 | 
						|
#if defined(CONFIG_ISA) || defined(CONFIG_EISA)
 | 
						|
 | 
						|
/* Specialix probes for this card at 32k increments from 640k to 16M.
 | 
						|
   I consider machines with less than 16M unlikely nowadays, so I'm
 | 
						|
   not probing above 1Mb. Also, 0xa0000, 0xb0000, are taken by the VGA
 | 
						|
   card. 0xe0000 and 0xf0000 are taken by the BIOS. That only leaves 
 | 
						|
   0xc0000, 0xc8000, 0xd0000 and 0xd8000 . */
 | 
						|
 | 
						|
static int __devinit probe_si(struct sx_board *board)
 | 
						|
{
 | 
						|
	int i;
 | 
						|
 | 
						|
	func_enter();
 | 
						|
	sx_dprintk(SX_DEBUG_PROBE, "Going to verify SI signature hw %lx at "
 | 
						|
		"%p.\n", board->hw_base, board->base + SI2_ISA_ID_BASE);
 | 
						|
 | 
						|
	if (sx_debug & SX_DEBUG_PROBE)
 | 
						|
		my_hd_io(board->base + SI2_ISA_ID_BASE, 0x8);
 | 
						|
 | 
						|
	if (!IS_EISA_BOARD(board)) {
 | 
						|
		if (IS_SI1_BOARD(board)) {
 | 
						|
			for (i = 0; i < 8; i++) {
 | 
						|
				write_sx_byte(board, SI2_ISA_ID_BASE + 7 - i,i);
 | 
						|
			}
 | 
						|
		}
 | 
						|
		for (i = 0; i < 8; i++) {
 | 
						|
			if ((read_sx_byte(board, SI2_ISA_ID_BASE + 7 - i) & 7)
 | 
						|
					!= i) {
 | 
						|
				func_exit();
 | 
						|
				return 0;
 | 
						|
			}
 | 
						|
		}
 | 
						|
	}
 | 
						|
 | 
						|
	/* Now we're pretty much convinced that there is an SI board here, 
 | 
						|
	   but to prevent trouble, we'd better double check that we don't
 | 
						|
	   have an SI1 board when we're probing for an SI2 board.... */
 | 
						|
 | 
						|
	write_sx_byte(board, SI2_ISA_ID_BASE, 0x10);
 | 
						|
	if (IS_SI1_BOARD(board)) {
 | 
						|
		/* This should be an SI1 board, which has this
 | 
						|
		   location writable... */
 | 
						|
		if (read_sx_byte(board, SI2_ISA_ID_BASE) != 0x10) {
 | 
						|
			func_exit();
 | 
						|
			return 0;
 | 
						|
		}
 | 
						|
	} else {
 | 
						|
		/* This should be an SI2 board, which has the bottom
 | 
						|
		   3 bits non-writable... */
 | 
						|
		if (read_sx_byte(board, SI2_ISA_ID_BASE) == 0x10) {
 | 
						|
			func_exit();
 | 
						|
			return 0;
 | 
						|
		}
 | 
						|
	}
 | 
						|
 | 
						|
	/* Now we're pretty much convinced that there is an SI board here, 
 | 
						|
	   but to prevent trouble, we'd better double check that we don't
 | 
						|
	   have an SI1 board when we're probing for an SI2 board.... */
 | 
						|
 | 
						|
	write_sx_byte(board, SI2_ISA_ID_BASE, 0x10);
 | 
						|
	if (IS_SI1_BOARD(board)) {
 | 
						|
		/* This should be an SI1 board, which has this
 | 
						|
		   location writable... */
 | 
						|
		if (read_sx_byte(board, SI2_ISA_ID_BASE) != 0x10) {
 | 
						|
			func_exit();
 | 
						|
			return 0;
 | 
						|
		}
 | 
						|
	} else {
 | 
						|
		/* This should be an SI2 board, which has the bottom
 | 
						|
		   3 bits non-writable... */
 | 
						|
		if (read_sx_byte(board, SI2_ISA_ID_BASE) == 0x10) {
 | 
						|
			func_exit();
 | 
						|
			return 0;
 | 
						|
		}
 | 
						|
	}
 | 
						|
 | 
						|
	printheader();
 | 
						|
 | 
						|
	printk(KERN_DEBUG "sx: Found an SI board at %lx\n", board->hw_base);
 | 
						|
	/* Compared to the SX boards, it is a complete guess as to what
 | 
						|
	   this card is up to... */
 | 
						|
 | 
						|
	board->nports = -1;
 | 
						|
 | 
						|
	/* This resets the processor, and keeps it off the bus. */
 | 
						|
	if (!sx_reset(board))
 | 
						|
		return 0;
 | 
						|
	sx_dprintk(SX_DEBUG_INIT, "reset the board...\n");
 | 
						|
 | 
						|
	func_exit();
 | 
						|
	return 1;
 | 
						|
}
 | 
						|
#endif
 | 
						|
 | 
						|
static const struct tty_operations sx_ops = {
 | 
						|
	.break_ctl = sx_break,
 | 
						|
	.open = sx_open,
 | 
						|
	.close = gs_close,
 | 
						|
	.write = gs_write,
 | 
						|
	.put_char = gs_put_char,
 | 
						|
	.flush_chars = gs_flush_chars,
 | 
						|
	.write_room = gs_write_room,
 | 
						|
	.chars_in_buffer = gs_chars_in_buffer,
 | 
						|
	.flush_buffer = gs_flush_buffer,
 | 
						|
	.ioctl = sx_ioctl,
 | 
						|
	.throttle = sx_throttle,
 | 
						|
	.unthrottle = sx_unthrottle,
 | 
						|
	.set_termios = gs_set_termios,
 | 
						|
	.stop = gs_stop,
 | 
						|
	.start = gs_start,
 | 
						|
	.hangup = gs_hangup,
 | 
						|
	.tiocmget = sx_tiocmget,
 | 
						|
	.tiocmset = sx_tiocmset,
 | 
						|
};
 | 
						|
 | 
						|
static const struct tty_port_operations sx_port_ops = {
 | 
						|
	.carrier_raised = sx_carrier_raised,
 | 
						|
};
 | 
						|
 | 
						|
static int sx_init_drivers(void)
 | 
						|
{
 | 
						|
	int error;
 | 
						|
 | 
						|
	func_enter();
 | 
						|
 | 
						|
	sx_driver = alloc_tty_driver(sx_nports);
 | 
						|
	if (!sx_driver)
 | 
						|
		return 1;
 | 
						|
	sx_driver->owner = THIS_MODULE;
 | 
						|
	sx_driver->driver_name = "specialix_sx";
 | 
						|
	sx_driver->name = "ttyX";
 | 
						|
	sx_driver->major = SX_NORMAL_MAJOR;
 | 
						|
	sx_driver->type = TTY_DRIVER_TYPE_SERIAL;
 | 
						|
	sx_driver->subtype = SERIAL_TYPE_NORMAL;
 | 
						|
	sx_driver->init_termios = tty_std_termios;
 | 
						|
	sx_driver->init_termios.c_cflag = B9600 | CS8 | CREAD | HUPCL | CLOCAL;
 | 
						|
	sx_driver->init_termios.c_ispeed = 9600;
 | 
						|
	sx_driver->init_termios.c_ospeed = 9600;
 | 
						|
	sx_driver->flags = TTY_DRIVER_REAL_RAW;
 | 
						|
	tty_set_operations(sx_driver, &sx_ops);
 | 
						|
 | 
						|
	if ((error = tty_register_driver(sx_driver))) {
 | 
						|
		put_tty_driver(sx_driver);
 | 
						|
		printk(KERN_ERR "sx: Couldn't register sx driver, error = %d\n",
 | 
						|
			error);
 | 
						|
		return 1;
 | 
						|
	}
 | 
						|
	func_exit();
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
static int sx_init_portstructs(int nboards, int nports)
 | 
						|
{
 | 
						|
	struct sx_board *board;
 | 
						|
	struct sx_port *port;
 | 
						|
	int i, j;
 | 
						|
	int addr, chans;
 | 
						|
	int portno;
 | 
						|
 | 
						|
	func_enter();
 | 
						|
 | 
						|
	/* Many drivers statically allocate the maximum number of ports
 | 
						|
	   There is no reason not to allocate them dynamically.
 | 
						|
	   Is there? -- REW */
 | 
						|
	sx_ports = kcalloc(nports, sizeof(struct sx_port), GFP_KERNEL);
 | 
						|
	if (!sx_ports)
 | 
						|
		return -ENOMEM;
 | 
						|
 | 
						|
	port = sx_ports;
 | 
						|
	for (i = 0; i < nboards; i++) {
 | 
						|
		board = &boards[i];
 | 
						|
		board->ports = port;
 | 
						|
		for (j = 0; j < boards[i].nports; j++) {
 | 
						|
			sx_dprintk(SX_DEBUG_INIT, "initing port %d\n", j);
 | 
						|
			tty_port_init(&port->gs.port);
 | 
						|
			port->gs.port.ops = &sx_port_ops;
 | 
						|
			port->gs.magic = SX_MAGIC;
 | 
						|
			port->gs.close_delay = HZ / 2;
 | 
						|
			port->gs.closing_wait = 30 * HZ;
 | 
						|
			port->board = board;
 | 
						|
			port->gs.rd = &sx_real_driver;
 | 
						|
#ifdef NEW_WRITE_LOCKING
 | 
						|
			port->gs.port_write_mutex = MUTEX;
 | 
						|
#endif
 | 
						|
			spin_lock_init(&port->gs.driver_lock);
 | 
						|
			/*
 | 
						|
			 * Initializing wait queue
 | 
						|
			 */
 | 
						|
			port++;
 | 
						|
		}
 | 
						|
	}
 | 
						|
 | 
						|
	port = sx_ports;
 | 
						|
	portno = 0;
 | 
						|
	for (i = 0; i < nboards; i++) {
 | 
						|
		board = &boards[i];
 | 
						|
		board->port_base = portno;
 | 
						|
		/* Possibly the configuration was rejected. */
 | 
						|
		sx_dprintk(SX_DEBUG_PROBE, "Board has %d channels\n",
 | 
						|
				board->nports);
 | 
						|
		if (board->nports <= 0)
 | 
						|
			continue;
 | 
						|
		/* XXX byteorder ?? */
 | 
						|
		for (addr = 0x80; addr != 0;
 | 
						|
				addr = read_sx_word(board, addr) & 0x7fff) {
 | 
						|
			chans = sx_read_module_byte(board, addr, mc_type);
 | 
						|
			sx_dprintk(SX_DEBUG_PROBE, "Module at %x: %d "
 | 
						|
					"channels\n", addr, chans);
 | 
						|
			sx_dprintk(SX_DEBUG_PROBE, "Port at");
 | 
						|
			for (j = 0; j < chans; j++) {
 | 
						|
				/* The "sx-way" is the way it SHOULD be done.
 | 
						|
				   That way in the future, the firmware may for
 | 
						|
				   example pack the structures a bit more
 | 
						|
				   efficient. Neil tells me it isn't going to
 | 
						|
				   happen anytime soon though. */
 | 
						|
				if (IS_SX_BOARD(board))
 | 
						|
					port->ch_base = sx_read_module_word(
 | 
						|
							board, addr + j * 2,
 | 
						|
							mc_chan_pointer);
 | 
						|
				else
 | 
						|
					port->ch_base = addr + 0x100 + 0x300 *j;
 | 
						|
 | 
						|
				sx_dprintk(SX_DEBUG_PROBE, " %x",
 | 
						|
						port->ch_base);
 | 
						|
				port->line = portno++;
 | 
						|
				port++;
 | 
						|
			}
 | 
						|
			sx_dprintk(SX_DEBUG_PROBE, "\n");
 | 
						|
		}
 | 
						|
		/* This has to be done earlier. */
 | 
						|
		/* board->flags |= SX_BOARD_INITIALIZED; */
 | 
						|
	}
 | 
						|
 | 
						|
	func_exit();
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
static unsigned int sx_find_free_board(void)
 | 
						|
{
 | 
						|
	unsigned int i;
 | 
						|
 | 
						|
	for (i = 0; i < SX_NBOARDS; i++)
 | 
						|
		if (!(boards[i].flags & SX_BOARD_PRESENT))
 | 
						|
			break;
 | 
						|
 | 
						|
	return i;
 | 
						|
}
 | 
						|
 | 
						|
static void __exit sx_release_drivers(void)
 | 
						|
{
 | 
						|
	func_enter();
 | 
						|
	tty_unregister_driver(sx_driver);
 | 
						|
	put_tty_driver(sx_driver);
 | 
						|
	func_exit();
 | 
						|
}
 | 
						|
 | 
						|
static void __devexit sx_remove_card(struct sx_board *board,
 | 
						|
		struct pci_dev *pdev)
 | 
						|
{
 | 
						|
	if (board->flags & SX_BOARD_INITIALIZED) {
 | 
						|
		/* The board should stop messing with us. (actually I mean the
 | 
						|
		   interrupt) */
 | 
						|
		sx_reset(board);
 | 
						|
		if ((board->irq) && (board->flags & SX_IRQ_ALLOCATED))
 | 
						|
			free_irq(board->irq, board);
 | 
						|
 | 
						|
		/* It is safe/allowed to del_timer a non-active timer */
 | 
						|
		del_timer(&board->timer);
 | 
						|
		if (pdev) {
 | 
						|
#ifdef CONFIG_PCI
 | 
						|
			iounmap(board->base2);
 | 
						|
			pci_release_region(pdev, IS_CF_BOARD(board) ? 3 : 2);
 | 
						|
#endif
 | 
						|
		} else {
 | 
						|
			iounmap(board->base);
 | 
						|
			release_region(board->hw_base, board->hw_len);
 | 
						|
		}
 | 
						|
 | 
						|
		board->flags &= ~(SX_BOARD_INITIALIZED | SX_BOARD_PRESENT);
 | 
						|
	}
 | 
						|
}
 | 
						|
 | 
						|
#ifdef CONFIG_EISA
 | 
						|
 | 
						|
static int __devinit sx_eisa_probe(struct device *dev)
 | 
						|
{
 | 
						|
	struct eisa_device *edev = to_eisa_device(dev);
 | 
						|
	struct sx_board *board;
 | 
						|
	unsigned long eisa_slot = edev->base_addr;
 | 
						|
	unsigned int i;
 | 
						|
	int retval = -EIO;
 | 
						|
 | 
						|
	mutex_lock(&sx_boards_lock);
 | 
						|
	i = sx_find_free_board();
 | 
						|
	if (i == SX_NBOARDS) {
 | 
						|
		mutex_unlock(&sx_boards_lock);
 | 
						|
		goto err;
 | 
						|
	}
 | 
						|
	board = &boards[i];
 | 
						|
	board->flags |= SX_BOARD_PRESENT;
 | 
						|
	mutex_unlock(&sx_boards_lock);
 | 
						|
 | 
						|
	dev_info(dev, "XIO : Signature found in EISA slot %lu, "
 | 
						|
		 "Product %d Rev %d (REPORT THIS TO LKLM)\n",
 | 
						|
		 eisa_slot >> 12,
 | 
						|
		 inb(eisa_slot + EISA_VENDOR_ID_OFFSET + 2),
 | 
						|
		 inb(eisa_slot + EISA_VENDOR_ID_OFFSET + 3));
 | 
						|
 | 
						|
	board->eisa_base = eisa_slot;
 | 
						|
	board->flags &= ~SX_BOARD_TYPE;
 | 
						|
	board->flags |= SI_EISA_BOARD;
 | 
						|
 | 
						|
	board->hw_base = ((inb(eisa_slot + 0xc01) << 8) +
 | 
						|
			  inb(eisa_slot + 0xc00)) << 16;
 | 
						|
	board->hw_len = SI2_EISA_WINDOW_LEN;
 | 
						|
	if (!request_region(board->hw_base, board->hw_len, "sx")) {
 | 
						|
		dev_err(dev, "can't request region\n");
 | 
						|
		goto err_flag;
 | 
						|
	}
 | 
						|
	board->base2 =
 | 
						|
	board->base = ioremap_nocache(board->hw_base, SI2_EISA_WINDOW_LEN);
 | 
						|
	if (!board->base) {
 | 
						|
		dev_err(dev, "can't remap memory\n");
 | 
						|
		goto err_reg;
 | 
						|
	}
 | 
						|
 | 
						|
	sx_dprintk(SX_DEBUG_PROBE, "IO hw_base address: %lx\n", board->hw_base);
 | 
						|
	sx_dprintk(SX_DEBUG_PROBE, "base: %p\n", board->base);
 | 
						|
	board->irq = inb(eisa_slot + 0xc02) >> 4;
 | 
						|
	sx_dprintk(SX_DEBUG_PROBE, "IRQ: %d\n", board->irq);
 | 
						|
 | 
						|
	if (!probe_si(board))
 | 
						|
		goto err_unmap;
 | 
						|
 | 
						|
	dev_set_drvdata(dev, board);
 | 
						|
 | 
						|
	return 0;
 | 
						|
err_unmap:
 | 
						|
	iounmap(board->base);
 | 
						|
err_reg:
 | 
						|
	release_region(board->hw_base, board->hw_len);
 | 
						|
err_flag:
 | 
						|
	board->flags &= ~SX_BOARD_PRESENT;
 | 
						|
err:
 | 
						|
	return retval;
 | 
						|
}
 | 
						|
 | 
						|
static int __devexit sx_eisa_remove(struct device *dev)
 | 
						|
{
 | 
						|
	struct sx_board *board = dev_get_drvdata(dev);
 | 
						|
 | 
						|
	sx_remove_card(board, NULL);
 | 
						|
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
static struct eisa_device_id sx_eisa_tbl[] = {
 | 
						|
	{ "SLX" },
 | 
						|
	{ "" }
 | 
						|
};
 | 
						|
 | 
						|
MODULE_DEVICE_TABLE(eisa, sx_eisa_tbl);
 | 
						|
 | 
						|
static struct eisa_driver sx_eisadriver = {
 | 
						|
	.id_table = sx_eisa_tbl,
 | 
						|
	.driver = {
 | 
						|
		.name = "sx",
 | 
						|
		.probe = sx_eisa_probe,
 | 
						|
		.remove = __devexit_p(sx_eisa_remove),
 | 
						|
	}
 | 
						|
};
 | 
						|
 | 
						|
#endif
 | 
						|
 | 
						|
#ifdef CONFIG_PCI
 | 
						|
 /******************************************************** 
 | 
						|
 * Setting bit 17 in the CNTRL register of the PLX 9050  * 
 | 
						|
 * chip forces a retry on writes while a read is pending.*
 | 
						|
 * This is to prevent the card locking up on Intel Xeon  *
 | 
						|
 * multiprocessor systems with the NX chipset.    -- NV  *
 | 
						|
 ********************************************************/
 | 
						|
 | 
						|
/* Newer cards are produced with this bit set from the configuration
 | 
						|
   EEprom.  As the bit is read/write for the CPU, we can fix it here,
 | 
						|
   if we detect that it isn't set correctly. -- REW */
 | 
						|
 | 
						|
static void __devinit fix_sx_pci(struct pci_dev *pdev, struct sx_board *board)
 | 
						|
{
 | 
						|
	unsigned int hwbase;
 | 
						|
	void __iomem *rebase;
 | 
						|
	unsigned int t;
 | 
						|
 | 
						|
#define CNTRL_REG_OFFSET	0x50
 | 
						|
#define CNTRL_REG_GOODVALUE	0x18260000
 | 
						|
 | 
						|
	pci_read_config_dword(pdev, PCI_BASE_ADDRESS_0, &hwbase);
 | 
						|
	hwbase &= PCI_BASE_ADDRESS_MEM_MASK;
 | 
						|
	rebase = ioremap_nocache(hwbase, 0x80);
 | 
						|
	t = readl(rebase + CNTRL_REG_OFFSET);
 | 
						|
	if (t != CNTRL_REG_GOODVALUE) {
 | 
						|
		printk(KERN_DEBUG "sx: performing cntrl reg fix: %08x -> "
 | 
						|
			"%08x\n", t, CNTRL_REG_GOODVALUE);
 | 
						|
		writel(CNTRL_REG_GOODVALUE, rebase + CNTRL_REG_OFFSET);
 | 
						|
	}
 | 
						|
	iounmap(rebase);
 | 
						|
}
 | 
						|
#endif
 | 
						|
 | 
						|
static int __devinit sx_pci_probe(struct pci_dev *pdev,
 | 
						|
				  const struct pci_device_id *ent)
 | 
						|
{
 | 
						|
#ifdef CONFIG_PCI
 | 
						|
	struct sx_board *board;
 | 
						|
	unsigned int i, reg;
 | 
						|
	int retval = -EIO;
 | 
						|
 | 
						|
	mutex_lock(&sx_boards_lock);
 | 
						|
	i = sx_find_free_board();
 | 
						|
	if (i == SX_NBOARDS) {
 | 
						|
		mutex_unlock(&sx_boards_lock);
 | 
						|
		goto err;
 | 
						|
	}
 | 
						|
	board = &boards[i];
 | 
						|
	board->flags |= SX_BOARD_PRESENT;
 | 
						|
	mutex_unlock(&sx_boards_lock);
 | 
						|
 | 
						|
	retval = pci_enable_device(pdev);
 | 
						|
	if (retval)
 | 
						|
		goto err_flag;
 | 
						|
 | 
						|
	board->flags &= ~SX_BOARD_TYPE;
 | 
						|
	board->flags |= (pdev->subsystem_vendor == 0x200) ? SX_PCI_BOARD :
 | 
						|
		SX_CFPCI_BOARD;
 | 
						|
 | 
						|
	/* CF boards use base address 3.... */
 | 
						|
	reg = IS_CF_BOARD(board) ? 3 : 2;
 | 
						|
	retval = pci_request_region(pdev, reg, "sx");
 | 
						|
	if (retval) {
 | 
						|
		dev_err(&pdev->dev, "can't request region\n");
 | 
						|
		goto err_flag;
 | 
						|
	}
 | 
						|
	board->hw_base = pci_resource_start(pdev, reg);
 | 
						|
	board->base2 =
 | 
						|
	board->base = ioremap_nocache(board->hw_base, WINDOW_LEN(board));
 | 
						|
	if (!board->base) {
 | 
						|
		dev_err(&pdev->dev, "ioremap failed\n");
 | 
						|
		goto err_reg;
 | 
						|
	}
 | 
						|
 | 
						|
	/* Most of the stuff on the CF board is offset by 0x18000 ....  */
 | 
						|
	if (IS_CF_BOARD(board))
 | 
						|
		board->base += 0x18000;
 | 
						|
 | 
						|
	board->irq = pdev->irq;
 | 
						|
 | 
						|
	dev_info(&pdev->dev, "Got a specialix card: %p(%d) %x.\n", board->base,
 | 
						|
		 board->irq, board->flags);
 | 
						|
 | 
						|
	if (!probe_sx(board)) {
 | 
						|
		retval = -EIO;
 | 
						|
		goto err_unmap;
 | 
						|
	}
 | 
						|
 | 
						|
	fix_sx_pci(pdev, board);
 | 
						|
 | 
						|
	pci_set_drvdata(pdev, board);
 | 
						|
 | 
						|
	return 0;
 | 
						|
err_unmap:
 | 
						|
	iounmap(board->base2);
 | 
						|
err_reg:
 | 
						|
	pci_release_region(pdev, reg);
 | 
						|
err_flag:
 | 
						|
	board->flags &= ~SX_BOARD_PRESENT;
 | 
						|
err:
 | 
						|
	return retval;
 | 
						|
#else
 | 
						|
	return -ENODEV;
 | 
						|
#endif
 | 
						|
}
 | 
						|
 | 
						|
static void __devexit sx_pci_remove(struct pci_dev *pdev)
 | 
						|
{
 | 
						|
	struct sx_board *board = pci_get_drvdata(pdev);
 | 
						|
 | 
						|
	sx_remove_card(board, pdev);
 | 
						|
}
 | 
						|
 | 
						|
/* Specialix has a whole bunch of cards with 0x2000 as the device ID. They say
 | 
						|
   its because the standard requires it. So check for SUBVENDOR_ID. */
 | 
						|
static struct pci_device_id sx_pci_tbl[] = {
 | 
						|
	{ PCI_VENDOR_ID_SPECIALIX, PCI_DEVICE_ID_SPECIALIX_SX_XIO_IO8,
 | 
						|
		.subvendor = PCI_ANY_ID, .subdevice = 0x0200 },
 | 
						|
	{ PCI_VENDOR_ID_SPECIALIX, PCI_DEVICE_ID_SPECIALIX_SX_XIO_IO8,
 | 
						|
		.subvendor = PCI_ANY_ID, .subdevice = 0x0300 },
 | 
						|
	{ 0 }
 | 
						|
};
 | 
						|
 | 
						|
MODULE_DEVICE_TABLE(pci, sx_pci_tbl);
 | 
						|
 | 
						|
static struct pci_driver sx_pcidriver = {
 | 
						|
	.name = "sx",
 | 
						|
	.id_table = sx_pci_tbl,
 | 
						|
	.probe = sx_pci_probe,
 | 
						|
	.remove = __devexit_p(sx_pci_remove)
 | 
						|
};
 | 
						|
 | 
						|
static int __init sx_init(void)
 | 
						|
{
 | 
						|
#ifdef CONFIG_EISA
 | 
						|
	int retval1;
 | 
						|
#endif
 | 
						|
#ifdef CONFIG_ISA
 | 
						|
	struct sx_board *board;
 | 
						|
	unsigned int i;
 | 
						|
#endif
 | 
						|
	unsigned int found = 0;
 | 
						|
	int retval;
 | 
						|
 | 
						|
	func_enter();
 | 
						|
	sx_dprintk(SX_DEBUG_INIT, "Initing sx module... (sx_debug=%d)\n",
 | 
						|
			sx_debug);
 | 
						|
	if (abs((long)(&sx_debug) - sx_debug) < 0x10000) {
 | 
						|
		printk(KERN_WARNING "sx: sx_debug is an address, instead of a "
 | 
						|
				"value. Assuming -1.\n(%p)\n", &sx_debug);
 | 
						|
		sx_debug = -1;
 | 
						|
	}
 | 
						|
 | 
						|
	if (misc_register(&sx_fw_device) < 0) {
 | 
						|
		printk(KERN_ERR "SX: Unable to register firmware loader "
 | 
						|
				"driver.\n");
 | 
						|
		return -EIO;
 | 
						|
	}
 | 
						|
#ifdef CONFIG_ISA
 | 
						|
	for (i = 0; i < NR_SX_ADDRS; i++) {
 | 
						|
		board = &boards[found];
 | 
						|
		board->hw_base = sx_probe_addrs[i];
 | 
						|
		board->hw_len = SX_WINDOW_LEN;
 | 
						|
		if (!request_region(board->hw_base, board->hw_len, "sx"))
 | 
						|
			continue;
 | 
						|
		board->base2 =
 | 
						|
		board->base = ioremap_nocache(board->hw_base, board->hw_len);
 | 
						|
		if (!board->base)
 | 
						|
			goto err_sx_reg;
 | 
						|
		board->flags &= ~SX_BOARD_TYPE;
 | 
						|
		board->flags |= SX_ISA_BOARD;
 | 
						|
		board->irq = sx_irqmask ? -1 : 0;
 | 
						|
 | 
						|
		if (probe_sx(board)) {
 | 
						|
			board->flags |= SX_BOARD_PRESENT;
 | 
						|
			found++;
 | 
						|
		} else {
 | 
						|
			iounmap(board->base);
 | 
						|
err_sx_reg:
 | 
						|
			release_region(board->hw_base, board->hw_len);
 | 
						|
		}
 | 
						|
	}
 | 
						|
 | 
						|
	for (i = 0; i < NR_SI_ADDRS; i++) {
 | 
						|
		board = &boards[found];
 | 
						|
		board->hw_base = si_probe_addrs[i];
 | 
						|
		board->hw_len = SI2_ISA_WINDOW_LEN;
 | 
						|
		if (!request_region(board->hw_base, board->hw_len, "sx"))
 | 
						|
			continue;
 | 
						|
		board->base2 =
 | 
						|
		board->base = ioremap_nocache(board->hw_base, board->hw_len);
 | 
						|
		if (!board->base)
 | 
						|
			goto err_si_reg;
 | 
						|
		board->flags &= ~SX_BOARD_TYPE;
 | 
						|
		board->flags |= SI_ISA_BOARD;
 | 
						|
		board->irq = sx_irqmask ? -1 : 0;
 | 
						|
 | 
						|
		if (probe_si(board)) {
 | 
						|
			board->flags |= SX_BOARD_PRESENT;
 | 
						|
			found++;
 | 
						|
		} else {
 | 
						|
			iounmap(board->base);
 | 
						|
err_si_reg:
 | 
						|
			release_region(board->hw_base, board->hw_len);
 | 
						|
		}
 | 
						|
	}
 | 
						|
	for (i = 0; i < NR_SI1_ADDRS; i++) {
 | 
						|
		board = &boards[found];
 | 
						|
		board->hw_base = si1_probe_addrs[i];
 | 
						|
		board->hw_len = SI1_ISA_WINDOW_LEN;
 | 
						|
		if (!request_region(board->hw_base, board->hw_len, "sx"))
 | 
						|
			continue;
 | 
						|
		board->base2 =
 | 
						|
		board->base = ioremap_nocache(board->hw_base, board->hw_len);
 | 
						|
		if (!board->base)
 | 
						|
			goto err_si1_reg;
 | 
						|
		board->flags &= ~SX_BOARD_TYPE;
 | 
						|
		board->flags |= SI1_ISA_BOARD;
 | 
						|
		board->irq = sx_irqmask ? -1 : 0;
 | 
						|
 | 
						|
		if (probe_si(board)) {
 | 
						|
			board->flags |= SX_BOARD_PRESENT;
 | 
						|
			found++;
 | 
						|
		} else {
 | 
						|
			iounmap(board->base);
 | 
						|
err_si1_reg:
 | 
						|
			release_region(board->hw_base, board->hw_len);
 | 
						|
		}
 | 
						|
	}
 | 
						|
#endif
 | 
						|
#ifdef CONFIG_EISA
 | 
						|
	retval1 = eisa_driver_register(&sx_eisadriver);
 | 
						|
#endif
 | 
						|
	retval = pci_register_driver(&sx_pcidriver);
 | 
						|
 | 
						|
	if (found) {
 | 
						|
		printk(KERN_INFO "sx: total of %d boards detected.\n", found);
 | 
						|
		retval = 0;
 | 
						|
	} else if (retval) {
 | 
						|
#ifdef CONFIG_EISA
 | 
						|
		retval = retval1;
 | 
						|
		if (retval1)
 | 
						|
#endif
 | 
						|
			misc_deregister(&sx_fw_device);
 | 
						|
	}
 | 
						|
 | 
						|
	func_exit();
 | 
						|
	return retval;
 | 
						|
}
 | 
						|
 | 
						|
static void __exit sx_exit(void)
 | 
						|
{
 | 
						|
	int i;
 | 
						|
 | 
						|
	func_enter();
 | 
						|
#ifdef CONFIG_EISA
 | 
						|
	eisa_driver_unregister(&sx_eisadriver);
 | 
						|
#endif
 | 
						|
	pci_unregister_driver(&sx_pcidriver);
 | 
						|
 | 
						|
	for (i = 0; i < SX_NBOARDS; i++)
 | 
						|
		sx_remove_card(&boards[i], NULL);
 | 
						|
 | 
						|
	if (misc_deregister(&sx_fw_device) < 0) {
 | 
						|
		printk(KERN_INFO "sx: couldn't deregister firmware loader "
 | 
						|
				"device\n");
 | 
						|
	}
 | 
						|
	sx_dprintk(SX_DEBUG_CLEANUP, "Cleaning up drivers (%d)\n",
 | 
						|
			sx_initialized);
 | 
						|
	if (sx_initialized)
 | 
						|
		sx_release_drivers();
 | 
						|
 | 
						|
	kfree(sx_ports);
 | 
						|
	func_exit();
 | 
						|
}
 | 
						|
 | 
						|
module_init(sx_init);
 | 
						|
module_exit(sx_exit);
 |