天天看點

module_init(s3c24xx_serial_modinit);

static struct uart_driver s3c24xx_uart_drv = {

    .owner        = THIS_MODULE,

    .driver_name    = "s3c2410_serial",

    .nr        = CONFIG_SERIAL_SAMSUNG_UARTS,

    .cons        = S3C24XX_SERIAL_CONSOLE,

    .dev_name    = S3C24XX_SERIAL_NAME,

    .major        = S3C24XX_SERIAL_MAJOR,

    .minor        = S3C24XX_SERIAL_MINOR,

};

int uart_register_driver(struct uart_driver *drv)

{

    struct tty_driver *normal;

    int i, retval;

    BUG_ON(drv->state);

    drv->state = kzalloc(sizeof(struct uart_state) * drv->nr, GFP_KERNEL);

    if (!drv->state)

        goto out;

    normal = alloc_tty_driver(drv->nr);

    if (!normal)

        goto out_kfree;

    drv->tty_driver = normal;

    normal->owner        = drv->owner;

    normal->driver_name    = drv->driver_name;

    normal->name        = drv->dev_name;

    normal->major        = drv->major;

    normal->minor_start    = drv->minor;

    normal->type        = TTY_DRIVER_TYPE_SERIAL;

    normal->subtype        = SERIAL_TYPE_NORMAL;

    normal->init_termios    = tty_std_termios;

    normal->init_termios.c_cflag = B9600 | CS8 | CREAD | HUPCL | CLOCAL;

    normal->init_termios.c_ispeed = normal->init_termios.c_ospeed = 9600;

    normal->flags        = TTY_DRIVER_REAL_RAW | TTY_DRIVER_DYNAMIC_DEV;

    normal->driver_state    = drv;

    tty_set_operations(normal, &uart_ops);

    for (i = 0; i < drv->nr; i++) {

        struct uart_state *state = drv->state + i;

        struct tty_port *port = &state->port;

        tty_port_init(port);

        port->ops = &uart_port_ops;

        port->close_delay     = 500;    

        port->closing_wait    = 30000;    

        tasklet_init(&state->tlet, uart_tasklet_action,

                 (unsigned long)state);

    }

    retval = tty_register_driver(normal);

    if (retval >= 0)

        return retval;

    put_tty_driver(normal);

out_kfree:

    kfree(drv->state);

out:

    return -ENOMEM;

}

static int __init s3c24xx_serial_modinit(void)

{

    int ret;

    ret = uart_register_driver(&s3c24xx_uart_drv);

    if (ret < 0) {

        printk(KERN_ERR "failed to register UART driver\n");

        return -1;

    }

    return 0;

}

module_init(s3c24xx_serial_modinit);

繼續閱讀