📄 serial_sicc.c
字号:
else retval = -ERESTARTSYS; break; } if (!(info->flags & ASYNC_CLOSING) && (do_clocal /*|| (UART_GET_FR(info->port) & SICC_UARTFR_DCD)*/)) break; if (signal_pending(current)) { retval = -ERESTARTSYS; break; } schedule(); } set_current_state(TASK_RUNNING); remove_wait_queue(&info->open_wait, &wait); if (extra_count) state->count++; info->blocked_open--; if (retval) return retval; info->flags |= ASYNC_NORMAL_ACTIVE; return 0;}static struct SICC_info *siccuart_get(int line){ struct SICC_info *info; struct SICC_state *state = sicc_state + line; state->count++; if (state->info) return state->info; info = kmalloc(sizeof(struct SICC_info), GFP_KERNEL); if (info) { memset(info, 0, sizeof(struct SICC_info)); init_waitqueue_head(&info->open_wait); init_waitqueue_head(&info->close_wait); init_waitqueue_head(&info->delta_msr_wait); info->flags = state->flags; info->state = state; info->port = sicc_ports + line; tasklet_init(&info->tlet, siccuart_tasklet_action, (unsigned long)info); } if (state->info) { kfree(info); return state->info; } state->info = info; return info;}static int siccuart_open(struct tty_struct *tty, struct file *filp){ struct SICC_info *info; int retval, line = tty->index; // is this a line that we've got? if (line >= SERIAL_SICC_NR) { return -ENODEV; } info = siccuart_get(line); if (!info) return -ENOMEM; tty->driver_data = info; info->tty = tty; info->tty->low_latency = (info->flags & ASYNC_LOW_LATENCY) ? 1 : 0; /* * Make sure we have the temporary buffer allocated */ if (!tmp_buf) { unsigned long page = get_zeroed_page(GFP_KERNEL); if (tmp_buf) free_page(page); else if (!page) { return -ENOMEM; } tmp_buf = (u_char *)page; } /* * If the port is in the middle of closing, bail out now. */ if (tty_hung_up_p(filp) || (info->flags & ASYNC_CLOSING)) { if (info->flags & ASYNC_CLOSING) interruptible_sleep_on(&info->close_wait); return -EAGAIN; } /* * Start up the serial port */ retval = siccuart_startup(info); if (retval) { return retval; } retval = block_til_ready(tty, filp, info); if (retval) { return retval; }#ifdef CONFIG_SERIAL_SICC_CONSOLE if (siccuart_cons.cflag && siccuart_cons.index == line) { tty->termios->c_cflag = siccuart_cons.cflag; siccuart_cons.cflag = 0; siccuart_change_speed(info, NULL); }#endif return 0;}static struct tty_operations sicc_ops = { .open = siccuart_open, .close = siccuart_close, .write = siccuart_write, .put_char = siccuart_put_char, .flush_chars = siccuart_flush_chars, .write_room = siccuart_write_room, .chars_in_buffer = siccuart_chars_in_buffer, .flush_buffer = siccuart_flush_buffer, .ioctl = siccuart_ioctl, .throttle = siccuart_throttle, .unthrottle = siccuart_unthrottle, .send_xchar = siccuart_send_xchar, .set_termios = siccuart_set_termios, .stop = siccuart_stop, .start = siccuart_start, .hangup = siccuart_hangup, .break_ctl = siccuart_break_ctl, .wait_until_sent = siccuart_wait_until_sent,};int __init siccuart_init(void){ int i; siccnormal_driver = alloc_tty_driver(SERIAL_SICC_NR); if (!siccnormal_driver) return -ENOMEM; printk("IBM Vesta SICC serial port driver V 0.1 by Yudong Yang and Yi Ge / IBM CRL .\n"); siccnormal_driver->driver_name = "serial_sicc"; siccnormal_driver->owner = THIS_MODULE; siccnormal_driver->name = SERIAL_SICC_NAME; siccnormal_driver->major = SERIAL_SICC_MAJOR; siccnormal_driver->minor_start = SERIAL_SICC_MINOR; siccnormal_driver->type = TTY_DRIVER_TYPE_SERIAL; siccnormal_driver->subtype = SERIAL_TYPE_NORMAL; siccnormal_driver->init_termios = tty_std_termios; siccnormal_driver->init_termios.c_cflag = B9600 | CS8 | CREAD | HUPCL | CLOCAL; siccnormal_driver->flags = TTY_DRIVER_REAL_RAW | TTY_DRIVER_NO_DEVFS; tty_set_operations(siccnormal_driver, &sicc_ops); if (tty_register_driver(siccnormal_driver)) panic("Couldn't register SICC serial driver\n"); for (i = 0; i < SERIAL_SICC_NR; i++) { struct SICC_state *state = sicc_state + i; state->line = i; state->close_delay = 5 * HZ / 10; state->closing_wait = 30 * HZ; spin_lock_init(&state->sicc_lock); } return 0;}__initcall(siccuart_init);#ifdef CONFIG_SERIAL_SICC_CONSOLE/************** console driver *****************//* * This code is currently never used; console->read is never called. * Therefore, although we have an implementation, we don't use it. * FIXME: the "const char *s" should be fixed to "char *s" some day. * (when the definition in include/linux/console.h is also fixed) */#ifdef used_and_not_const_char_pointerstatic int siccuart_console_read(struct console *co, const char *s, u_int count){ struct SICC_port *port = &sicc_ports[co->index]; unsigned int status; char *w; int c; pr_debug("siccuart_console_read() called\n"); c = 0; w = s; while (c < count) { if(readb(port->uart_base + BL_SICC_LSR) & _LSR_RBR_FULL) { *w++ = readb(port->uart_base + BL_SICC_RBR); c++; } else { // nothing more to get, return return c; } } // return the count return c;}#endif/* * Print a string to the serial port trying not to disturb * any possible real use of the port... * * The console_lock must be held when we get here. */static void siccuart_console_write(struct console *co, const char *s, u_int count){ struct SICC_port *port = &sicc_ports[co->index]; unsigned int old_cr; int i; /* * First save the CR then disable the interrupts */ old_cr = readb(port->uart_base + BL_SICC_TxCR); writeb(old_cr & ~_TxCR_DME_MASK, port->uart_base + BL_SICC_TxCR); /* * Now, do each character */ for (i = 0; i < count; i++) { while ((readb(port->uart_base + BL_SICC_LSR)&_LSR_TX_ALL) != _LSR_TX_ALL); writeb(s[i], port->uart_base + BL_SICC_TBR); if (s[i] == '\n') { while ((readb(port->uart_base + BL_SICC_LSR)&_LSR_TX_ALL) != _LSR_TX_ALL); writeb('\r', port->uart_base + BL_SICC_TBR); } } /* * Finally, wait for transmitter to become empty * and restore the TCR */ while ((readb(port->uart_base + BL_SICC_LSR)&_LSR_TX_ALL) != _LSR_TX_ALL); writeb(old_cr, port->uart_base + BL_SICC_TxCR);}/* * Receive character from the serial port */static int siccuart_console_wait_key(struct console *co){ struct SICC_port *port = &sicc_ports[co->index]; int c; while(!(readb(port->uart_base + BL_SICC_LSR) & _LSR_RBR_FULL)); c = readb(port->uart_base + BL_SICC_RBR); return c;}static struct tty_driver *siccuart_console_device(struct console *c, int *index){ *index = c->index; return siccnormal_driver;}static int __init siccuart_console_setup(struct console *co, char *options){ struct SICC_port *port; int baud = 9600; int bits = 8; int parity = 'n'; u_int cflag = CREAD | HUPCL | CLOCAL; u_int lcr_h, quot; if (co->index >= SERIAL_SICC_NR) co->index = 0; port = &sicc_ports[co->index]; if (port->uart_base == 0) port->uart_base = (int)ioremap(port->uart_base_phys, PAGE_SIZE); if (options) { char *s = options; baud = simple_strtoul(s, NULL, 10); while (*s >= '0' && *s <= '9') s++; if (*s) parity = *s++; if (*s) bits = *s - '0'; } /* * Now construct a cflag setting. */ switch (baud) { case 1200: cflag |= B1200; break; case 2400: cflag |= B2400; break; case 4800: cflag |= B4800; break; default: cflag |= B9600; baud = 9600; break; case 19200: cflag |= B19200; break; case 38400: cflag |= B38400; break; case 57600: cflag |= B57600; break; case 115200: cflag |= B115200; break; } switch (bits) { case 7: cflag |= CS7; lcr_h = _LCR_PE_DISABLE | _LCR_DB_7_BITS | _LCR_SB_1_BIT; break; default: cflag |= CS8; lcr_h = _LCR_PE_DISABLE | _LCR_DB_8_BITS | _LCR_SB_1_BIT; break; } switch (parity) { case 'o': case 'O': cflag |= PARODD; lcr_h |= _LCR_PTY_ODD; break; case 'e': case 'E': cflag |= PARENB; lcr_h |= _LCR_PE_ENABLE | _LCR_PTY_ODD; break; } co->cflag = cflag; { // a copy of is inserted here ppc403SetBaud(com_port, (int)9600); unsigned long divisor, clockSource, temp; unsigned int rate = baud; /* Ensure CICCR[7] is 0 to select Internal Baud Clock */ powerpcMtcic_cr((unsigned long)(powerpcMfcic_cr() & 0xFEFFFFFF)); /* Determine Internal Baud Clock Frequency */ /* powerpcMfclkgpcr() reads DCR 0x120 - the*/ /* SCCR (Serial Clock Control Register) on Vesta */ temp = powerpcMfclkgpcr(); if(temp & 0x00000080) { clockSource = 324000000; } else { clockSource = 216000000; } clockSource = clockSource/(unsigned long)((temp&0x00FC0000)>>18); divisor = clockSource/(16*rate) - 1; /* divisor has only 12 bits of resolution */ if(divisor>0x00000FFF){ divisor=0x00000FFF; } quot = divisor; } writeb((quot & 0x00000F00)>>8, port->uart_base + BL_SICC_BRDH ); writeb( quot & 0x00000FF, port->uart_base + BL_SICC_BRDL ); /* Set CTL2 reg to use external clock (ExtClk) and enable FIFOs. */ /* For now, do NOT use FIFOs since 403 UART did not have this */ /* capability and this driver was inherited from 403UART. */ writeb(_CTL2_EXTERN, port->uart_base + BL_SICC_CTL2); writeb(lcr_h, port->uart_base + BL_SICC_LCR); writeb(_RCR_ER_ENABLE | _RCR_PME_HARD, port->uart_base + BL_SICC_RCR); writeb( _TxCR_ET_ENABLE , port->uart_base + BL_SICC_TxCR); // writeb(, info->port->uart_base + BL_SICC_RCR ); /* * Transmitter Command Register: Transmitter enabled & DMA + TBR interrupt * + Transmitter Empty interrupt + Transmitter error interrupt disabled & * Stop mode when CTS active enabled & Transmit Break + Pattern Generation * mode disabled. */ writeb( 0x00, port->uart_base + BL_SICC_IrCR ); // disable IrDA readb(port->uart_base + BL_SICC_RBR); writeb(0xf8, port->uart_base + BL_SICC_LSR); /* reset bits 0-4 of LSR */ /* we will enable the port as we need it */ return 0;}static struct console siccuart_cons ={ .name = SERIAL_SICC_NAME, .write = siccuart_console_write,#ifdef used_and_not_const_char_pointer .read = siccuart_console_read,#endif .device = siccuart_console_device, .wait_key = siccuart_console_wait_key, .setup = siccuart_console_setup, .flags = CON_PRINTBUFFER, .index = -1,};void __init sicc_console_init(void){ register_console(&siccuart_cons);}#endif /* CONFIG_SERIAL_SICC_CONSOLE */
⌨️ 快捷键说明
复制代码
Ctrl + C
搜索代码
Ctrl + F
全屏模式
F11
切换主题
Ctrl + Shift + D
显示快捷键
?
增大字号
Ctrl + =
减小字号
Ctrl + -