Linux Audio

Check our new training course

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