ipoctal.c 18.7 KB
Newer Older
1 2 3 4
/**
 * ipoctal.c
 *
 * driver for the GE IP-OCTAL boards
5 6 7 8
 *
 * Copyright (C) 2009-2012 CERN (www.cern.ch)
 * Author: Nicolas Serafini, EIC2 SA
 * Author: Samuel Iglesias Gonsalvez <siglesias@igalia.com>
9 10 11
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms of the GNU General Public License as published by the Free
12
 * Software Foundation; version 2 of the License.
13 14 15 16 17 18 19 20 21 22
 */

#include <linux/device.h>
#include <linux/module.h>
#include <linux/interrupt.h>
#include <linux/sched.h>
#include <linux/tty.h>
#include <linux/serial.h>
#include <linux/tty_flip.h>
#include <linux/slab.h>
23
#include <linux/io.h>
24
#include <linux/ipack.h>
25 26 27 28 29 30 31 32
#include "ipoctal.h"
#include "scc2698.h"

#define IP_OCTAL_ID_SPACE_VECTOR    0x41
#define IP_OCTAL_NB_BLOCKS          4

static const struct tty_operations ipoctal_fops;

33 34 35 36 37 38 39 40 41 42
struct ipoctal_channel {
	struct ipoctal_stats		stats;
	unsigned int			nb_bytes;
	wait_queue_head_t		queue;
	spinlock_t			lock;
	unsigned int			pointer_read;
	unsigned int			pointer_write;
	struct tty_port			tty_port;
	union scc2698_channel __iomem	*regs;
	union scc2698_block __iomem	*block_regs;
43
	unsigned int			board_id;
44 45
	u8				isr_rx_rdy_mask;
	u8				isr_tx_rdy_mask;
46
	unsigned int			rx_enable;
47 48
};

49 50 51
struct ipoctal {
	struct ipack_device		*dev;
	unsigned int			board_id;
52
	struct ipoctal_channel		channel[NR_CHANNELS];
53
	struct tty_driver		*tty_drv;
54
	u8 __iomem			*mem8_space;
55
	u8 __iomem			*int_space;
56 57 58 59
};

static int ipoctal_port_activate(struct tty_port *port, struct tty_struct *tty)
{
60
	struct ipoctal_channel *channel;
61

62
	channel = dev_get_drvdata(tty->dev);
63

64 65 66 67
	/*
	 * Enable RX. TX will be enabled when
	 * there is something to send
	 */
68
	iowrite8(CR_ENABLE_RX, &channel->regs->w.cr);
69
	channel->rx_enable = 1;
70 71 72 73 74
	return 0;
}

static int ipoctal_open(struct tty_struct *tty, struct file *file)
{
75
	struct ipoctal_channel *channel;
76

77
	channel = dev_get_drvdata(tty->dev);
78
	tty->driver_data = channel;
79

80
	return tty_port_open(&channel->tty_port, tty, file);
81 82 83 84 85 86 87 88 89 90 91 92
}

static void ipoctal_reset_stats(struct ipoctal_stats *stats)
{
	stats->tx = 0;
	stats->rx = 0;
	stats->rcv_break = 0;
	stats->framing_err = 0;
	stats->overrun_err = 0;
	stats->parity_err = 0;
}

93
static void ipoctal_free_channel(struct ipoctal_channel *channel)
94
{
95 96 97 98
	ipoctal_reset_stats(&channel->stats);
	channel->pointer_read = 0;
	channel->pointer_write = 0;
	channel->nb_bytes = 0;
99 100 101 102
}

static void ipoctal_close(struct tty_struct *tty, struct file *filp)
{
103
	struct ipoctal_channel *channel = tty->driver_data;
104

105
	tty_port_close(&channel->tty_port, tty, filp);
106
	ipoctal_free_channel(channel);
107 108 109 110 111
}

static int ipoctal_get_icount(struct tty_struct *tty,
			      struct serial_icounter_struct *icount)
{
112
	struct ipoctal_channel *channel = tty->driver_data;
113 114 115 116 117

	icount->cts = 0;
	icount->dsr = 0;
	icount->rng = 0;
	icount->dcd = 0;
118 119 120 121 122
	icount->rx = channel->stats.rx;
	icount->tx = channel->stats.tx;
	icount->frame = channel->stats.framing_err;
	icount->parity = channel->stats.parity_err;
	icount->brk = channel->stats.rcv_break;
123 124 125
	return 0;
}

126 127
static void ipoctal_irq_rx(struct ipoctal_channel *channel,
			   struct tty_struct *tty, u8 sr)
128
{
129
	unsigned char value;
130
	unsigned char flag;
131 132 133 134
	u8 isr;

	do {
		value = ioread8(&channel->regs->r.rhr);
135
		flag = TTY_NORMAL;
136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153
		/* Error: count statistics */
		if (sr & SR_ERROR) {
			iowrite8(CR_CMD_RESET_ERR_STATUS, &channel->regs->w.cr);

			if (sr & SR_OVERRUN_ERROR) {
				channel->stats.overrun_err++;
				/* Overrun doesn't affect the current character*/
				tty_insert_flip_char(tty, 0, TTY_OVERRUN);
			}
			if (sr & SR_PARITY_ERROR) {
				channel->stats.parity_err++;
				flag = TTY_PARITY;
			}
			if (sr & SR_FRAMING_ERROR) {
				channel->stats.framing_err++;
				flag = TTY_FRAME;
			}
			if (sr & SR_RECEIVED_BREAK) {
154
				iowrite8(CR_CMD_RESET_BREAK_CHANGE, &channel->regs->w.cr);
155 156 157
				channel->stats.rcv_break++;
				flag = TTY_BREAK;
			}
158
		}
159 160 161 162 163 164 165 166 167
		tty_insert_flip_char(tty, value, flag);

		/* Check if there are more characters in RX FIFO
		 * If there are more, the isr register for this channel
		 * has enabled the RxRDY|FFULL bit.
		 */
		isr = ioread8(&channel->block_regs->r.isr);
		sr = ioread8(&channel->regs->r.sr);
	} while (isr & channel->isr_rx_rdy_mask);
168

169
	tty_flip_buffer_push(tty);
170 171 172 173 174 175 176
}

static void ipoctal_irq_tx(struct ipoctal_channel *channel)
{
	unsigned char value;
	unsigned int *pointer_write = &channel->pointer_write;

177
	if (channel->nb_bytes == 0)
178
		return;
179

180 181 182 183 184 185 186
	value = channel->tty_port.xmit_buf[*pointer_write];
	iowrite8(value, &channel->regs->w.thr);
	channel->stats.tx++;
	(*pointer_write)++;
	*pointer_write = *pointer_write % PAGE_SIZE;
	channel->nb_bytes--;
}
187

188 189 190 191 192 193 194 195
static void ipoctal_irq_channel(struct ipoctal_channel *channel)
{
	u8 isr, sr;
	struct tty_struct *tty;

	tty = tty_port_tty_get(&channel->tty_port);
	if (!tty)
		return;
196 197

	spin_lock(&channel->lock);
198 199 200 201 202
	/* The HW is organized in pair of channels.  See which register we need
	 * to read from */
	isr = ioread8(&channel->block_regs->r.isr);
	sr = ioread8(&channel->regs->r.sr);

203
	if ((sr & SR_TX_EMPTY) && (channel->nb_bytes == 0)) {
204
		iowrite8(CR_DISABLE_TX, &channel->regs->w.cr);
205 206 207 208 209 210
		/* In case of RS-485, change from TX to RX when finishing TX.
		 * Half-duplex. */
		if (channel->board_id == IPACK1_DEVICE_ID_SBS_OCTAL_485) {
			iowrite8(CR_CMD_NEGATE_RTSN, &channel->regs->w.cr);
			iowrite8(CR_ENABLE_RX, &channel->regs->w.cr);
		}
211
	}
212 213 214 215 216 217 218 219 220 221

	/* RX data */
	if ((isr & channel->isr_rx_rdy_mask) && (sr & SR_RX_READY))
		ipoctal_irq_rx(channel, tty, sr);

	/* TX of each character */
	if ((isr & channel->isr_tx_rdy_mask) && (sr & SR_TX_READY))
		ipoctal_irq_tx(channel);

	tty_kref_put(tty);
222
	spin_unlock(&channel->lock);
223 224
}

225
static irqreturn_t ipoctal_irq_handler(void *arg)
226 227 228 229
{
	unsigned int i;
	struct ipoctal *ipoctal = (struct ipoctal *) arg;

230
	/* Clear the IPack device interrupt */
231 232
	readw(ipoctal->int_space + ACK_INT_REQ0);
	readw(ipoctal->int_space + ACK_INT_REQ1);
233

234 235 236 237
	/* Check all channels */
	for (i = 0; i < NR_CHANNELS; i++)
		ipoctal_irq_channel(&ipoctal->channel[i]);

238 239 240 241 242 243 244 245 246
	return IRQ_HANDLED;
}

static const struct tty_port_operations ipoctal_tty_port_ops = {
	.dtr_rts = NULL,
	.activate = ipoctal_port_activate,
};

static int ipoctal_inst_slot(struct ipoctal *ipoctal, unsigned int bus_nr,
247
			     unsigned int slot)
248
{
249
	int res;
250 251 252
	int i;
	struct tty_driver *tty;
	char name[20];
253
	struct ipoctal_channel *channel;
254 255
	struct ipack_region *region;
	void __iomem *addr;
256 257
	union scc2698_channel __iomem *chan_regs;
	union scc2698_block __iomem *block_regs;
258

259
	ipoctal->board_id = ipoctal->dev->id_device;
260

261 262 263 264
	region = &ipoctal->dev->region[IPACK_IO_SPACE];
	addr = devm_ioremap_nocache(&ipoctal->dev->dev,
				    region->start, region->size);
	if (!addr) {
265 266 267
		dev_err(&ipoctal->dev->dev,
			"Unable to map slot [%d:%d] IO space!\n",
			bus_nr, slot);
268
		return -EADDRNOTAVAIL;
269
	}
270 271 272 273 274
	/* Save the virtual address to access the registers easily */
	chan_regs =
		(union scc2698_channel __iomem *) addr;
	block_regs =
		(union scc2698_block __iomem *) addr;
275

276 277 278 279 280
	region = &ipoctal->dev->region[IPACK_INT_SPACE];
	ipoctal->int_space =
		devm_ioremap_nocache(&ipoctal->dev->dev,
				     region->start, region->size);
	if (!ipoctal->int_space) {
281 282 283
		dev_err(&ipoctal->dev->dev,
			"Unable to map slot [%d:%d] INT space!\n",
			bus_nr, slot);
284
		return -EADDRNOTAVAIL;
285 286
	}

287 288
	region = &ipoctal->dev->region[IPACK_MEM8_SPACE];
	ipoctal->mem8_space =
289 290 291
		devm_ioremap_nocache(&ipoctal->dev->dev,
				     region->start, 0x8000);
	if (!addr) {
292
		dev_err(&ipoctal->dev->dev,
293
			"Unable to map slot [%d:%d] MEM8 space!\n",
294
			bus_nr, slot);
295
		return -EADDRNOTAVAIL;
296 297 298 299 300
	}


	/* Disable RX and TX before touching anything */
	for (i = 0; i < NR_CHANNELS ; i++) {
301 302 303
		struct ipoctal_channel *channel = &ipoctal->channel[i];
		channel->regs = chan_regs + i;
		channel->block_regs = block_regs + (i >> 1);
304
		channel->board_id = ipoctal->board_id;
305 306 307 308 309 310 311
		if (i & 1) {
			channel->isr_tx_rdy_mask = ISR_TxRDY_B;
			channel->isr_rx_rdy_mask = ISR_RxRDY_FFULL_B;
		} else {
			channel->isr_tx_rdy_mask = ISR_TxRDY_A;
			channel->isr_rx_rdy_mask = ISR_RxRDY_FFULL_A;
		}
312

313
		iowrite8(CR_DISABLE_RX | CR_DISABLE_TX, &channel->regs->w.cr);
314
		channel->rx_enable = 0;
315 316 317 318 319 320
		iowrite8(CR_CMD_RESET_RX, &channel->regs->w.cr);
		iowrite8(CR_CMD_RESET_TX, &channel->regs->w.cr);
		iowrite8(MR1_CHRL_8_BITS | MR1_ERROR_CHAR | MR1_RxINT_RxRDY,
			 &channel->regs->w.mr); /* mr1 */
		iowrite8(0, &channel->regs->w.mr); /* mr2 */
		iowrite8(TX_CLK_9600  | RX_CLK_9600, &channel->regs->w.csr);
321 322 323
	}

	for (i = 0; i < IP_OCTAL_NB_BLOCKS; i++) {
324 325 326 327 328 329
		iowrite8(ACR_BRG_SET2, &block_regs[i].w.acr);
		iowrite8(OPCR_MPP_OUTPUT | OPCR_MPOa_RTSN | OPCR_MPOb_RTSN,
			 &block_regs[i].w.opcr);
		iowrite8(IMR_TxRDY_A | IMR_RxRDY_FFULL_A | IMR_DELTA_BREAK_A |
			 IMR_TxRDY_B | IMR_RxRDY_FFULL_B | IMR_DELTA_BREAK_B,
			 &block_regs[i].w.imr);
330 331 332 333 334 335 336
	}

	/*
	 * IP-OCTAL has different addresses to copy its IRQ vector.
	 * Depending of the carrier these addresses are accesible or not.
	 * More info in the datasheet.
	 */
337
	ipoctal->dev->bus->ops->request_irq(ipoctal->dev,
338
				       ipoctal_irq_handler, ipoctal);
339
	/* Dummy write */
340
	iowrite8(1, ipoctal->mem8_space + 1);
341 342 343 344 345 346

	/* Register the TTY device */

	/* Each IP-OCTAL channel is a TTY port */
	tty = alloc_tty_driver(NR_CHANNELS);

347 348
	if (!tty)
		return -ENOMEM;
349 350 351

	/* Fill struct tty_driver with ipoctal data */
	tty->owner = THIS_MODULE;
352 353
	tty->driver_name = KBUILD_MODNAME;
	sprintf(name, KBUILD_MODNAME ".%d.%d.", bus_nr, slot);
354 355 356 357 358 359 360 361 362 363 364 365 366 367 368
	tty->name = name;
	tty->major = 0;

	tty->minor_start = 0;
	tty->type = TTY_DRIVER_TYPE_SERIAL;
	tty->subtype = SERIAL_TYPE_NORMAL;
	tty->flags = TTY_DRIVER_REAL_RAW | TTY_DRIVER_DYNAMIC_DEV;
	tty->init_termios = tty_std_termios;
	tty->init_termios.c_cflag = B9600 | CS8 | CREAD | HUPCL | CLOCAL;
	tty->init_termios.c_ispeed = 9600;
	tty->init_termios.c_ospeed = 9600;

	tty_set_operations(tty, &ipoctal_fops);
	res = tty_register_driver(tty);
	if (res) {
369
		dev_err(&ipoctal->dev->dev, "Can't register tty driver.\n");
370
		put_tty_driver(tty);
371
		return res;
372 373 374 375 376 377
	}

	/* Save struct tty_driver for use it when uninstalling the device */
	ipoctal->tty_drv = tty;

	for (i = 0; i < NR_CHANNELS; i++) {
378 379
		struct device *tty_dev;

380 381 382 383 384 385 386 387 388 389
		channel = &ipoctal->channel[i];
		tty_port_init(&channel->tty_port);
		tty_port_alloc_xmit_buf(&channel->tty_port);
		channel->tty_port.ops = &ipoctal_tty_port_ops;

		ipoctal_reset_stats(&channel->stats);
		channel->nb_bytes = 0;
		spin_lock_init(&channel->lock);
		channel->pointer_read = 0;
		channel->pointer_write = 0;
390
		tty_dev = tty_port_register_device(&channel->tty_port, tty, i, NULL);
391 392
		if (IS_ERR(tty_dev)) {
			dev_err(&ipoctal->dev->dev, "Failed to register tty device.\n");
393
			tty_port_destroy(&channel->tty_port);
394 395
			continue;
		}
396
		dev_set_drvdata(tty_dev, channel);
397 398 399 400 401
	}

	return 0;
}

402
static inline int ipoctal_copy_write_buffer(struct ipoctal_channel *channel,
403 404 405 406 407
					    const unsigned char *buf,
					    int count)
{
	unsigned long flags;
	int i;
408
	unsigned int *pointer_read = &channel->pointer_read;
409 410 411

	/* Copy the bytes from the user buffer to the internal one */
	for (i = 0; i < count; i++) {
412 413 414
		if (i <= (PAGE_SIZE - channel->nb_bytes)) {
			spin_lock_irqsave(&channel->lock, flags);
			channel->tty_port.xmit_buf[*pointer_read] = buf[i];
415
			*pointer_read = (*pointer_read + 1) % PAGE_SIZE;
416 417
			channel->nb_bytes++;
			spin_unlock_irqrestore(&channel->lock, flags);
418 419 420 421 422 423 424
		} else {
			break;
		}
	}
	return i;
}

425 426
static int ipoctal_write_tty(struct tty_struct *tty,
			     const unsigned char *buf, int count)
427
{
428
	struct ipoctal_channel *channel = tty->driver_data;
429
	unsigned int char_copied;
430

431
	char_copied = ipoctal_copy_write_buffer(channel, buf, count);
432 433

	/* As the IP-OCTAL 485 only supports half duplex, do it manually */
434
	if (channel->board_id == IPACK1_DEVICE_ID_SBS_OCTAL_485) {
435
		iowrite8(CR_DISABLE_RX, &channel->regs->w.cr);
436
		channel->rx_enable = 0;
437
		iowrite8(CR_CMD_ASSERT_RTSN, &channel->regs->w.cr);
438 439 440 441 442 443
	}

	/*
	 * Send a packet and then disable TX to avoid failure after several send
	 * operations
	 */
444
	iowrite8(CR_ENABLE_TX, &channel->regs->w.cr);
445
	return char_copied;
446 447 448 449
}

static int ipoctal_write_room(struct tty_struct *tty)
{
450
	struct ipoctal_channel *channel = tty->driver_data;
451

452
	return PAGE_SIZE - channel->nb_bytes;
453 454 455 456
}

static int ipoctal_chars_in_buffer(struct tty_struct *tty)
{
457
	struct ipoctal_channel *channel = tty->driver_data;
458

459
	return channel->nb_bytes;
460 461 462 463 464 465 466 467 468
}

static void ipoctal_set_termios(struct tty_struct *tty,
				struct ktermios *old_termios)
{
	unsigned int cflag;
	unsigned char mr1 = 0;
	unsigned char mr2 = 0;
	unsigned char csr = 0;
469
	struct ipoctal_channel *channel = tty->driver_data;
470 471
	speed_t baud;

472
	cflag = tty->termios.c_cflag;
473 474

	/* Disable and reset everything before change the setup */
475 476 477 478 479
	iowrite8(CR_DISABLE_RX | CR_DISABLE_TX, &channel->regs->w.cr);
	iowrite8(CR_CMD_RESET_RX, &channel->regs->w.cr);
	iowrite8(CR_CMD_RESET_TX, &channel->regs->w.cr);
	iowrite8(CR_CMD_RESET_ERR_STATUS, &channel->regs->w.cr);
	iowrite8(CR_CMD_RESET_MR, &channel->regs->w.cr);
480 481 482 483 484 485 486 487 488 489 490 491 492

	/* Set Bits per chars */
	switch (cflag & CSIZE) {
	case CS6:
		mr1 |= MR1_CHRL_6_BITS;
		break;
	case CS7:
		mr1 |= MR1_CHRL_7_BITS;
		break;
	case CS8:
	default:
		mr1 |= MR1_CHRL_8_BITS;
		/* By default, select CS8 */
493
		tty->termios.c_cflag = (cflag & ~CSIZE) | CS8;
494 495 496 497 498 499 500 501 502 503 504 505 506
		break;
	}

	/* Set Parity */
	if (cflag & PARENB)
		if (cflag & PARODD)
			mr1 |= MR1_PARITY_ON | MR1_PARITY_ODD;
		else
			mr1 |= MR1_PARITY_ON | MR1_PARITY_EVEN;
	else
		mr1 |= MR1_PARITY_OFF;

	/* Mark or space parity is not supported */
507
	tty->termios.c_cflag &= ~CMSPAR;
508 509 510 511 512 513 514 515

	/* Set stop bits */
	if (cflag & CSTOPB)
		mr2 |= MR2_STOP_BITS_LENGTH_2;
	else
		mr2 |= MR2_STOP_BITS_LENGTH_1;

	/* Set the flow control */
516
	switch (channel->board_id) {
517
	case IPACK1_DEVICE_ID_SBS_OCTAL_232:
518 519 520 521 522 523 524 525
		if (cflag & CRTSCTS) {
			mr1 |= MR1_RxRTS_CONTROL_ON;
			mr2 |= MR2_TxRTS_CONTROL_OFF | MR2_CTS_ENABLE_TX_ON;
		} else {
			mr1 |= MR1_RxRTS_CONTROL_OFF;
			mr2 |= MR2_TxRTS_CONTROL_OFF | MR2_CTS_ENABLE_TX_OFF;
		}
		break;
526
	case IPACK1_DEVICE_ID_SBS_OCTAL_422:
527 528 529
		mr1 |= MR1_RxRTS_CONTROL_OFF;
		mr2 |= MR2_TxRTS_CONTROL_OFF | MR2_CTS_ENABLE_TX_OFF;
		break;
530
	case IPACK1_DEVICE_ID_SBS_OCTAL_485:
531 532 533 534 535 536 537 538 539
		mr1 |= MR1_RxRTS_CONTROL_OFF;
		mr2 |= MR2_TxRTS_CONTROL_ON | MR2_CTS_ENABLE_TX_OFF;
		break;
	default:
		return;
		break;
	}

	baud = tty_get_baud_rate(tty);
540
	tty_termios_encode_baud_rate(&tty->termios, baud, baud);
541 542

	/* Set baud rate */
543
	switch (baud) {
544 545 546 547 548 549 550 551 552 553 554 555 556 557 558 559 560 561 562 563 564 565 566 567 568 569 570 571 572 573 574 575 576 577 578 579 580 581 582 583
	case 75:
		csr |= TX_CLK_75 | RX_CLK_75;
		break;
	case 110:
		csr |= TX_CLK_110 | RX_CLK_110;
		break;
	case 150:
		csr |= TX_CLK_150 | RX_CLK_150;
		break;
	case 300:
		csr |= TX_CLK_300 | RX_CLK_300;
		break;
	case 600:
		csr |= TX_CLK_600 | RX_CLK_600;
		break;
	case 1200:
		csr |= TX_CLK_1200 | RX_CLK_1200;
		break;
	case 1800:
		csr |= TX_CLK_1800 | RX_CLK_1800;
		break;
	case 2000:
		csr |= TX_CLK_2000 | RX_CLK_2000;
		break;
	case 2400:
		csr |= TX_CLK_2400 | RX_CLK_2400;
		break;
	case 4800:
		csr |= TX_CLK_4800  | RX_CLK_4800;
		break;
	case 9600:
		csr |= TX_CLK_9600  | RX_CLK_9600;
		break;
	case 19200:
		csr |= TX_CLK_19200 | RX_CLK_19200;
		break;
	case 38400:
	default:
		csr |= TX_CLK_38400 | RX_CLK_38400;
		/* In case of default, we establish 38400 bps */
584
		tty_termios_encode_baud_rate(&tty->termios, 38400, 38400);
585 586 587 588 589 590 591
		break;
	}

	mr1 |= MR1_ERROR_CHAR;
	mr1 |= MR1_RxINT_RxRDY;

	/* Write the control registers */
592 593 594
	iowrite8(mr1, &channel->regs->w.mr);
	iowrite8(mr2, &channel->regs->w.mr);
	iowrite8(csr, &channel->regs->w.csr);
595

596 597 598
	/* Enable again the RX, if it was before */
	if (channel->rx_enable)
		iowrite8(CR_ENABLE_RX, &channel->regs->w.cr);
599 600 601 602 603
}

static void ipoctal_hangup(struct tty_struct *tty)
{
	unsigned long flags;
604
	struct ipoctal_channel *channel = tty->driver_data;
605

606
	if (channel == NULL)
607 608
		return;

609 610 611 612 613
	spin_lock_irqsave(&channel->lock, flags);
	channel->nb_bytes = 0;
	channel->pointer_read = 0;
	channel->pointer_write = 0;
	spin_unlock_irqrestore(&channel->lock, flags);
614

615
	tty_port_hangup(&channel->tty_port);
616

617
	iowrite8(CR_DISABLE_RX | CR_DISABLE_TX, &channel->regs->w.cr);
618
	channel->rx_enable = 0;
619 620 621 622
	iowrite8(CR_CMD_RESET_RX, &channel->regs->w.cr);
	iowrite8(CR_CMD_RESET_TX, &channel->regs->w.cr);
	iowrite8(CR_CMD_RESET_ERR_STATUS, &channel->regs->w.cr);
	iowrite8(CR_CMD_RESET_MR, &channel->regs->w.cr);
623

624 625
	clear_bit(ASYNCB_INITIALIZED, &channel->tty_port.flags);
	wake_up_interruptible(&channel->tty_port.open_wait);
626 627
}

628 629 630 631 632 633 634 635 636 637 638 639 640 641 642 643
static void ipoctal_shutdown(struct tty_struct *tty)
{
	struct ipoctal_channel *channel = tty->driver_data;

	if (channel == NULL)
		return;

	iowrite8(CR_DISABLE_RX | CR_DISABLE_TX, &channel->regs->w.cr);
	channel->rx_enable = 0;
	iowrite8(CR_CMD_RESET_RX, &channel->regs->w.cr);
	iowrite8(CR_CMD_RESET_TX, &channel->regs->w.cr);
	iowrite8(CR_CMD_RESET_ERR_STATUS, &channel->regs->w.cr);
	iowrite8(CR_CMD_RESET_MR, &channel->regs->w.cr);
	clear_bit(ASYNCB_INITIALIZED, &channel->tty_port.flags);
}

644 645 646 647 648 649 650 651 652 653
static const struct tty_operations ipoctal_fops = {
	.ioctl =		NULL,
	.open =			ipoctal_open,
	.close =		ipoctal_close,
	.write =		ipoctal_write_tty,
	.set_termios =		ipoctal_set_termios,
	.write_room =		ipoctal_write_room,
	.chars_in_buffer =	ipoctal_chars_in_buffer,
	.get_icount =		ipoctal_get_icount,
	.hangup =		ipoctal_hangup,
654
	.shutdown =		ipoctal_shutdown,
655 656 657 658 659 660 661 662 663 664 665 666
};

static int ipoctal_probe(struct ipack_device *dev)
{
	int res;
	struct ipoctal *ipoctal;

	ipoctal = kzalloc(sizeof(struct ipoctal), GFP_KERNEL);
	if (ipoctal == NULL)
		return -ENOMEM;

	ipoctal->dev = dev;
667
	res = ipoctal_inst_slot(ipoctal, dev->bus->bus_nr, dev->slot);
668 669 670
	if (res)
		goto out_uninst;

671
	dev_set_drvdata(&dev->dev, ipoctal);
672 673 674 675 676 677 678 679 680 681 682
	return 0;

out_uninst:
	kfree(ipoctal);
	return res;
}

static void __ipoctal_remove(struct ipoctal *ipoctal)
{
	int i;

683 684
	ipoctal->dev->bus->ops->free_irq(ipoctal->dev);

685
	for (i = 0; i < NR_CHANNELS; i++) {
686
		struct ipoctal_channel *channel = &ipoctal->channel[i];
687
		tty_unregister_device(ipoctal->tty_drv, i);
688
		tty_port_free_xmit_buf(&channel->tty_port);
689
		tty_port_destroy(&channel->tty_port);
690 691 692 693 694 695 696
	}

	tty_unregister_driver(ipoctal->tty_drv);
	put_tty_driver(ipoctal->tty_drv);
	kfree(ipoctal);
}

697
static void ipoctal_remove(struct ipack_device *idev)
698
{
699
	__ipoctal_remove(dev_get_drvdata(&idev->dev));
700 701
}

702 703 704 705 706 707 708 709 710 711 712 713
static DEFINE_IPACK_DEVICE_TABLE(ipoctal_ids) = {
	{ IPACK_DEVICE(IPACK_ID_VERSION_1, IPACK1_VENDOR_ID_SBS,
			IPACK1_DEVICE_ID_SBS_OCTAL_232) },
	{ IPACK_DEVICE(IPACK_ID_VERSION_1, IPACK1_VENDOR_ID_SBS,
			IPACK1_DEVICE_ID_SBS_OCTAL_422) },
	{ IPACK_DEVICE(IPACK_ID_VERSION_1, IPACK1_VENDOR_ID_SBS,
			IPACK1_DEVICE_ID_SBS_OCTAL_485) },
	{ 0, },
};

MODULE_DEVICE_TABLE(ipack, ipoctal_ids);

714
static const struct ipack_driver_ops ipoctal_drv_ops = {
715
	.probe  = ipoctal_probe,
716 717 718
	.remove = ipoctal_remove,
};

719 720
static struct ipack_driver driver = {
	.ops      = &ipoctal_drv_ops,
721
	.id_table = ipoctal_ids,
722 723
};

724 725
static int __init ipoctal_init(void)
{
726
	return ipack_driver_register(&driver, THIS_MODULE, KBUILD_MODNAME);
727 728 729 730 731 732 733 734 735 736 737 738
}

static void __exit ipoctal_exit(void)
{
	ipack_driver_unregister(&driver);
}

MODULE_DESCRIPTION("IP-Octal 232, 422 and 485 device driver");
MODULE_LICENSE("GPL");

module_init(ipoctal_init);
module_exit(ipoctal_exit);