cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

icom.c (51610B)


      1// SPDX-License-Identifier: GPL-2.0+
      2/*
      3  * icom.c
      4  *
      5  * Copyright (C) 2001 IBM Corporation. All rights reserved.
      6  *
      7  * Serial device driver.
      8  *
      9  * Based on code from serial.c
     10  */
     11#include <linux/module.h>
     12#include <linux/kernel.h>
     13#include <linux/errno.h>
     14#include <linux/signal.h>
     15#include <linux/timer.h>
     16#include <linux/interrupt.h>
     17#include <linux/tty.h>
     18#include <linux/termios.h>
     19#include <linux/fs.h>
     20#include <linux/tty_flip.h>
     21#include <linux/serial.h>
     22#include <linux/serial_core.h>
     23#include <linux/serial_reg.h>
     24#include <linux/major.h>
     25#include <linux/string.h>
     26#include <linux/fcntl.h>
     27#include <linux/ptrace.h>
     28#include <linux/ioport.h>
     29#include <linux/mm.h>
     30#include <linux/slab.h>
     31#include <linux/init.h>
     32#include <linux/delay.h>
     33#include <linux/pci.h>
     34#include <linux/vmalloc.h>
     35#include <linux/smp.h>
     36#include <linux/spinlock.h>
     37#include <linux/kref.h>
     38#include <linux/firmware.h>
     39#include <linux/bitops.h>
     40
     41#include <linux/io.h>
     42#include <asm/irq.h>
     43#include <linux/uaccess.h>
     44
     45/*#define ICOM_TRACE		 enable port trace capabilities */
     46
     47#define ICOM_DRIVER_NAME "icom"
     48#define NR_PORTS	       128
     49
     50static const unsigned int icom_acfg_baud[] = {
     51	300,
     52	600,
     53	900,
     54	1200,
     55	1800,
     56	2400,
     57	3600,
     58	4800,
     59	7200,
     60	9600,
     61	14400,
     62	19200,
     63	28800,
     64	38400,
     65	57600,
     66	76800,
     67	115200,
     68	153600,
     69	230400,
     70	307200,
     71	460800,
     72};
     73#define BAUD_TABLE_LIMIT	(ARRAY_SIZE(icom_acfg_baud) - 1)
     74
     75struct icom_regs {
     76	u32 control;		/* Adapter Control Register     */
     77	u32 interrupt;		/* Adapter Interrupt Register   */
     78	u32 int_mask;		/* Adapter Interrupt Mask Reg   */
     79	u32 int_pri;		/* Adapter Interrupt Priority r */
     80	u32 int_reg_b;		/* Adapter non-masked Interrupt */
     81	u32 resvd01;
     82	u32 resvd02;
     83	u32 resvd03;
     84	u32 control_2;		/* Adapter Control Register 2   */
     85	u32 interrupt_2;	/* Adapter Interrupt Register 2 */
     86	u32 int_mask_2;		/* Adapter Interrupt Mask 2     */
     87	u32 int_pri_2;		/* Adapter Interrupt Prior 2    */
     88	u32 int_reg_2b;		/* Adapter non-masked 2         */
     89};
     90
     91struct func_dram {
     92	u32 reserved[108];	/* 0-1B0   reserved by personality code */
     93	u32 RcvStatusAddr;	/* 1B0-1B3 Status Address for Next rcv */
     94	u8 RcvStnAddr;		/* 1B4     Receive Station Addr */
     95	u8 IdleState;		/* 1B5     Idle State */
     96	u8 IdleMonitor;		/* 1B6     Idle Monitor */
     97	u8 FlagFillIdleTimer;	/* 1B7     Flag Fill Idle Timer */
     98	u32 XmitStatusAddr;	/* 1B8-1BB Transmit Status Address */
     99	u8 StartXmitCmd;	/* 1BC     Start Xmit Command */
    100	u8 HDLCConfigReg;	/* 1BD     Reserved */
    101	u8 CauseCode;		/* 1BE     Cause code for fatal error */
    102	u8 xchar;		/* 1BF     High priority send */
    103	u32 reserved3;		/* 1C0-1C3 Reserved */
    104	u8 PrevCmdReg;		/* 1C4     Reserved */
    105	u8 CmdReg;		/* 1C5     Command Register */
    106	u8 async_config2;	/* 1C6     Async Config Byte 2 */
    107	u8 async_config3;	/* 1C7     Async Config Byte 3 */
    108	u8 dce_resvd[20];	/* 1C8-1DB DCE Rsvd           */
    109	u8 dce_resvd21;		/* 1DC     DCE Rsvd (21st byte */
    110	u8 misc_flags;		/* 1DD     misc flags         */
    111#define V2_HARDWARE     0x40
    112#define ICOM_HDW_ACTIVE 0x01
    113	u8 call_length;		/* 1DE     Phone #/CFI buff ln */
    114	u8 call_length2;	/* 1DF     Upper byte (unused) */
    115	u32 call_addr;		/* 1E0-1E3 Phn #/CFI buff addr */
    116	u16 timer_value;	/* 1E4-1E5 general timer value */
    117	u8 timer_command;	/* 1E6     general timer cmd  */
    118	u8 dce_command;		/* 1E7     dce command reg    */
    119	u8 dce_cmd_status;	/* 1E8     dce command stat   */
    120	u8 x21_r1_ioff;		/* 1E9     dce ready counter  */
    121	u8 x21_r0_ioff;		/* 1EA     dce not ready ctr  */
    122	u8 x21_ralt_ioff;	/* 1EB     dce CNR counter    */
    123	u8 x21_r1_ion;		/* 1EC     dce ready I on ctr */
    124	u8 rsvd_ier;		/* 1ED     Rsvd for IER (if ne */
    125	u8 ier;			/* 1EE     Interrupt Enable   */
    126	u8 isr;			/* 1EF     Input Signal Reg   */
    127	u8 osr;			/* 1F0     Output Signal Reg  */
    128	u8 reset;		/* 1F1     Reset/Reload Reg   */
    129	u8 disable;		/* 1F2     Disable Reg        */
    130	u8 sync;		/* 1F3     Sync Reg           */
    131	u8 error_stat;		/* 1F4     Error Status       */
    132	u8 cable_id;		/* 1F5     Cable ID           */
    133	u8 cs_length;		/* 1F6     CS Load Length     */
    134	u8 mac_length;		/* 1F7     Mac Load Length    */
    135	u32 cs_load_addr;	/* 1F8-1FB Call Load PCI Addr */
    136	u32 mac_load_addr;	/* 1FC-1FF Mac Load PCI Addr  */
    137};
    138
    139/*
    140 * adapter defines and structures
    141 */
    142#define ICOM_CONTROL_START_A         0x00000008
    143#define ICOM_CONTROL_STOP_A          0x00000004
    144#define ICOM_CONTROL_START_B         0x00000002
    145#define ICOM_CONTROL_STOP_B          0x00000001
    146#define ICOM_CONTROL_START_C         0x00000008
    147#define ICOM_CONTROL_STOP_C          0x00000004
    148#define ICOM_CONTROL_START_D         0x00000002
    149#define ICOM_CONTROL_STOP_D          0x00000001
    150#define ICOM_IRAM_OFFSET             0x1000
    151#define ICOM_IRAM_SIZE               0x0C00
    152#define ICOM_DCE_IRAM_OFFSET         0x0A00
    153#define ICOM_CABLE_ID_VALID          0x01
    154#define ICOM_CABLE_ID_MASK           0xF0
    155#define ICOM_DISABLE                 0x80
    156#define CMD_XMIT_RCV_ENABLE          0xC0
    157#define CMD_XMIT_ENABLE              0x40
    158#define CMD_RCV_DISABLE              0x00
    159#define CMD_RCV_ENABLE               0x80
    160#define CMD_RESTART                  0x01
    161#define CMD_HOLD_XMIT                0x02
    162#define CMD_SND_BREAK                0x04
    163#define RS232_CABLE                  0x06
    164#define V24_CABLE                    0x0E
    165#define V35_CABLE                    0x0C
    166#define V36_CABLE                    0x02
    167#define NO_CABLE                     0x00
    168#define START_DOWNLOAD               0x80
    169#define ICOM_INT_MASK_PRC_A          0x00003FFF
    170#define ICOM_INT_MASK_PRC_B          0x3FFF0000
    171#define ICOM_INT_MASK_PRC_C          0x00003FFF
    172#define ICOM_INT_MASK_PRC_D          0x3FFF0000
    173#define INT_RCV_COMPLETED            0x1000
    174#define INT_XMIT_COMPLETED           0x2000
    175#define INT_IDLE_DETECT              0x0800
    176#define INT_RCV_DISABLED             0x0400
    177#define INT_XMIT_DISABLED            0x0200
    178#define INT_RCV_XMIT_SHUTDOWN        0x0100
    179#define INT_FATAL_ERROR              0x0080
    180#define INT_CABLE_PULL               0x0020
    181#define INT_SIGNAL_CHANGE            0x0010
    182#define HDLC_PPP_PURE_ASYNC          0x02
    183#define HDLC_FF_FILL                 0x00
    184#define HDLC_HDW_FLOW                0x01
    185#define START_XMIT                   0x80
    186#define ICOM_ACFG_DRIVE1             0x20
    187#define ICOM_ACFG_NO_PARITY          0x00
    188#define ICOM_ACFG_PARITY_ENAB        0x02
    189#define ICOM_ACFG_PARITY_ODD         0x01
    190#define ICOM_ACFG_8BPC               0x00
    191#define ICOM_ACFG_7BPC               0x04
    192#define ICOM_ACFG_6BPC               0x08
    193#define ICOM_ACFG_5BPC               0x0C
    194#define ICOM_ACFG_1STOP_BIT          0x00
    195#define ICOM_ACFG_2STOP_BIT          0x10
    196#define ICOM_DTR                     0x80
    197#define ICOM_RTS                     0x40
    198#define ICOM_RI                      0x08
    199#define ICOM_DSR                     0x80
    200#define ICOM_DCD                     0x20
    201#define ICOM_CTS                     0x40
    202
    203#define NUM_XBUFFS 1
    204#define NUM_RBUFFS 2
    205#define RCV_BUFF_SZ 0x0200
    206#define XMIT_BUFF_SZ 0x1000
    207struct statusArea {
    208    /**********************************************/
    209	/* Transmit Status Area                       */
    210    /**********************************************/
    211	struct xmit_status_area{
    212		__le32 leNext;	/* Next entry in Little Endian on Adapter */
    213		__le32 leNextASD;
    214		__le32 leBuffer;	/* Buffer for entry in LE for Adapter */
    215		__le16 leLengthASD;
    216		__le16 leOffsetASD;
    217		__le16 leLength;	/* Length of data in segment */
    218		__le16 flags;
    219#define SA_FLAGS_DONE           0x0080	/* Done with Segment */
    220#define SA_FLAGS_CONTINUED      0x8000	/* More Segments */
    221#define SA_FLAGS_IDLE           0x4000	/* Mark IDLE after frm */
    222#define SA_FLAGS_READY_TO_XMIT  0x0800
    223#define SA_FLAGS_STAT_MASK      0x007F
    224	} xmit[NUM_XBUFFS];
    225
    226    /**********************************************/
    227	/* Receive Status Area                        */
    228    /**********************************************/
    229	struct {
    230		__le32 leNext;	/* Next entry in Little Endian on Adapter */
    231		__le32 leNextASD;
    232		__le32 leBuffer;	/* Buffer for entry in LE for Adapter */
    233		__le16 WorkingLength;	/* size of segment */
    234		__le16 reserv01;
    235		__le16 leLength;	/* Length of data in segment */
    236		__le16 flags;
    237#define SA_FL_RCV_DONE           0x0010	/* Data ready */
    238#define SA_FLAGS_OVERRUN         0x0040
    239#define SA_FLAGS_PARITY_ERROR    0x0080
    240#define SA_FLAGS_FRAME_ERROR     0x0001
    241#define SA_FLAGS_FRAME_TRUNC     0x0002
    242#define SA_FLAGS_BREAK_DET       0x0004	/* set conditionally by device driver, not hardware */
    243#define SA_FLAGS_RCV_MASK        0xFFE6
    244	} rcv[NUM_RBUFFS];
    245};
    246
    247struct icom_adapter;
    248
    249
    250#define ICOM_MAJOR       243
    251#define ICOM_MINOR_START 0
    252
    253struct icom_port {
    254	struct uart_port uart_port;
    255	unsigned char cable_id;
    256	unsigned char read_status_mask;
    257	unsigned char ignore_status_mask;
    258	void __iomem * int_reg;
    259	struct icom_regs __iomem *global_reg;
    260	struct func_dram __iomem *dram;
    261	int port;
    262	struct statusArea *statStg;
    263	dma_addr_t statStg_pci;
    264	__le32 *xmitRestart;
    265	dma_addr_t xmitRestart_pci;
    266	unsigned char *xmit_buf;
    267	dma_addr_t xmit_buf_pci;
    268	unsigned char *recv_buf;
    269	dma_addr_t recv_buf_pci;
    270	int next_rcv;
    271	int status;
    272#define ICOM_PORT_ACTIVE	1	/* Port exists. */
    273#define ICOM_PORT_OFF		0	/* Port does not exist. */
    274	struct icom_adapter *adapter;
    275};
    276
    277struct icom_adapter {
    278	void __iomem * base_addr;
    279	unsigned long base_addr_pci;
    280	struct pci_dev *pci_dev;
    281	struct icom_port port_info[4];
    282	int index;
    283	int version;
    284#define ADAPTER_V1	0x0001
    285#define ADAPTER_V2	0x0002
    286	u32 subsystem_id;
    287#define FOUR_PORT_MODEL				0x0252
    288#define V2_TWO_PORTS_RVX			0x021A
    289#define V2_ONE_PORT_RVX_ONE_PORT_IMBED_MDM	0x0251
    290	int numb_ports;
    291	struct list_head icom_adapter_entry;
    292	struct kref kref;
    293};
    294
    295/* prototype */
    296extern void iCom_sercons_init(void);
    297
    298struct lookup_proc_table {
    299	u32	__iomem *global_control_reg;
    300	unsigned long	processor_id;
    301};
    302
    303struct lookup_int_table {
    304	u32	__iomem *global_int_mask;
    305	unsigned long	processor_id;
    306};
    307
    308static inline struct icom_port *to_icom_port(struct uart_port *port)
    309{
    310	return container_of(port, struct icom_port, uart_port);
    311}
    312
    313static const struct pci_device_id icom_pci_table[] = {
    314	{
    315		.vendor = PCI_VENDOR_ID_IBM,
    316		.device = PCI_DEVICE_ID_IBM_ICOM_DEV_ID_1,
    317		.subvendor = PCI_ANY_ID,
    318		.subdevice = PCI_ANY_ID,
    319		.driver_data = ADAPTER_V1,
    320	},
    321	{
    322		.vendor = PCI_VENDOR_ID_IBM,
    323		.device = PCI_DEVICE_ID_IBM_ICOM_DEV_ID_2,
    324		.subvendor = PCI_VENDOR_ID_IBM,
    325		.subdevice = PCI_DEVICE_ID_IBM_ICOM_V2_TWO_PORTS_RVX,
    326		.driver_data = ADAPTER_V2,
    327	},
    328	{
    329		.vendor = PCI_VENDOR_ID_IBM,
    330		.device = PCI_DEVICE_ID_IBM_ICOM_DEV_ID_2,
    331		.subvendor = PCI_VENDOR_ID_IBM,
    332		.subdevice = PCI_DEVICE_ID_IBM_ICOM_V2_ONE_PORT_RVX_ONE_PORT_MDM,
    333		.driver_data = ADAPTER_V2,
    334	},
    335	{
    336		.vendor = PCI_VENDOR_ID_IBM,
    337		.device = PCI_DEVICE_ID_IBM_ICOM_DEV_ID_2,
    338		.subvendor = PCI_VENDOR_ID_IBM,
    339		.subdevice = PCI_DEVICE_ID_IBM_ICOM_FOUR_PORT_MODEL,
    340		.driver_data = ADAPTER_V2,
    341	},
    342	{
    343		.vendor = PCI_VENDOR_ID_IBM,
    344		.device = PCI_DEVICE_ID_IBM_ICOM_DEV_ID_2,
    345		.subvendor = PCI_VENDOR_ID_IBM,
    346		.subdevice = PCI_DEVICE_ID_IBM_ICOM_V2_ONE_PORT_RVX_ONE_PORT_MDM_PCIE,
    347		.driver_data = ADAPTER_V2,
    348	},
    349	{}
    350};
    351
    352static struct lookup_proc_table start_proc[4] = {
    353	{NULL, ICOM_CONTROL_START_A},
    354	{NULL, ICOM_CONTROL_START_B},
    355	{NULL, ICOM_CONTROL_START_C},
    356	{NULL, ICOM_CONTROL_START_D}
    357};
    358
    359
    360static struct lookup_proc_table stop_proc[4] = {
    361	{NULL, ICOM_CONTROL_STOP_A},
    362	{NULL, ICOM_CONTROL_STOP_B},
    363	{NULL, ICOM_CONTROL_STOP_C},
    364	{NULL, ICOM_CONTROL_STOP_D}
    365};
    366
    367static struct lookup_int_table int_mask_tbl[4] = {
    368	{NULL, ICOM_INT_MASK_PRC_A},
    369	{NULL, ICOM_INT_MASK_PRC_B},
    370	{NULL, ICOM_INT_MASK_PRC_C},
    371	{NULL, ICOM_INT_MASK_PRC_D},
    372};
    373
    374
    375MODULE_DEVICE_TABLE(pci, icom_pci_table);
    376
    377static LIST_HEAD(icom_adapter_head);
    378
    379/* spinlock for adapter initialization and changing adapter operations */
    380static DEFINE_SPINLOCK(icom_lock);
    381
    382#ifdef ICOM_TRACE
    383static inline void trace(struct icom_port *icom_port, char *trace_pt,
    384			unsigned long trace_data)
    385{
    386	dev_info(&icom_port->adapter->pci_dev->dev, ":%d:%s - %lx\n",
    387	icom_port->port, trace_pt, trace_data);
    388}
    389#else
    390static inline void trace(struct icom_port *icom_port, char *trace_pt, unsigned long trace_data) {};
    391#endif
    392static void icom_kref_release(struct kref *kref);
    393
    394static void free_port_memory(struct icom_port *icom_port)
    395{
    396	struct pci_dev *dev = icom_port->adapter->pci_dev;
    397
    398	trace(icom_port, "RET_PORT_MEM", 0);
    399	if (icom_port->recv_buf) {
    400		dma_free_coherent(&dev->dev, 4096, icom_port->recv_buf,
    401				  icom_port->recv_buf_pci);
    402		icom_port->recv_buf = NULL;
    403	}
    404	if (icom_port->xmit_buf) {
    405		dma_free_coherent(&dev->dev, 4096, icom_port->xmit_buf,
    406				  icom_port->xmit_buf_pci);
    407		icom_port->xmit_buf = NULL;
    408	}
    409	if (icom_port->statStg) {
    410		dma_free_coherent(&dev->dev, 4096, icom_port->statStg,
    411				  icom_port->statStg_pci);
    412		icom_port->statStg = NULL;
    413	}
    414
    415	if (icom_port->xmitRestart) {
    416		dma_free_coherent(&dev->dev, 4096, icom_port->xmitRestart,
    417				  icom_port->xmitRestart_pci);
    418		icom_port->xmitRestart = NULL;
    419	}
    420}
    421
    422static int get_port_memory(struct icom_port *icom_port)
    423{
    424	int index;
    425	unsigned long stgAddr;
    426	unsigned long startStgAddr;
    427	unsigned long offset;
    428	struct pci_dev *dev = icom_port->adapter->pci_dev;
    429
    430	icom_port->xmit_buf =
    431	    dma_alloc_coherent(&dev->dev, 4096, &icom_port->xmit_buf_pci,
    432			       GFP_KERNEL);
    433	if (!icom_port->xmit_buf) {
    434		dev_err(&dev->dev, "Can not allocate Transmit buffer\n");
    435		return -ENOMEM;
    436	}
    437
    438	trace(icom_port, "GET_PORT_MEM",
    439	      (unsigned long) icom_port->xmit_buf);
    440
    441	icom_port->recv_buf =
    442	    dma_alloc_coherent(&dev->dev, 4096, &icom_port->recv_buf_pci,
    443			       GFP_KERNEL);
    444	if (!icom_port->recv_buf) {
    445		dev_err(&dev->dev, "Can not allocate Receive buffer\n");
    446		free_port_memory(icom_port);
    447		return -ENOMEM;
    448	}
    449	trace(icom_port, "GET_PORT_MEM",
    450	      (unsigned long) icom_port->recv_buf);
    451
    452	icom_port->statStg =
    453	    dma_alloc_coherent(&dev->dev, 4096, &icom_port->statStg_pci,
    454			       GFP_KERNEL);
    455	if (!icom_port->statStg) {
    456		dev_err(&dev->dev, "Can not allocate Status buffer\n");
    457		free_port_memory(icom_port);
    458		return -ENOMEM;
    459	}
    460	trace(icom_port, "GET_PORT_MEM",
    461	      (unsigned long) icom_port->statStg);
    462
    463	icom_port->xmitRestart =
    464	    dma_alloc_coherent(&dev->dev, 4096, &icom_port->xmitRestart_pci,
    465			       GFP_KERNEL);
    466	if (!icom_port->xmitRestart) {
    467		dev_err(&dev->dev,
    468			"Can not allocate xmit Restart buffer\n");
    469		free_port_memory(icom_port);
    470		return -ENOMEM;
    471	}
    472
    473	/* FODs: Frame Out Descriptor Queue, this is a FIFO queue that
    474           indicates that frames are to be transmitted
    475	*/
    476
    477	stgAddr = (unsigned long) icom_port->statStg;
    478	for (index = 0; index < NUM_XBUFFS; index++) {
    479		trace(icom_port, "FOD_ADDR", stgAddr);
    480		stgAddr = stgAddr + sizeof(icom_port->statStg->xmit[0]);
    481		if (index < (NUM_XBUFFS - 1)) {
    482			memset(&icom_port->statStg->xmit[index], 0, sizeof(struct xmit_status_area));
    483			icom_port->statStg->xmit[index].leLengthASD =
    484			    cpu_to_le16(XMIT_BUFF_SZ);
    485			trace(icom_port, "FOD_ADDR", stgAddr);
    486			trace(icom_port, "FOD_XBUFF",
    487			      (unsigned long) icom_port->xmit_buf);
    488			icom_port->statStg->xmit[index].leBuffer =
    489			    cpu_to_le32(icom_port->xmit_buf_pci);
    490		} else if (index == (NUM_XBUFFS - 1)) {
    491			memset(&icom_port->statStg->xmit[index], 0, sizeof(struct xmit_status_area));
    492			icom_port->statStg->xmit[index].leLengthASD =
    493			    cpu_to_le16(XMIT_BUFF_SZ);
    494			trace(icom_port, "FOD_XBUFF",
    495			      (unsigned long) icom_port->xmit_buf);
    496			icom_port->statStg->xmit[index].leBuffer =
    497			    cpu_to_le32(icom_port->xmit_buf_pci);
    498		} else {
    499			memset(&icom_port->statStg->xmit[index], 0, sizeof(struct xmit_status_area));
    500		}
    501	}
    502	/* FIDs */
    503	startStgAddr = stgAddr;
    504
    505	/* fill in every entry, even if no buffer */
    506	for (index = 0; index <  NUM_RBUFFS; index++) {
    507		trace(icom_port, "FID_ADDR", stgAddr);
    508		stgAddr = stgAddr + sizeof(icom_port->statStg->rcv[0]);
    509		icom_port->statStg->rcv[index].leLength = 0;
    510		icom_port->statStg->rcv[index].WorkingLength =
    511		    cpu_to_le16(RCV_BUFF_SZ);
    512		if (index < (NUM_RBUFFS - 1) ) {
    513			offset = stgAddr - (unsigned long) icom_port->statStg;
    514			icom_port->statStg->rcv[index].leNext =
    515			      cpu_to_le32(icom_port-> statStg_pci + offset);
    516			trace(icom_port, "FID_RBUFF",
    517			      (unsigned long) icom_port->recv_buf);
    518			icom_port->statStg->rcv[index].leBuffer =
    519			    cpu_to_le32(icom_port->recv_buf_pci);
    520		} else if (index == (NUM_RBUFFS -1) ) {
    521			offset = startStgAddr - (unsigned long) icom_port->statStg;
    522			icom_port->statStg->rcv[index].leNext =
    523			    cpu_to_le32(icom_port-> statStg_pci + offset);
    524			trace(icom_port, "FID_RBUFF",
    525			      (unsigned long) icom_port->recv_buf + 2048);
    526			icom_port->statStg->rcv[index].leBuffer =
    527			    cpu_to_le32(icom_port->recv_buf_pci + 2048);
    528		} else {
    529			icom_port->statStg->rcv[index].leNext = 0;
    530			icom_port->statStg->rcv[index].leBuffer = 0;
    531		}
    532	}
    533
    534	return 0;
    535}
    536
    537static void stop_processor(struct icom_port *icom_port)
    538{
    539	unsigned long temp;
    540	unsigned long flags;
    541	int port;
    542
    543	spin_lock_irqsave(&icom_lock, flags);
    544
    545	port = icom_port->port;
    546	if (port >= ARRAY_SIZE(stop_proc)) {
    547		dev_err(&icom_port->adapter->pci_dev->dev,
    548			"Invalid port assignment\n");
    549		goto unlock;
    550	}
    551
    552	if (port == 0 || port == 1)
    553		stop_proc[port].global_control_reg = &icom_port->global_reg->control;
    554	else
    555		stop_proc[port].global_control_reg = &icom_port->global_reg->control_2;
    556
    557	temp = readl(stop_proc[port].global_control_reg);
    558	temp = (temp & ~start_proc[port].processor_id) | stop_proc[port].processor_id;
    559	writel(temp, stop_proc[port].global_control_reg);
    560
    561	/* write flush */
    562	readl(stop_proc[port].global_control_reg);
    563
    564unlock:
    565	spin_unlock_irqrestore(&icom_lock, flags);
    566}
    567
    568static void start_processor(struct icom_port *icom_port)
    569{
    570	unsigned long temp;
    571	unsigned long flags;
    572	int port;
    573
    574	spin_lock_irqsave(&icom_lock, flags);
    575
    576	port = icom_port->port;
    577	if (port >= ARRAY_SIZE(start_proc)) {
    578		dev_err(&icom_port->adapter->pci_dev->dev,
    579			"Invalid port assignment\n");
    580		goto unlock;
    581	}
    582
    583	if (port == 0 || port == 1)
    584		start_proc[port].global_control_reg = &icom_port->global_reg->control;
    585	else
    586		start_proc[port].global_control_reg = &icom_port->global_reg->control_2;
    587
    588	temp = readl(start_proc[port].global_control_reg);
    589	temp = (temp & ~stop_proc[port].processor_id) | start_proc[port].processor_id;
    590	writel(temp, start_proc[port].global_control_reg);
    591
    592	/* write flush */
    593	readl(start_proc[port].global_control_reg);
    594
    595unlock:
    596	spin_unlock_irqrestore(&icom_lock, flags);
    597}
    598
    599static void load_code(struct icom_port *icom_port)
    600{
    601	const struct firmware *fw;
    602	char __iomem *iram_ptr;
    603	int index;
    604	int status = 0;
    605	void __iomem *dram_ptr = icom_port->dram;
    606	dma_addr_t temp_pci;
    607	unsigned char *new_page = NULL;
    608	unsigned char cable_id = NO_CABLE;
    609	struct pci_dev *dev = icom_port->adapter->pci_dev;
    610
    611	/* Clear out any pending interrupts */
    612	writew(0x3FFF, icom_port->int_reg);
    613
    614	trace(icom_port, "CLEAR_INTERRUPTS", 0);
    615
    616	/* Stop processor */
    617	stop_processor(icom_port);
    618
    619	/* Zero out DRAM */
    620	memset_io(dram_ptr, 0, 512);
    621
    622	/* Load Call Setup into Adapter */
    623	if (request_firmware(&fw, "icom_call_setup.bin", &dev->dev) < 0) {
    624		dev_err(&dev->dev,"Unable to load icom_call_setup.bin firmware image\n");
    625		status = -1;
    626		goto load_code_exit;
    627	}
    628
    629	if (fw->size > ICOM_DCE_IRAM_OFFSET) {
    630		dev_err(&dev->dev, "Invalid firmware image for icom_call_setup.bin found.\n");
    631		release_firmware(fw);
    632		status = -1;
    633		goto load_code_exit;
    634	}
    635
    636	iram_ptr = (char __iomem *)icom_port->dram + ICOM_IRAM_OFFSET;
    637	for (index = 0; index < fw->size; index++)
    638		writeb(fw->data[index], &iram_ptr[index]);
    639
    640	release_firmware(fw);
    641
    642	/* Load Resident DCE portion of Adapter */
    643	if (request_firmware(&fw, "icom_res_dce.bin", &dev->dev) < 0) {
    644		dev_err(&dev->dev,"Unable to load icom_res_dce.bin firmware image\n");
    645		status = -1;
    646		goto load_code_exit;
    647	}
    648
    649	if (fw->size > ICOM_IRAM_SIZE) {
    650		dev_err(&dev->dev, "Invalid firmware image for icom_res_dce.bin found.\n");
    651		release_firmware(fw);
    652		status = -1;
    653		goto load_code_exit;
    654	}
    655
    656	iram_ptr = (char __iomem *) icom_port->dram + ICOM_IRAM_OFFSET;
    657	for (index = ICOM_DCE_IRAM_OFFSET; index < fw->size; index++)
    658		writeb(fw->data[index], &iram_ptr[index]);
    659
    660	release_firmware(fw);
    661
    662	/* Set Hardware level */
    663	if (icom_port->adapter->version == ADAPTER_V2)
    664		writeb(V2_HARDWARE, &(icom_port->dram->misc_flags));
    665
    666	/* Start the processor in Adapter */
    667	start_processor(icom_port);
    668
    669	writeb((HDLC_PPP_PURE_ASYNC | HDLC_FF_FILL),
    670	       &(icom_port->dram->HDLCConfigReg));
    671	writeb(0x04, &(icom_port->dram->FlagFillIdleTimer));	/* 0.5 seconds */
    672	writeb(0x00, &(icom_port->dram->CmdReg));
    673	writeb(0x10, &(icom_port->dram->async_config3));
    674	writeb((ICOM_ACFG_DRIVE1 | ICOM_ACFG_NO_PARITY | ICOM_ACFG_8BPC |
    675		ICOM_ACFG_1STOP_BIT), &(icom_port->dram->async_config2));
    676
    677	/*Set up data in icom DRAM to indicate where personality
    678	 *code is located and its length.
    679	 */
    680	new_page = dma_alloc_coherent(&dev->dev, 4096, &temp_pci, GFP_KERNEL);
    681
    682	if (!new_page) {
    683		dev_err(&dev->dev, "Can not allocate DMA buffer\n");
    684		status = -1;
    685		goto load_code_exit;
    686	}
    687
    688	if (request_firmware(&fw, "icom_asc.bin", &dev->dev) < 0) {
    689		dev_err(&dev->dev,"Unable to load icom_asc.bin firmware image\n");
    690		status = -1;
    691		goto load_code_exit;
    692	}
    693
    694	if (fw->size > ICOM_DCE_IRAM_OFFSET) {
    695		dev_err(&dev->dev, "Invalid firmware image for icom_asc.bin found.\n");
    696		release_firmware(fw);
    697		status = -1;
    698		goto load_code_exit;
    699	}
    700
    701	for (index = 0; index < fw->size; index++)
    702		new_page[index] = fw->data[index];
    703
    704	writeb((char) ((fw->size + 16)/16), &icom_port->dram->mac_length);
    705	writel(temp_pci, &icom_port->dram->mac_load_addr);
    706
    707	release_firmware(fw);
    708
    709	/*Setting the syncReg to 0x80 causes adapter to start downloading
    710	   the personality code into adapter instruction RAM.
    711	   Once code is loaded, it will begin executing and, based on
    712	   information provided above, will start DMAing data from
    713	   shared memory to adapter DRAM.
    714	 */
    715	/* the wait loop below verifies this write operation has been done
    716	   and processed
    717	*/
    718	writeb(START_DOWNLOAD, &icom_port->dram->sync);
    719
    720	/* Wait max 1 Sec for data download and processor to start */
    721	for (index = 0; index < 10; index++) {
    722		msleep(100);
    723		if (readb(&icom_port->dram->misc_flags) & ICOM_HDW_ACTIVE)
    724			break;
    725	}
    726
    727	if (index == 10)
    728		status = -1;
    729
    730	/*
    731	 * check Cable ID
    732	 */
    733	cable_id = readb(&icom_port->dram->cable_id);
    734
    735	if (cable_id & ICOM_CABLE_ID_VALID) {
    736		/* Get cable ID into the lower 4 bits (standard form) */
    737		cable_id = (cable_id & ICOM_CABLE_ID_MASK) >> 4;
    738		icom_port->cable_id = cable_id;
    739	} else {
    740		dev_err(&dev->dev,"Invalid or no cable attached\n");
    741		icom_port->cable_id = NO_CABLE;
    742	}
    743
    744      load_code_exit:
    745
    746	if (status != 0) {
    747		/* Clear out any pending interrupts */
    748		writew(0x3FFF, icom_port->int_reg);
    749
    750		/* Turn off port */
    751		writeb(ICOM_DISABLE, &(icom_port->dram->disable));
    752
    753		/* Stop processor */
    754		stop_processor(icom_port);
    755
    756		dev_err(&icom_port->adapter->pci_dev->dev,"Port not operational\n");
    757	}
    758
    759	if (new_page != NULL)
    760		dma_free_coherent(&dev->dev, 4096, new_page, temp_pci);
    761}
    762
    763static int startup(struct icom_port *icom_port)
    764{
    765	unsigned long temp;
    766	unsigned char cable_id, raw_cable_id;
    767	unsigned long flags;
    768	int port;
    769
    770	trace(icom_port, "STARTUP", 0);
    771
    772	if (!icom_port->dram) {
    773		/* should NEVER be NULL */
    774		dev_err(&icom_port->adapter->pci_dev->dev,
    775			"Unusable Port, port configuration missing\n");
    776		return -ENODEV;
    777	}
    778
    779	/*
    780	 * check Cable ID
    781	 */
    782	raw_cable_id = readb(&icom_port->dram->cable_id);
    783	trace(icom_port, "CABLE_ID", raw_cable_id);
    784
    785	/* Get cable ID into the lower 4 bits (standard form) */
    786	cable_id = (raw_cable_id & ICOM_CABLE_ID_MASK) >> 4;
    787
    788	/* Check for valid Cable ID */
    789	if (!(raw_cable_id & ICOM_CABLE_ID_VALID) ||
    790	    (cable_id != icom_port->cable_id)) {
    791
    792		/* reload adapter code, pick up any potential changes in cable id */
    793		load_code(icom_port);
    794
    795		/* still no sign of cable, error out */
    796		raw_cable_id = readb(&icom_port->dram->cable_id);
    797		cable_id = (raw_cable_id & ICOM_CABLE_ID_MASK) >> 4;
    798		if (!(raw_cable_id & ICOM_CABLE_ID_VALID) ||
    799		    (icom_port->cable_id == NO_CABLE))
    800			return -EIO;
    801	}
    802
    803	/*
    804	 * Finally, clear and  enable interrupts
    805	 */
    806	spin_lock_irqsave(&icom_lock, flags);
    807	port = icom_port->port;
    808	if (port >= ARRAY_SIZE(int_mask_tbl)) {
    809		dev_err(&icom_port->adapter->pci_dev->dev,
    810			"Invalid port assignment\n");
    811		goto unlock;
    812	}
    813
    814	if (port == 0 || port == 1)
    815		int_mask_tbl[port].global_int_mask = &icom_port->global_reg->int_mask;
    816	else
    817		int_mask_tbl[port].global_int_mask = &icom_port->global_reg->int_mask_2;
    818
    819	if (port == 0 || port == 2)
    820		writew(0x00FF, icom_port->int_reg);
    821	else
    822		writew(0x3F00, icom_port->int_reg);
    823
    824	temp = readl(int_mask_tbl[port].global_int_mask);
    825	writel(temp & ~int_mask_tbl[port].processor_id, int_mask_tbl[port].global_int_mask);
    826
    827	/* write flush */
    828	readl(int_mask_tbl[port].global_int_mask);
    829
    830unlock:
    831	spin_unlock_irqrestore(&icom_lock, flags);
    832	return 0;
    833}
    834
    835static void shutdown(struct icom_port *icom_port)
    836{
    837	unsigned long temp;
    838	unsigned char cmdReg;
    839	unsigned long flags;
    840	int port;
    841
    842	spin_lock_irqsave(&icom_lock, flags);
    843	trace(icom_port, "SHUTDOWN", 0);
    844
    845	/*
    846	 * disable all interrupts
    847	 */
    848	port = icom_port->port;
    849	if (port >= ARRAY_SIZE(int_mask_tbl)) {
    850		dev_err(&icom_port->adapter->pci_dev->dev,
    851			"Invalid port assignment\n");
    852		goto unlock;
    853	}
    854	if (port == 0 || port == 1)
    855		int_mask_tbl[port].global_int_mask = &icom_port->global_reg->int_mask;
    856	else
    857		int_mask_tbl[port].global_int_mask = &icom_port->global_reg->int_mask_2;
    858
    859	temp = readl(int_mask_tbl[port].global_int_mask);
    860	writel(temp | int_mask_tbl[port].processor_id, int_mask_tbl[port].global_int_mask);
    861
    862	/* write flush */
    863	readl(int_mask_tbl[port].global_int_mask);
    864
    865unlock:
    866	spin_unlock_irqrestore(&icom_lock, flags);
    867
    868	/*
    869	 * disable break condition
    870	 */
    871	cmdReg = readb(&icom_port->dram->CmdReg);
    872	if (cmdReg & CMD_SND_BREAK) {
    873		writeb(cmdReg & ~CMD_SND_BREAK, &icom_port->dram->CmdReg);
    874	}
    875}
    876
    877static int icom_write(struct uart_port *port)
    878{
    879	struct icom_port *icom_port = to_icom_port(port);
    880	unsigned long data_count;
    881	unsigned char cmdReg;
    882	unsigned long offset;
    883	int temp_tail = port->state->xmit.tail;
    884
    885	trace(icom_port, "WRITE", 0);
    886
    887	if (le16_to_cpu(icom_port->statStg->xmit[0].flags) &
    888	    SA_FLAGS_READY_TO_XMIT) {
    889		trace(icom_port, "WRITE_FULL", 0);
    890		return 0;
    891	}
    892
    893	data_count = 0;
    894	while ((port->state->xmit.head != temp_tail) &&
    895	       (data_count <= XMIT_BUFF_SZ)) {
    896
    897		icom_port->xmit_buf[data_count++] =
    898		    port->state->xmit.buf[temp_tail];
    899
    900		temp_tail++;
    901		temp_tail &= (UART_XMIT_SIZE - 1);
    902	}
    903
    904	if (data_count) {
    905		icom_port->statStg->xmit[0].flags =
    906		    cpu_to_le16(SA_FLAGS_READY_TO_XMIT);
    907		icom_port->statStg->xmit[0].leLength =
    908		    cpu_to_le16(data_count);
    909		offset =
    910		    (unsigned long) &icom_port->statStg->xmit[0] -
    911		    (unsigned long) icom_port->statStg;
    912		*icom_port->xmitRestart =
    913		    cpu_to_le32(icom_port->statStg_pci + offset);
    914		cmdReg = readb(&icom_port->dram->CmdReg);
    915		writeb(cmdReg | CMD_XMIT_RCV_ENABLE,
    916		       &icom_port->dram->CmdReg);
    917		writeb(START_XMIT, &icom_port->dram->StartXmitCmd);
    918		trace(icom_port, "WRITE_START", data_count);
    919		/* write flush */
    920		readb(&icom_port->dram->StartXmitCmd);
    921	}
    922
    923	return data_count;
    924}
    925
    926static inline void check_modem_status(struct icom_port *icom_port)
    927{
    928	static char old_status = 0;
    929	char delta_status;
    930	unsigned char status;
    931
    932	spin_lock(&icom_port->uart_port.lock);
    933
    934	/*modem input register */
    935	status = readb(&icom_port->dram->isr);
    936	trace(icom_port, "CHECK_MODEM", status);
    937	delta_status = status ^ old_status;
    938	if (delta_status) {
    939		if (delta_status & ICOM_RI)
    940			icom_port->uart_port.icount.rng++;
    941		if (delta_status & ICOM_DSR)
    942			icom_port->uart_port.icount.dsr++;
    943		if (delta_status & ICOM_DCD)
    944			uart_handle_dcd_change(&icom_port->uart_port,
    945					       delta_status & ICOM_DCD);
    946		if (delta_status & ICOM_CTS)
    947			uart_handle_cts_change(&icom_port->uart_port,
    948					       delta_status & ICOM_CTS);
    949
    950		wake_up_interruptible(&icom_port->uart_port.state->
    951				      port.delta_msr_wait);
    952		old_status = status;
    953	}
    954	spin_unlock(&icom_port->uart_port.lock);
    955}
    956
    957static void xmit_interrupt(u16 port_int_reg, struct icom_port *icom_port)
    958{
    959	u16 count, i;
    960
    961	if (port_int_reg & (INT_XMIT_COMPLETED)) {
    962		trace(icom_port, "XMIT_COMPLETE", 0);
    963
    964		/* clear buffer in use bit */
    965		icom_port->statStg->xmit[0].flags &=
    966			cpu_to_le16(~SA_FLAGS_READY_TO_XMIT);
    967
    968		count = le16_to_cpu(icom_port->statStg->xmit[0].leLength);
    969		icom_port->uart_port.icount.tx += count;
    970
    971		for (i=0; i<count &&
    972			!uart_circ_empty(&icom_port->uart_port.state->xmit); i++) {
    973
    974			icom_port->uart_port.state->xmit.tail++;
    975			icom_port->uart_port.state->xmit.tail &=
    976				(UART_XMIT_SIZE - 1);
    977		}
    978
    979		if (!icom_write(&icom_port->uart_port))
    980			/* activate write queue */
    981			uart_write_wakeup(&icom_port->uart_port);
    982	} else
    983		trace(icom_port, "XMIT_DISABLED", 0);
    984}
    985
    986static void recv_interrupt(u16 port_int_reg, struct icom_port *icom_port)
    987{
    988	short int count, rcv_buff;
    989	struct tty_port *port = &icom_port->uart_port.state->port;
    990	u16 status;
    991	struct uart_icount *icount;
    992	unsigned long offset;
    993	unsigned char flag;
    994
    995	trace(icom_port, "RCV_COMPLETE", 0);
    996	rcv_buff = icom_port->next_rcv;
    997
    998	status = le16_to_cpu(icom_port->statStg->rcv[rcv_buff].flags);
    999	while (status & SA_FL_RCV_DONE) {
   1000		int first = -1;
   1001
   1002		trace(icom_port, "FID_STATUS", status);
   1003		count = le16_to_cpu(icom_port->statStg->rcv[rcv_buff].leLength);
   1004
   1005		trace(icom_port, "RCV_COUNT", count);
   1006
   1007		trace(icom_port, "REAL_COUNT", count);
   1008
   1009		offset = le32_to_cpu(icom_port->statStg->rcv[rcv_buff].leBuffer) -
   1010			icom_port->recv_buf_pci;
   1011
   1012		/* Block copy all but the last byte as this may have status */
   1013		if (count > 0) {
   1014			first = icom_port->recv_buf[offset];
   1015			tty_insert_flip_string(port, icom_port->recv_buf + offset, count - 1);
   1016		}
   1017
   1018		icount = &icom_port->uart_port.icount;
   1019		icount->rx += count;
   1020
   1021		/* Break detect logic */
   1022		if ((status & SA_FLAGS_FRAME_ERROR)
   1023		    && first == 0) {
   1024			status &= ~SA_FLAGS_FRAME_ERROR;
   1025			status |= SA_FLAGS_BREAK_DET;
   1026			trace(icom_port, "BREAK_DET", 0);
   1027		}
   1028
   1029		flag = TTY_NORMAL;
   1030
   1031		if (status &
   1032		    (SA_FLAGS_BREAK_DET | SA_FLAGS_PARITY_ERROR |
   1033		     SA_FLAGS_FRAME_ERROR | SA_FLAGS_OVERRUN)) {
   1034
   1035			if (status & SA_FLAGS_BREAK_DET)
   1036				icount->brk++;
   1037			if (status & SA_FLAGS_PARITY_ERROR)
   1038				icount->parity++;
   1039			if (status & SA_FLAGS_FRAME_ERROR)
   1040				icount->frame++;
   1041			if (status & SA_FLAGS_OVERRUN)
   1042				icount->overrun++;
   1043
   1044			/*
   1045			 * Now check to see if character should be
   1046			 * ignored, and mask off conditions which
   1047			 * should be ignored.
   1048			 */
   1049			if (status & icom_port->ignore_status_mask) {
   1050				trace(icom_port, "IGNORE_CHAR", 0);
   1051				goto ignore_char;
   1052			}
   1053
   1054			status &= icom_port->read_status_mask;
   1055
   1056			if (status & SA_FLAGS_BREAK_DET) {
   1057				flag = TTY_BREAK;
   1058			} else if (status & SA_FLAGS_PARITY_ERROR) {
   1059				trace(icom_port, "PARITY_ERROR", 0);
   1060				flag = TTY_PARITY;
   1061			} else if (status & SA_FLAGS_FRAME_ERROR)
   1062				flag = TTY_FRAME;
   1063
   1064		}
   1065
   1066		tty_insert_flip_char(port, *(icom_port->recv_buf + offset + count - 1), flag);
   1067
   1068		if (status & SA_FLAGS_OVERRUN)
   1069			/*
   1070			 * Overrun is special, since it's
   1071			 * reported immediately, and doesn't
   1072			 * affect the current character
   1073			 */
   1074			tty_insert_flip_char(port, 0, TTY_OVERRUN);
   1075ignore_char:
   1076		icom_port->statStg->rcv[rcv_buff].flags = 0;
   1077		icom_port->statStg->rcv[rcv_buff].leLength = 0;
   1078		icom_port->statStg->rcv[rcv_buff].WorkingLength =
   1079			cpu_to_le16(RCV_BUFF_SZ);
   1080
   1081		rcv_buff++;
   1082		if (rcv_buff == NUM_RBUFFS)
   1083			rcv_buff = 0;
   1084
   1085		status = le16_to_cpu(icom_port->statStg->rcv[rcv_buff].flags);
   1086	}
   1087	icom_port->next_rcv = rcv_buff;
   1088
   1089	tty_flip_buffer_push(port);
   1090}
   1091
   1092static void process_interrupt(u16 port_int_reg,
   1093			      struct icom_port *icom_port)
   1094{
   1095
   1096	spin_lock(&icom_port->uart_port.lock);
   1097	trace(icom_port, "INTERRUPT", port_int_reg);
   1098
   1099	if (port_int_reg & (INT_XMIT_COMPLETED | INT_XMIT_DISABLED))
   1100		xmit_interrupt(port_int_reg, icom_port);
   1101
   1102	if (port_int_reg & INT_RCV_COMPLETED)
   1103		recv_interrupt(port_int_reg, icom_port);
   1104
   1105	spin_unlock(&icom_port->uart_port.lock);
   1106}
   1107
   1108static irqreturn_t icom_interrupt(int irq, void *dev_id)
   1109{
   1110	void __iomem * int_reg;
   1111	u32 adapter_interrupts;
   1112	u16 port_int_reg;
   1113	struct icom_adapter *icom_adapter;
   1114	struct icom_port *icom_port;
   1115
   1116	/* find icom_port for this interrupt */
   1117	icom_adapter = (struct icom_adapter *) dev_id;
   1118
   1119	if (icom_adapter->version == ADAPTER_V2) {
   1120		int_reg = icom_adapter->base_addr + 0x8024;
   1121
   1122		adapter_interrupts = readl(int_reg);
   1123
   1124		if (adapter_interrupts & 0x00003FFF) {
   1125			/* port 2 interrupt,  NOTE:  for all ADAPTER_V2, port 2 will be active */
   1126			icom_port = &icom_adapter->port_info[2];
   1127			port_int_reg = (u16) adapter_interrupts;
   1128			process_interrupt(port_int_reg, icom_port);
   1129			check_modem_status(icom_port);
   1130		}
   1131		if (adapter_interrupts & 0x3FFF0000) {
   1132			/* port 3 interrupt */
   1133			icom_port = &icom_adapter->port_info[3];
   1134			if (icom_port->status == ICOM_PORT_ACTIVE) {
   1135				port_int_reg =
   1136				    (u16) (adapter_interrupts >> 16);
   1137				process_interrupt(port_int_reg, icom_port);
   1138				check_modem_status(icom_port);
   1139			}
   1140		}
   1141
   1142		/* Clear out any pending interrupts */
   1143		writel(adapter_interrupts, int_reg);
   1144
   1145		int_reg = icom_adapter->base_addr + 0x8004;
   1146	} else {
   1147		int_reg = icom_adapter->base_addr + 0x4004;
   1148	}
   1149
   1150	adapter_interrupts = readl(int_reg);
   1151
   1152	if (adapter_interrupts & 0x00003FFF) {
   1153		/* port 0 interrupt, NOTE:  for all adapters, port 0 will be active */
   1154		icom_port = &icom_adapter->port_info[0];
   1155		port_int_reg = (u16) adapter_interrupts;
   1156		process_interrupt(port_int_reg, icom_port);
   1157		check_modem_status(icom_port);
   1158	}
   1159	if (adapter_interrupts & 0x3FFF0000) {
   1160		/* port 1 interrupt */
   1161		icom_port = &icom_adapter->port_info[1];
   1162		if (icom_port->status == ICOM_PORT_ACTIVE) {
   1163			port_int_reg = (u16) (adapter_interrupts >> 16);
   1164			process_interrupt(port_int_reg, icom_port);
   1165			check_modem_status(icom_port);
   1166		}
   1167	}
   1168
   1169	/* Clear out any pending interrupts */
   1170	writel(adapter_interrupts, int_reg);
   1171
   1172	/* flush the write */
   1173	adapter_interrupts = readl(int_reg);
   1174
   1175	return IRQ_HANDLED;
   1176}
   1177
   1178/*
   1179 * ------------------------------------------------------------------
   1180 * Begin serial-core API
   1181 * ------------------------------------------------------------------
   1182 */
   1183static unsigned int icom_tx_empty(struct uart_port *port)
   1184{
   1185	struct icom_port *icom_port = to_icom_port(port);
   1186	int ret;
   1187	unsigned long flags;
   1188
   1189	spin_lock_irqsave(&port->lock, flags);
   1190	if (le16_to_cpu(icom_port->statStg->xmit[0].flags) &
   1191	    SA_FLAGS_READY_TO_XMIT)
   1192		ret = TIOCSER_TEMT;
   1193	else
   1194		ret = 0;
   1195
   1196	spin_unlock_irqrestore(&port->lock, flags);
   1197	return ret;
   1198}
   1199
   1200static void icom_set_mctrl(struct uart_port *port, unsigned int mctrl)
   1201{
   1202	struct icom_port *icom_port = to_icom_port(port);
   1203	unsigned char local_osr;
   1204
   1205	trace(icom_port, "SET_MODEM", 0);
   1206	local_osr = readb(&icom_port->dram->osr);
   1207
   1208	if (mctrl & TIOCM_RTS) {
   1209		trace(icom_port, "RAISE_RTS", 0);
   1210		local_osr |= ICOM_RTS;
   1211	} else {
   1212		trace(icom_port, "LOWER_RTS", 0);
   1213		local_osr &= ~ICOM_RTS;
   1214	}
   1215
   1216	if (mctrl & TIOCM_DTR) {
   1217		trace(icom_port, "RAISE_DTR", 0);
   1218		local_osr |= ICOM_DTR;
   1219	} else {
   1220		trace(icom_port, "LOWER_DTR", 0);
   1221		local_osr &= ~ICOM_DTR;
   1222	}
   1223
   1224	writeb(local_osr, &icom_port->dram->osr);
   1225}
   1226
   1227static unsigned int icom_get_mctrl(struct uart_port *port)
   1228{
   1229	struct icom_port *icom_port = to_icom_port(port);
   1230	unsigned char status;
   1231	unsigned int result;
   1232
   1233	trace(icom_port, "GET_MODEM", 0);
   1234
   1235	status = readb(&icom_port->dram->isr);
   1236
   1237	result = ((status & ICOM_DCD) ? TIOCM_CAR : 0)
   1238	    | ((status & ICOM_RI) ? TIOCM_RNG : 0)
   1239	    | ((status & ICOM_DSR) ? TIOCM_DSR : 0)
   1240	    | ((status & ICOM_CTS) ? TIOCM_CTS : 0);
   1241	return result;
   1242}
   1243
   1244static void icom_stop_tx(struct uart_port *port)
   1245{
   1246	struct icom_port *icom_port = to_icom_port(port);
   1247	unsigned char cmdReg;
   1248
   1249	trace(icom_port, "STOP", 0);
   1250	cmdReg = readb(&icom_port->dram->CmdReg);
   1251	writeb(cmdReg | CMD_HOLD_XMIT, &icom_port->dram->CmdReg);
   1252}
   1253
   1254static void icom_start_tx(struct uart_port *port)
   1255{
   1256	struct icom_port *icom_port = to_icom_port(port);
   1257	unsigned char cmdReg;
   1258
   1259	trace(icom_port, "START", 0);
   1260	cmdReg = readb(&icom_port->dram->CmdReg);
   1261	if ((cmdReg & CMD_HOLD_XMIT) == CMD_HOLD_XMIT)
   1262		writeb(cmdReg & ~CMD_HOLD_XMIT,
   1263		       &icom_port->dram->CmdReg);
   1264
   1265	icom_write(port);
   1266}
   1267
   1268static void icom_send_xchar(struct uart_port *port, char ch)
   1269{
   1270	struct icom_port *icom_port = to_icom_port(port);
   1271	unsigned char xdata;
   1272	int index;
   1273	unsigned long flags;
   1274
   1275	trace(icom_port, "SEND_XCHAR", ch);
   1276
   1277	/* wait .1 sec to send char */
   1278	for (index = 0; index < 10; index++) {
   1279		spin_lock_irqsave(&port->lock, flags);
   1280		xdata = readb(&icom_port->dram->xchar);
   1281		if (xdata == 0x00) {
   1282			trace(icom_port, "QUICK_WRITE", 0);
   1283			writeb(ch, &icom_port->dram->xchar);
   1284
   1285			/* flush write operation */
   1286			xdata = readb(&icom_port->dram->xchar);
   1287			spin_unlock_irqrestore(&port->lock, flags);
   1288			break;
   1289		}
   1290		spin_unlock_irqrestore(&port->lock, flags);
   1291		msleep(10);
   1292	}
   1293}
   1294
   1295static void icom_stop_rx(struct uart_port *port)
   1296{
   1297	struct icom_port *icom_port = to_icom_port(port);
   1298	unsigned char cmdReg;
   1299
   1300	cmdReg = readb(&icom_port->dram->CmdReg);
   1301	writeb(cmdReg & ~CMD_RCV_ENABLE, &icom_port->dram->CmdReg);
   1302}
   1303
   1304static void icom_break(struct uart_port *port, int break_state)
   1305{
   1306	struct icom_port *icom_port = to_icom_port(port);
   1307	unsigned char cmdReg;
   1308	unsigned long flags;
   1309
   1310	spin_lock_irqsave(&port->lock, flags);
   1311	trace(icom_port, "BREAK", 0);
   1312	cmdReg = readb(&icom_port->dram->CmdReg);
   1313	if (break_state == -1) {
   1314		writeb(cmdReg | CMD_SND_BREAK, &icom_port->dram->CmdReg);
   1315	} else {
   1316		writeb(cmdReg & ~CMD_SND_BREAK, &icom_port->dram->CmdReg);
   1317	}
   1318	spin_unlock_irqrestore(&port->lock, flags);
   1319}
   1320
   1321static int icom_open(struct uart_port *port)
   1322{
   1323	struct icom_port *icom_port = to_icom_port(port);
   1324	int retval;
   1325
   1326	kref_get(&icom_port->adapter->kref);
   1327	retval = startup(icom_port);
   1328
   1329	if (retval) {
   1330		kref_put(&icom_port->adapter->kref, icom_kref_release);
   1331		trace(icom_port, "STARTUP_ERROR", 0);
   1332		return retval;
   1333	}
   1334
   1335	return 0;
   1336}
   1337
   1338static void icom_close(struct uart_port *port)
   1339{
   1340	struct icom_port *icom_port = to_icom_port(port);
   1341	unsigned char cmdReg;
   1342
   1343	trace(icom_port, "CLOSE", 0);
   1344
   1345	/* stop receiver */
   1346	cmdReg = readb(&icom_port->dram->CmdReg);
   1347	writeb(cmdReg & ~CMD_RCV_ENABLE, &icom_port->dram->CmdReg);
   1348
   1349	shutdown(icom_port);
   1350
   1351	kref_put(&icom_port->adapter->kref, icom_kref_release);
   1352}
   1353
   1354static void icom_set_termios(struct uart_port *port,
   1355			     struct ktermios *termios,
   1356			     struct ktermios *old_termios)
   1357{
   1358	struct icom_port *icom_port = to_icom_port(port);
   1359	int baud;
   1360	unsigned cflag, iflag;
   1361	char new_config2;
   1362	char new_config3 = 0;
   1363	char tmp_byte;
   1364	int index;
   1365	int rcv_buff, xmit_buff;
   1366	unsigned long offset;
   1367	unsigned long flags;
   1368
   1369	spin_lock_irqsave(&port->lock, flags);
   1370	trace(icom_port, "CHANGE_SPEED", 0);
   1371
   1372	cflag = termios->c_cflag;
   1373	iflag = termios->c_iflag;
   1374
   1375	new_config2 = ICOM_ACFG_DRIVE1;
   1376
   1377	/* byte size and parity */
   1378	switch (cflag & CSIZE) {
   1379	case CS5:		/* 5 bits/char */
   1380		new_config2 |= ICOM_ACFG_5BPC;
   1381		break;
   1382	case CS6:		/* 6 bits/char */
   1383		new_config2 |= ICOM_ACFG_6BPC;
   1384		break;
   1385	case CS7:		/* 7 bits/char */
   1386		new_config2 |= ICOM_ACFG_7BPC;
   1387		break;
   1388	case CS8:		/* 8 bits/char */
   1389		new_config2 |= ICOM_ACFG_8BPC;
   1390		break;
   1391	default:
   1392		break;
   1393	}
   1394	if (cflag & CSTOPB) {
   1395		/* 2 stop bits */
   1396		new_config2 |= ICOM_ACFG_2STOP_BIT;
   1397	}
   1398	if (cflag & PARENB) {
   1399		/* parity bit enabled */
   1400		new_config2 |= ICOM_ACFG_PARITY_ENAB;
   1401		trace(icom_port, "PARENB", 0);
   1402	}
   1403	if (cflag & PARODD) {
   1404		/* odd parity */
   1405		new_config2 |= ICOM_ACFG_PARITY_ODD;
   1406		trace(icom_port, "PARODD", 0);
   1407	}
   1408
   1409	/* Determine divisor based on baud rate */
   1410	baud = uart_get_baud_rate(port, termios, old_termios,
   1411				  icom_acfg_baud[0],
   1412				  icom_acfg_baud[BAUD_TABLE_LIMIT]);
   1413	if (!baud)
   1414		baud = 9600;	/* B0 transition handled in rs_set_termios */
   1415
   1416	for (index = 0; index < BAUD_TABLE_LIMIT; index++) {
   1417		if (icom_acfg_baud[index] == baud) {
   1418			new_config3 = index;
   1419			break;
   1420		}
   1421	}
   1422
   1423	uart_update_timeout(port, cflag, baud);
   1424
   1425	/* CTS flow control flag and modem status interrupts */
   1426	tmp_byte = readb(&(icom_port->dram->HDLCConfigReg));
   1427	if (cflag & CRTSCTS)
   1428		tmp_byte |= HDLC_HDW_FLOW;
   1429	else
   1430		tmp_byte &= ~HDLC_HDW_FLOW;
   1431	writeb(tmp_byte, &(icom_port->dram->HDLCConfigReg));
   1432
   1433	/*
   1434	 * Set up parity check flag
   1435	 */
   1436	icom_port->read_status_mask = SA_FLAGS_OVERRUN | SA_FL_RCV_DONE;
   1437	if (iflag & INPCK)
   1438		icom_port->read_status_mask |=
   1439		    SA_FLAGS_FRAME_ERROR | SA_FLAGS_PARITY_ERROR;
   1440
   1441	if ((iflag & BRKINT) || (iflag & PARMRK))
   1442		icom_port->read_status_mask |= SA_FLAGS_BREAK_DET;
   1443
   1444	/*
   1445	 * Characters to ignore
   1446	 */
   1447	icom_port->ignore_status_mask = 0;
   1448	if (iflag & IGNPAR)
   1449		icom_port->ignore_status_mask |=
   1450		    SA_FLAGS_PARITY_ERROR | SA_FLAGS_FRAME_ERROR;
   1451	if (iflag & IGNBRK) {
   1452		icom_port->ignore_status_mask |= SA_FLAGS_BREAK_DET;
   1453		/*
   1454		 * If we're ignore parity and break indicators, ignore
   1455		 * overruns too.  (For real raw support).
   1456		 */
   1457		if (iflag & IGNPAR)
   1458			icom_port->ignore_status_mask |= SA_FLAGS_OVERRUN;
   1459	}
   1460
   1461	/*
   1462	 * !!! ignore all characters if CREAD is not set
   1463	 */
   1464	if ((cflag & CREAD) == 0)
   1465		icom_port->ignore_status_mask |= SA_FL_RCV_DONE;
   1466
   1467	/* Turn off Receiver to prepare for reset */
   1468	writeb(CMD_RCV_DISABLE, &icom_port->dram->CmdReg);
   1469
   1470	for (index = 0; index < 10; index++) {
   1471		if (readb(&icom_port->dram->PrevCmdReg) == 0x00) {
   1472			break;
   1473		}
   1474	}
   1475
   1476	/* clear all current buffers of data */
   1477	for (rcv_buff = 0; rcv_buff < NUM_RBUFFS; rcv_buff++) {
   1478		icom_port->statStg->rcv[rcv_buff].flags = 0;
   1479		icom_port->statStg->rcv[rcv_buff].leLength = 0;
   1480		icom_port->statStg->rcv[rcv_buff].WorkingLength =
   1481		    cpu_to_le16(RCV_BUFF_SZ);
   1482	}
   1483
   1484	for (xmit_buff = 0; xmit_buff < NUM_XBUFFS; xmit_buff++) {
   1485		icom_port->statStg->xmit[xmit_buff].flags = 0;
   1486	}
   1487
   1488	/* activate changes and start xmit and receiver here */
   1489	/* Enable the receiver */
   1490	writeb(new_config3, &(icom_port->dram->async_config3));
   1491	writeb(new_config2, &(icom_port->dram->async_config2));
   1492	tmp_byte = readb(&(icom_port->dram->HDLCConfigReg));
   1493	tmp_byte |= HDLC_PPP_PURE_ASYNC | HDLC_FF_FILL;
   1494	writeb(tmp_byte, &(icom_port->dram->HDLCConfigReg));
   1495	writeb(0x04, &(icom_port->dram->FlagFillIdleTimer));	/* 0.5 seconds */
   1496	writeb(0xFF, &(icom_port->dram->ier));	/* enable modem signal interrupts */
   1497
   1498	/* reset processor */
   1499	writeb(CMD_RESTART, &icom_port->dram->CmdReg);
   1500
   1501	for (index = 0; index < 10; index++) {
   1502		if (readb(&icom_port->dram->CmdReg) == 0x00) {
   1503			break;
   1504		}
   1505	}
   1506
   1507	/* Enable Transmitter and Receiver */
   1508	offset =
   1509	    (unsigned long) &icom_port->statStg->rcv[0] -
   1510	    (unsigned long) icom_port->statStg;
   1511	writel(icom_port->statStg_pci + offset,
   1512	       &icom_port->dram->RcvStatusAddr);
   1513	icom_port->next_rcv = 0;
   1514	*icom_port->xmitRestart = 0;
   1515	writel(icom_port->xmitRestart_pci,
   1516	       &icom_port->dram->XmitStatusAddr);
   1517	trace(icom_port, "XR_ENAB", 0);
   1518	writeb(CMD_XMIT_RCV_ENABLE, &icom_port->dram->CmdReg);
   1519
   1520	spin_unlock_irqrestore(&port->lock, flags);
   1521}
   1522
   1523static const char *icom_type(struct uart_port *port)
   1524{
   1525	return "icom";
   1526}
   1527
   1528static void icom_config_port(struct uart_port *port, int flags)
   1529{
   1530	port->type = PORT_ICOM;
   1531}
   1532
   1533static const struct uart_ops icom_ops = {
   1534	.tx_empty = icom_tx_empty,
   1535	.set_mctrl = icom_set_mctrl,
   1536	.get_mctrl = icom_get_mctrl,
   1537	.stop_tx = icom_stop_tx,
   1538	.start_tx = icom_start_tx,
   1539	.send_xchar = icom_send_xchar,
   1540	.stop_rx = icom_stop_rx,
   1541	.break_ctl = icom_break,
   1542	.startup = icom_open,
   1543	.shutdown = icom_close,
   1544	.set_termios = icom_set_termios,
   1545	.type = icom_type,
   1546	.config_port = icom_config_port,
   1547};
   1548
   1549#define ICOM_CONSOLE NULL
   1550
   1551static struct uart_driver icom_uart_driver = {
   1552	.owner = THIS_MODULE,
   1553	.driver_name = ICOM_DRIVER_NAME,
   1554	.dev_name = "ttyA",
   1555	.major = ICOM_MAJOR,
   1556	.minor = ICOM_MINOR_START,
   1557	.nr = NR_PORTS,
   1558	.cons = ICOM_CONSOLE,
   1559};
   1560
   1561static int icom_init_ports(struct icom_adapter *icom_adapter)
   1562{
   1563	u32 subsystem_id = icom_adapter->subsystem_id;
   1564	int i;
   1565	struct icom_port *icom_port;
   1566
   1567	if (icom_adapter->version == ADAPTER_V1) {
   1568		icom_adapter->numb_ports = 2;
   1569
   1570		for (i = 0; i < 2; i++) {
   1571			icom_port = &icom_adapter->port_info[i];
   1572			icom_port->port = i;
   1573			icom_port->status = ICOM_PORT_ACTIVE;
   1574		}
   1575	} else {
   1576		if (subsystem_id == PCI_DEVICE_ID_IBM_ICOM_FOUR_PORT_MODEL) {
   1577			icom_adapter->numb_ports = 4;
   1578
   1579			for (i = 0; i < 4; i++) {
   1580				icom_port = &icom_adapter->port_info[i];
   1581
   1582				icom_port->port = i;
   1583				icom_port->status = ICOM_PORT_ACTIVE;
   1584			}
   1585		} else {
   1586			icom_adapter->numb_ports = 4;
   1587
   1588			icom_adapter->port_info[0].port = 0;
   1589			icom_adapter->port_info[0].status = ICOM_PORT_ACTIVE;
   1590			icom_adapter->port_info[1].status = ICOM_PORT_OFF;
   1591			icom_adapter->port_info[2].port = 2;
   1592			icom_adapter->port_info[2].status = ICOM_PORT_ACTIVE;
   1593			icom_adapter->port_info[3].status = ICOM_PORT_OFF;
   1594		}
   1595	}
   1596
   1597	return 0;
   1598}
   1599
   1600static void icom_port_active(struct icom_port *icom_port, struct icom_adapter *icom_adapter, int port_num)
   1601{
   1602	if (icom_adapter->version == ADAPTER_V1) {
   1603		icom_port->global_reg = icom_adapter->base_addr + 0x4000;
   1604		icom_port->int_reg = icom_adapter->base_addr +
   1605		    0x4004 + 2 - 2 * port_num;
   1606	} else {
   1607		icom_port->global_reg = icom_adapter->base_addr + 0x8000;
   1608		if (icom_port->port < 2)
   1609			icom_port->int_reg = icom_adapter->base_addr +
   1610			    0x8004 + 2 - 2 * icom_port->port;
   1611		else
   1612			icom_port->int_reg = icom_adapter->base_addr +
   1613			    0x8024 + 2 - 2 * (icom_port->port - 2);
   1614	}
   1615}
   1616static int icom_load_ports(struct icom_adapter *icom_adapter)
   1617{
   1618	struct icom_port *icom_port;
   1619	int port_num;
   1620
   1621	for (port_num = 0; port_num < icom_adapter->numb_ports; port_num++) {
   1622
   1623		icom_port = &icom_adapter->port_info[port_num];
   1624
   1625		if (icom_port->status == ICOM_PORT_ACTIVE) {
   1626			icom_port_active(icom_port, icom_adapter, port_num);
   1627			icom_port->dram = icom_adapter->base_addr +
   1628					0x2000 * icom_port->port;
   1629
   1630			icom_port->adapter = icom_adapter;
   1631
   1632			/* get port memory */
   1633			if (get_port_memory(icom_port) != 0) {
   1634				dev_err(&icom_port->adapter->pci_dev->dev,
   1635					"Memory allocation for port FAILED\n");
   1636			}
   1637		}
   1638	}
   1639	return 0;
   1640}
   1641
   1642static int icom_alloc_adapter(struct icom_adapter
   1643					**icom_adapter_ref)
   1644{
   1645	int adapter_count = 0;
   1646	struct icom_adapter *icom_adapter;
   1647	struct icom_adapter *cur_adapter_entry;
   1648
   1649	icom_adapter = kzalloc(sizeof(struct icom_adapter), GFP_KERNEL);
   1650
   1651	if (!icom_adapter) {
   1652		return -ENOMEM;
   1653	}
   1654
   1655	list_for_each_entry(cur_adapter_entry, &icom_adapter_head,
   1656			icom_adapter_entry) {
   1657		if (cur_adapter_entry->index != adapter_count) {
   1658			break;
   1659		}
   1660		adapter_count++;
   1661	}
   1662
   1663	icom_adapter->index = adapter_count;
   1664	list_add_tail(&icom_adapter->icom_adapter_entry,
   1665			&cur_adapter_entry->icom_adapter_entry);
   1666
   1667	*icom_adapter_ref = icom_adapter;
   1668	return 0;
   1669}
   1670
   1671static void icom_free_adapter(struct icom_adapter *icom_adapter)
   1672{
   1673	list_del(&icom_adapter->icom_adapter_entry);
   1674	kfree(icom_adapter);
   1675}
   1676
   1677static void icom_kref_release(struct kref *kref)
   1678{
   1679	struct icom_adapter *icom_adapter = container_of(kref,
   1680			struct icom_adapter, kref);
   1681	struct icom_port *icom_port;
   1682	int index;
   1683
   1684	for (index = 0; index < icom_adapter->numb_ports; index++) {
   1685		icom_port = &icom_adapter->port_info[index];
   1686
   1687		if (icom_port->status == ICOM_PORT_ACTIVE) {
   1688			dev_info(&icom_adapter->pci_dev->dev,
   1689				 "Device removed\n");
   1690
   1691			uart_remove_one_port(&icom_uart_driver,
   1692					     &icom_port->uart_port);
   1693
   1694			/* be sure that DTR and RTS are dropped */
   1695			writeb(0x00, &icom_port->dram->osr);
   1696
   1697			/* Wait 0.1 Sec for simple Init to complete */
   1698			msleep(100);
   1699
   1700			/* Stop proccessor */
   1701			stop_processor(icom_port);
   1702
   1703			free_port_memory(icom_port);
   1704		}
   1705	}
   1706
   1707	free_irq(icom_adapter->pci_dev->irq, (void *) icom_adapter);
   1708	iounmap(icom_adapter->base_addr);
   1709	pci_release_regions(icom_adapter->pci_dev);
   1710	icom_free_adapter(icom_adapter);
   1711}
   1712
   1713static int icom_probe(struct pci_dev *dev,
   1714				const struct pci_device_id *ent)
   1715{
   1716	int index;
   1717	unsigned int command_reg;
   1718	int retval;
   1719	struct icom_adapter *icom_adapter;
   1720	struct icom_port *icom_port;
   1721
   1722	retval = pci_enable_device(dev);
   1723	if (retval) {
   1724		dev_err(&dev->dev, "Device enable FAILED\n");
   1725		return retval;
   1726	}
   1727
   1728	retval = pci_request_regions(dev, "icom");
   1729	if (retval) {
   1730		 dev_err(&dev->dev, "pci_request_regions FAILED\n");
   1731		 pci_disable_device(dev);
   1732		 return retval;
   1733	 }
   1734
   1735	pci_set_master(dev);
   1736
   1737	retval = pci_read_config_dword(dev, PCI_COMMAND, &command_reg);
   1738	if (retval) {
   1739		dev_err(&dev->dev, "PCI Config read FAILED\n");
   1740		goto probe_exit0;
   1741	}
   1742
   1743	pci_write_config_dword(dev, PCI_COMMAND,
   1744		command_reg | PCI_COMMAND_MEMORY | PCI_COMMAND_MASTER
   1745 		| PCI_COMMAND_PARITY | PCI_COMMAND_SERR);
   1746
   1747	if (ent->driver_data == ADAPTER_V1) {
   1748		pci_write_config_dword(dev, 0x44, 0x8300830A);
   1749	} else {
   1750		pci_write_config_dword(dev, 0x44, 0x42004200);
   1751		pci_write_config_dword(dev, 0x48, 0x42004200);
   1752	}
   1753
   1754
   1755	retval = icom_alloc_adapter(&icom_adapter);
   1756	if (retval) {
   1757		 dev_err(&dev->dev, "icom_alloc_adapter FAILED\n");
   1758		 retval = -EIO;
   1759		 goto probe_exit0;
   1760	}
   1761
   1762	icom_adapter->base_addr_pci = pci_resource_start(dev, 0);
   1763	icom_adapter->pci_dev = dev;
   1764	icom_adapter->version = ent->driver_data;
   1765	icom_adapter->subsystem_id = ent->subdevice;
   1766
   1767
   1768	retval = icom_init_ports(icom_adapter);
   1769	if (retval) {
   1770		dev_err(&dev->dev, "Port configuration failed\n");
   1771		goto probe_exit1;
   1772	}
   1773
   1774	icom_adapter->base_addr = pci_ioremap_bar(dev, 0);
   1775
   1776	if (!icom_adapter->base_addr) {
   1777		retval = -ENOMEM;
   1778		goto probe_exit1;
   1779	}
   1780
   1781	 /* save off irq and request irq line */
   1782	 retval = request_irq(dev->irq, icom_interrupt, IRQF_SHARED, ICOM_DRIVER_NAME, (void *)icom_adapter);
   1783	 if (retval) {
   1784		  goto probe_exit2;
   1785	 }
   1786
   1787	retval = icom_load_ports(icom_adapter);
   1788
   1789	for (index = 0; index < icom_adapter->numb_ports; index++) {
   1790		icom_port = &icom_adapter->port_info[index];
   1791
   1792		if (icom_port->status == ICOM_PORT_ACTIVE) {
   1793			icom_port->uart_port.irq = icom_port->adapter->pci_dev->irq;
   1794			icom_port->uart_port.type = PORT_ICOM;
   1795			icom_port->uart_port.iotype = UPIO_MEM;
   1796			icom_port->uart_port.membase =
   1797				(unsigned char __iomem *)icom_adapter->base_addr_pci;
   1798			icom_port->uart_port.fifosize = 16;
   1799			icom_port->uart_port.ops = &icom_ops;
   1800			icom_port->uart_port.line =
   1801		        icom_port->port + icom_adapter->index * 4;
   1802			if (uart_add_one_port (&icom_uart_driver, &icom_port->uart_port)) {
   1803				icom_port->status = ICOM_PORT_OFF;
   1804				dev_err(&dev->dev, "Device add failed\n");
   1805			 } else
   1806				dev_info(&dev->dev, "Device added\n");
   1807		}
   1808	}
   1809
   1810	kref_init(&icom_adapter->kref);
   1811	return 0;
   1812
   1813probe_exit2:
   1814	iounmap(icom_adapter->base_addr);
   1815probe_exit1:
   1816	icom_free_adapter(icom_adapter);
   1817
   1818probe_exit0:
   1819	pci_release_regions(dev);
   1820	pci_disable_device(dev);
   1821
   1822	return retval;
   1823}
   1824
   1825static void icom_remove(struct pci_dev *dev)
   1826{
   1827	struct icom_adapter *icom_adapter;
   1828
   1829	list_for_each_entry(icom_adapter, &icom_adapter_head,
   1830			icom_adapter_entry) {
   1831		if (icom_adapter->pci_dev == dev) {
   1832			kref_put(&icom_adapter->kref, icom_kref_release);
   1833			return;
   1834		}
   1835	}
   1836
   1837	dev_err(&dev->dev, "Unable to find device to remove\n");
   1838}
   1839
   1840static struct pci_driver icom_pci_driver = {
   1841	.name = ICOM_DRIVER_NAME,
   1842	.id_table = icom_pci_table,
   1843	.probe = icom_probe,
   1844	.remove = icom_remove,
   1845};
   1846
   1847static int __init icom_init(void)
   1848{
   1849	int ret;
   1850
   1851	ret = uart_register_driver(&icom_uart_driver);
   1852	if (ret)
   1853		return ret;
   1854
   1855	ret = pci_register_driver(&icom_pci_driver);
   1856
   1857	if (ret < 0)
   1858		uart_unregister_driver(&icom_uart_driver);
   1859
   1860	return ret;
   1861}
   1862
   1863static void __exit icom_exit(void)
   1864{
   1865	pci_unregister_driver(&icom_pci_driver);
   1866	uart_unregister_driver(&icom_uart_driver);
   1867}
   1868
   1869module_init(icom_init);
   1870module_exit(icom_exit);
   1871
   1872MODULE_AUTHOR("Michael Anderson <mjanders@us.ibm.com>");
   1873MODULE_DESCRIPTION("IBM iSeries Serial IOA driver");
   1874MODULE_LICENSE("GPL");
   1875MODULE_FIRMWARE("icom_call_setup.bin");
   1876MODULE_FIRMWARE("icom_res_dce.bin");
   1877MODULE_FIRMWARE("icom_asc.bin");