hollalinux
/
linux-sg2042
mirror of https://github.com/sophgo/linux-riscv.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

[SERIAL] sunsab: Convert to of_driver framework. 

Signed-off-by: David S. Miller <davem@davemloft.net>
This commit is contained in:
David S. Miller 2006-06-29 15:17:47 -07:00 committed by David S. Miller
parent 9efc3715f7
commit c4d37215a8
1 changed files with 153 additions and 164 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

317
drivers/serial/sunsab.c
View File

@ -1,7 +1,7 @@
/* sunsab.c: ASYNC Driver for the SIEMENS SAB82532 DUSCC. /* sunsab.c: ASYNC Driver for the SIEMENS SAB82532 DUSCC.
* *
* Copyright (C) 1997 Eddie C. Dost (ecd@skynet.be) * Copyright (C) 1997 Eddie C. Dost (ecd@skynet.be)
* Copyright (C) 2002 David S. Miller (davem@redhat.com) * Copyright (C) 2002, 2006 David S. Miller (davem@davemloft.net)
* *
* Rewrote buffer handling to use CIRC(Circular Buffer) macros. * Rewrote buffer handling to use CIRC(Circular Buffer) macros.
* Maxim Krasnyanskiy <maxk@qualcomm.com> * Maxim Krasnyanskiy <maxk@qualcomm.com>
@ -12,7 +12,7 @@
* Theodore Ts'o <tytso@mit.edu>, 2001-Oct-12 * Theodore Ts'o <tytso@mit.edu>, 2001-Oct-12
* *
* Ported to new 2.5.x UART layer. * Ported to new 2.5.x UART layer.
* David S. Miller <davem@redhat.com> * David S. Miller <davem@davemloft.net>
*/ */
#include <linux/config.h> #include <linux/config.h>
@ -37,8 +37,8 @@
#include <asm/io.h> #include <asm/io.h>
#include <asm/irq.h> #include <asm/irq.h>
#include <asm/oplib.h> #include <asm/prom.h>
#include <asm/ebus.h> #include <asm/of_device.h>
#if defined(CONFIG_SERIAL_SUNZILOG_CONSOLE) && defined(CONFIG_MAGIC_SYSRQ) #if defined(CONFIG_SERIAL_SUNZILOG_CONSOLE) && defined(CONFIG_MAGIC_SYSRQ)
#define SUPPORT_SYSRQ #define SUPPORT_SYSRQ
@ -976,199 +976,188 @@ static inline struct console *SUNSAB_CONSOLE(void)
#define sunsab_console_init() do { } while (0) #define sunsab_console_init() do { } while (0)
#endif #endif
static void __init for_each_sab_edev(void (*callback)(struct linux_ebus_device *, void *), void *arg) static int __init sunsab_init_one(struct uart_sunsab_port *up,
struct of_device *op,
unsigned long offset,
int line)
{ {
struct linux_ebus *ebus; up->port.line = line;
struct linux_ebus_device *edev = NULL; up->port.dev = &op->dev;
for_each_ebus(ebus) { up->port.mapbase = op->resource[0].start + offset;
for_each_ebusdev(edev, ebus) { up->port.membase = of_ioremap(&op->resource[0], offset,
if (!strcmp(edev->prom_node->name, "se")) { sizeof(union sab82532_async_regs),
callback(edev, arg); "sab");
continue; if (!up->port.membase)
} else if (!strcmp(edev->prom_node->name, "serial")) { return -ENOMEM;
char *compat; up->regs = (union sab82532_async_regs __iomem *) up->port.membase;
int clen;
/* On RIO this can be an SE, check it. We could up->port.irq = op->irqs[0];
* just check ebus->is_rio, but this is more portable.
*/ up->port.fifosize = SAB82532_XMIT_FIFO_SIZE;
compat = of_get_property(edev->prom_node, up->port.iotype = UPIO_MEM;
"compatible", &clen);
if (compat && clen > 0) { writeb(SAB82532_IPC_IC_ACT_LOW, &up->regs->w.ipc);
if (strncmp(compat, "sab82532", 8) == 0) {
callback(edev, arg); up->port.ops = &sunsab_pops;
continue; up->port.type = PORT_SUNSAB;
} up->port.uartclk = SAB_BASE_BAUD;
}
} up->type = readb(&up->regs->r.vstr) & 0x0f;
writeb(~((1 << 1) | (1 << 2) | (1 << 4)), &up->regs->w.pcr);
writeb(0xff, &up->regs->w.pim);
if ((up->port.line & 0x1) == 0) {
up->pvr_dsr_bit = (1 << 0);
up->pvr_dtr_bit = (1 << 1);
} else {
up->pvr_dsr_bit = (1 << 3);
up->pvr_dtr_bit = (1 << 2);
}
up->cached_pvr = (1 << 1) | (1 << 2) | (1 << 4);
writeb(up->cached_pvr, &up->regs->w.pvr);
up->cached_mode = readb(&up->regs->rw.mode);
up->cached_mode |= SAB82532_MODE_FRTS;
writeb(up->cached_mode, &up->regs->rw.mode);
up->cached_mode |= SAB82532_MODE_RTS;
writeb(up->cached_mode, &up->regs->rw.mode);
up->tec_timeout = SAB82532_MAX_TEC_TIMEOUT;
up->cec_timeout = SAB82532_MAX_CEC_TIMEOUT;
if (!(up->port.line & 0x01)) {
int err;
err = request_irq(up->port.irq, sunsab_interrupt,
SA_SHIRQ, "sab", up);
if (err) {
of_iounmap(up->port.membase,
sizeof(union sab82532_async_regs));
return err;
} }
} }
}
static void __init sab_count_callback(struct linux_ebus_device *edev, void *arg)
{
int *count_p = arg;
(*count_p)++;
}
static void __init sab_attach_callback(struct linux_ebus_device *edev, void *arg)
{
int *instance_p = arg;
struct uart_sunsab_port *up;
unsigned long regs, offset;
int i;
/* Note: ports are located in reverse order */
regs = edev->resource[0].start;
offset = sizeof(union sab82532_async_regs);
for (i = 0; i < 2; i++) {
up = &sunsab_ports[(*instance_p * 2) + 1 - i];
memset(up, 0, sizeof(*up));
up->regs = ioremap(regs + offset, sizeof(union sab82532_async_regs));
up->port.irq = edev->irqs[0];
up->port.fifosize = SAB82532_XMIT_FIFO_SIZE;
up->port.mapbase = (unsigned long)up->regs;
up->port.iotype = UPIO_MEM;
writeb(SAB82532_IPC_IC_ACT_LOW, &up->regs->w.ipc);
offset -= sizeof(union sab82532_async_regs);
}
(*instance_p)++;
}
static int __init probe_for_sabs(void)
{
int this_sab = 0;
/* Find device instances. */
for_each_sab_edev(&sab_count_callback, &this_sab);
if (!this_sab)
return -ENODEV;
/* Allocate tables. */
sunsab_ports = kmalloc(sizeof(struct uart_sunsab_port) * this_sab * 2,
GFP_KERNEL);
if (!sunsab_ports)
return -ENOMEM;
num_channels = this_sab * 2;
this_sab = 0;
for_each_sab_edev(&sab_attach_callback, &this_sab);
return 0; return 0;
} }
static void __init sunsab_init_hw(void) static int __devinit sab_probe(struct of_device *op, const struct of_device_id *match)
{ {
int i; static int inst;
struct uart_sunsab_port *up;
int err;
for (i = 0; i < num_channels; i++) { up = &sunsab_ports[inst * 2];
struct uart_sunsab_port *up = &sunsab_ports[i];
up->port.line = i; err = sunsab_init_one(&up[0], op,
up->port.ops = &sunsab_pops; sizeof(union sab82532_async_regs),
up->port.type = PORT_SUNSAB; (inst * 2) + 0);
up->port.uartclk = SAB_BASE_BAUD; if (err)
return err;
up->type = readb(&up->regs->r.vstr) & 0x0f; err = sunsab_init_one(&up[0], op, 0,
writeb(~((1 << 1) | (1 << 2) | (1 << 4)), &up->regs->w.pcr); (inst * 2) + 1);
writeb(0xff, &up->regs->w.pim); if (err) {
if (up->port.line == 0) { of_iounmap(up[0].port.membase,
up->pvr_dsr_bit = (1 << 0); sizeof(union sab82532_async_regs));
up->pvr_dtr_bit = (1 << 1); free_irq(up[0].port.irq, &up[0]);
} else { return err;
up->pvr_dsr_bit = (1 << 3);
up->pvr_dtr_bit = (1 << 2);
}
up->cached_pvr = (1 << 1) | (1 << 2) | (1 << 4);
writeb(up->cached_pvr, &up->regs->w.pvr);
up->cached_mode = readb(&up->regs->rw.mode);
up->cached_mode |= SAB82532_MODE_FRTS;
writeb(up->cached_mode, &up->regs->rw.mode);
up->cached_mode |= SAB82532_MODE_RTS;
writeb(up->cached_mode, &up->regs->rw.mode);
up->tec_timeout = SAB82532_MAX_TEC_TIMEOUT;
up->cec_timeout = SAB82532_MAX_CEC_TIMEOUT;
if (!(up->port.line & 0x01)) {
if (request_irq(up->port.irq, sunsab_interrupt,
SA_SHIRQ, "serial(sab82532)", up)) {
printk("sunsab%d: can't get IRQ %x\n",
i, up->port.irq);
continue;
}
}
} }
uart_add_one_port(&sunsab_reg, &up[0].port);
uart_add_one_port(&sunsab_reg, &up[1].port);
dev_set_drvdata(&op->dev, &up[0]);
inst++;
return 0;
} }
static void __devexit sab_remove_one(struct uart_sunsab_port *up)
{
uart_remove_one_port(&sunsab_reg, &up->port);
if (!(up->port.line & 1))
free_irq(up->port.irq, up);
of_iounmap(up->port.membase,
sizeof(union sab82532_async_regs));
}
static int __devexit sab_remove(struct of_device *op)
{
struct uart_sunsab_port *up = dev_get_drvdata(&op->dev);
sab_remove_one(&up[0]);
sab_remove_one(&up[1]);
dev_set_drvdata(&op->dev, NULL);
return 0;
}
static struct of_device_id sab_match[] = {
{
.name = "se",
},
{
.name = "serial",
.compatible = "sab82532",
},
{},
};
MODULE_DEVICE_TABLE(of, sab_match);
static struct of_platform_driver sab_driver = {
.name = "sab",
.match_table = sab_match,
.probe = sab_probe,
.remove = __devexit_p(sab_remove),
};
static int __init sunsab_init(void) static int __init sunsab_init(void)
{ {
int ret = probe_for_sabs(); struct device_node *dp;
int i; int err;
if (ret < 0) num_channels = 0;
return ret; for_each_node_by_name(dp, "su")
num_channels += 2;
for_each_node_by_name(dp, "serial") {
if (of_device_is_compatible(dp, "sab82532"))
num_channels += 2;
}
sunsab_init_hw(); if (num_channels) {
sunsab_ports = kzalloc(sizeof(struct uart_sunsab_port) *
num_channels, GFP_KERNEL);
if (!sunsab_ports)
return -ENOMEM;
sunsab_reg.minor = sunserial_current_minor; sunsab_reg.minor = sunserial_current_minor;
sunsab_reg.nr = num_channels; sunsab_reg.nr = num_channels;
ret = uart_register_driver(&sunsab_reg); err = uart_register_driver(&sunsab_reg);
if (ret < 0) { if (err) {
int i; kfree(sunsab_ports);
sunsab_ports = NULL;
for (i = 0; i < num_channels; i++) { return err;
struct uart_sunsab_port *up = &sunsab_ports[i];
if (!(up->port.line & 0x01))
free_irq(up->port.irq, up);
iounmap(up->regs);
} }
kfree(sunsab_ports);
sunsab_ports = NULL;
return ret; sunsab_reg.tty_driver->name_base = sunsab_reg.minor - 64;
sunsab_reg.cons = SUNSAB_CONSOLE();
sunserial_current_minor += num_channels;
} }
sunsab_reg.tty_driver->name_base = sunsab_reg.minor - 64; return of_register_driver(&sab_driver, &of_bus_type);
sunsab_reg.cons = SUNSAB_CONSOLE();
sunserial_current_minor += num_channels;
for (i = 0; i < num_channels; i++) {
struct uart_sunsab_port *up = &sunsab_ports[i];
uart_add_one_port(&sunsab_reg, &up->port);
}
return 0;
} }
static void __exit sunsab_exit(void) static void __exit sunsab_exit(void)
{ {
int i; of_unregister_driver(&sab_driver);
if (num_channels) {
for (i = 0; i < num_channels; i++) { sunserial_current_minor -= num_channels;
struct uart_sunsab_port *up = &sunsab_ports[i]; uart_unregister_driver(&sunsab_reg);
uart_remove_one_port(&sunsab_reg, &up->port);
if (!(up->port.line & 0x01))
free_irq(up->port.irq, up);
iounmap(up->regs);
} }
sunserial_current_minor -= num_channels;
uart_unregister_driver(&sunsab_reg);
kfree(sunsab_ports); kfree(sunsab_ports);
sunsab_ports = NULL; sunsab_ports = NULL;
} }