static int clps711x_probe(struct device_d *dev)
{
struct clps711x_uart *s;
char syscon_dev[18];
BUG_ON(dev->num_resources != 2);
BUG_ON((dev->id != 0) && (dev->id != 1));
s = xzalloc(sizeof(struct clps711x_uart));
s->uart_clk = clk_get(dev, NULL);
BUG_ON(IS_ERR(s->uart_clk));
s->UBRLCR = dev_get_mem_region(dev, 0);
s->UARTDR = dev_get_mem_region(dev, 1);
sprintf(syscon_dev, "clps711x-syscon%i", dev->id + 1);
s->syscon = syscon_base_lookup_by_pdevname(syscon_dev);
BUG_ON(IS_ERR(s->syscon));
dev->priv = s;
s->cdev.dev = dev;
s->cdev.f_caps = CONSOLE_STDIN | CONSOLE_STDOUT | CONSOLE_STDERR;
s->cdev.tstc = clps711x_tstc;
s->cdev.putc = clps711x_putc;
s->cdev.getc = clps711x_getc;
s->cdev.flush = clps711x_flush;
s->cdev.setbrg = clps711x_setbaudrate;
clps711x_init_port(&s->cdev);
return console_register(&s->cdev);
}
static int clps711x_probe(struct device_d *dev)
{
struct clps711x_uart *s;
int err, id = dev->id;
char syscon_dev[8];
if (dev->device_node)
id = of_alias_get_id(dev->device_node, "serial");
if (id != 0 && id != 1)
return -EINVAL;
s = xzalloc(sizeof(struct clps711x_uart));
s->uart_clk = clk_get(dev, NULL);
if (IS_ERR(s->uart_clk)) {
err = PTR_ERR(s->uart_clk);
goto out_err;
}
s->base = dev_get_mem_region(dev, 0);
if (!dev->device_node) {
sprintf(syscon_dev, "syscon%i", id + 1);
s->syscon = syscon_base_lookup_by_pdevname(syscon_dev);
} else {
s->syscon = syscon_base_lookup_by_phandle(dev->device_node,
"syscon");
}
if (IS_ERR(s->syscon)) {
err = PTR_ERR(s->syscon);
goto out_err;
}
dev->priv = s;
s->cdev.dev = dev;
s->cdev.tstc = clps711x_tstc;
s->cdev.putc = clps711x_putc;
s->cdev.getc = clps711x_getc;
s->cdev.flush = clps711x_flush;
s->cdev.setbrg = clps711x_setbaudrate;
clps711x_init_port(&s->cdev);
err = console_register(&s->cdev);
out_err:
if (err)
free(s);
return err;
}
static int gfar_tbiphy_probe(struct device_d *dev)
{
struct gfar_phy *phy;
int ret;
phy = xzalloc(sizeof(*phy));
phy->dev = dev;
phy->regs = dev_get_mem_region(dev, 0);
if (IS_ERR(phy->regs))
return PTR_ERR(phy->regs);
phy->miibus.read = gfar_miiphy_read;
phy->miibus.write = gfar_miiphy_write;
phy->miibus.priv = phy;
phy->miibus.parent = dev;
dev->priv = phy;
ret = mdiobus_register(&phy->miibus);
if (ret)
return ret;
return 0;
}
static int mvebu_mdio_probe(struct device_d *dev)
{
struct mdio_priv *priv;
priv = xzalloc(sizeof(*priv));
dev->priv = priv;
priv->regs = dev_get_mem_region(dev, 0);
if (!priv->regs)
return -ENOMEM;
priv->clk = clk_get(dev, NULL);
if (!IS_ERR(priv->clk))
clk_enable(priv->clk);
priv->miibus.dev.device_node = dev->device_node;
priv->miibus.priv = priv;
priv->miibus.parent = dev;
priv->miibus.read = mvebu_mdio_read;
priv->miibus.write = mvebu_mdio_write;
return mdiobus_register(&priv->miibus);
}
/*
* Initialize device structure. Returns success if
* initialization succeeded.
*/
static int gfar_probe(struct device_d *dev)
{
struct gfar_info_struct *gfar_info = dev->platform_data;
struct eth_device *edev;
struct gfar_private *priv;
struct device_d *mdev;
size_t size;
char devname[16];
char *p;
priv = xzalloc(sizeof(struct gfar_private));
edev = &priv->edev;
priv->mdiobus_tbi = gfar_info->mdiobus_tbi;
priv->regs = dev_get_mem_region(dev, 0);
if (IS_ERR(priv->regs))
return PTR_ERR(priv->regs);
priv->phyaddr = gfar_info->phyaddr;
priv->tbicr = gfar_info->tbicr;
priv->tbiana = gfar_info->tbiana;
mdev = get_device_by_name("gfar-mdio0");
if (mdev == NULL) {
pr_err("gfar-mdio0 was not found\n");
return -ENODEV;
}
priv->gfar_mdio = mdev->priv;
if (priv->mdiobus_tbi != 0) {
sprintf(devname, "%s%d", "gfar-tbiphy", priv->mdiobus_tbi);
mdev = get_device_by_name(devname);
if (mdev == NULL) {
pr_err("%s was not found\n", devname);
return -ENODEV;
}
}
priv->gfar_tbi = mdev->priv;
/*
* Allocate descriptors 64-bit aligned. Descriptors
* are 8 bytes in size.
*/
size = ((TX_BUF_CNT * sizeof(struct txbd8)) +
(RX_BUF_CNT * sizeof(struct rxbd8))) + BUF_ALIGN;
p = (char *)xmemalign(BUF_ALIGN, size);
priv->txbd = (struct txbd8 __iomem *)p;
priv->rxbd = (struct rxbd8 __iomem *)(p +
(TX_BUF_CNT * sizeof(struct txbd8)));
edev->priv = priv;
edev->init = gfar_init;
edev->open = gfar_open;
edev->halt = gfar_halt;
edev->send = gfar_send;
edev->recv = gfar_recv;
edev->get_ethaddr = gfar_get_ethaddr;
edev->set_ethaddr = gfar_set_ethaddr;
edev->parent = dev;
setbits_be32(priv->regs + GFAR_MACCFG1_OFFSET, GFAR_MACCFG1_SOFT_RESET);
udelay(2);
clrbits_be32(priv->regs + GFAR_MACCFG1_OFFSET, GFAR_MACCFG1_SOFT_RESET);
gfar_init_phy(edev);
return eth_register(edev);
}