Commit 418441d9 authored by Wolfram Sang's avatar Wolfram Sang Committed by Grant Likely
Browse files

powerpc/mpc5200: fix error paths in PSC UART probe function



- error cases for mapbase and irq were unbundled
- mapped irq now gets disposed on error

Signed-off-by: default avatarWolfram Sang <w.sang@pengutronix.de>
Signed-off-by: default avatarGrant Likely <grant.likely@secretlab.ca>
parent aec739e0
Loading
Loading
Loading
Loading
+15 −8
Original line number Diff line number Diff line
@@ -1148,24 +1148,31 @@ mpc52xx_uart_of_probe(struct of_device *op, const struct of_device_id *match)
		return ret;

	port->mapbase = res.start;
	if (!port->mapbase) {
		dev_dbg(&op->dev, "Could not allocate resources for PSC\n");
		return -EINVAL;
	}

	port->irq = irq_of_parse_and_map(op->node, 0);
	if (port->irq == NO_IRQ) {
		dev_dbg(&op->dev, "Could not get irq\n");
		return -EINVAL;
	}

	dev_dbg(&op->dev, "mpc52xx-psc uart at %p, irq=%x, freq=%i\n",
		(void *)port->mapbase, port->irq, port->uartclk);

	if ((port->irq == NO_IRQ) || !port->mapbase) {
		printk(KERN_ERR "Could not allocate resources for PSC\n");
		return -EINVAL;
	}

	/* Add the port to the uart sub-system */
	ret = uart_add_one_port(&mpc52xx_uart_driver, port);
	if (!ret)
		dev_set_drvdata(&op->dev, (void *)port);

	if (ret) {
		irq_dispose_mapping(port->irq);
		return ret;
	}

	dev_set_drvdata(&op->dev, (void *)port);
	return 0;
}

static int
mpc52xx_uart_of_remove(struct of_device *op)
{