Linux Audio

Check our new training course

Linux debugging, profiling, tracing and performance analysis training

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