Commit 2b2e71fe authored by Michael Walle's avatar Michael Walle Committed by Greg Kroah-Hartman

tty: serial: fsl_lpuart: free IDs allocated by IDA

Since commit 3bc3206e ("serial: fsl_lpuart: Remove the alias node
dependence") the port line number can also be allocated by IDA, but in
case of an error the ID will no be removed again. More importantly, any
ID will be freed in remove(), even if it wasn't allocated but instead
fetched by of_alias_get_id(). If it was not allocated by IDA there will
be a warning:
  WARN(1, "ida_free called for id=%d which is not allocated.\n", id);

Move the ID allocation more to the end of the probe() so that we still
can use plain return in the first error cases.

Fixes: 3bc3206e ("serial: fsl_lpuart: Remove the alias node dependence")
Signed-off-by: default avatarMichael Walle <michael@walle.cc>
Cc: stable <stable@vger.kernel.org>
Link: https://lore.kernel.org/r/20200303174306.6015-3-michael@walle.ccSigned-off-by: default avatarGreg Kroah-Hartman <gregkh@linuxfoundation.org>
parent 0e28ed6c
...@@ -264,6 +264,7 @@ struct lpuart_port { ...@@ -264,6 +264,7 @@ struct lpuart_port {
int rx_dma_rng_buf_len; int rx_dma_rng_buf_len;
unsigned int dma_tx_nents; unsigned int dma_tx_nents;
wait_queue_head_t dma_wait; wait_queue_head_t dma_wait;
bool id_allocated;
}; };
struct lpuart_soc_data { struct lpuart_soc_data {
...@@ -2422,19 +2423,6 @@ static int lpuart_probe(struct platform_device *pdev) ...@@ -2422,19 +2423,6 @@ static int lpuart_probe(struct platform_device *pdev)
if (!sport) if (!sport)
return -ENOMEM; return -ENOMEM;
ret = of_alias_get_id(np, "serial");
if (ret < 0) {
ret = ida_simple_get(&fsl_lpuart_ida, 0, UART_NR, GFP_KERNEL);
if (ret < 0) {
dev_err(&pdev->dev, "port line is full, add device failed\n");
return ret;
}
}
if (ret >= ARRAY_SIZE(lpuart_ports)) {
dev_err(&pdev->dev, "serial%d out of range\n", ret);
return -EINVAL;
}
sport->port.line = ret;
res = platform_get_resource(pdev, IORESOURCE_MEM, 0); res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
sport->port.membase = devm_ioremap_resource(&pdev->dev, res); sport->port.membase = devm_ioremap_resource(&pdev->dev, res);
if (IS_ERR(sport->port.membase)) if (IS_ERR(sport->port.membase))
...@@ -2479,9 +2467,25 @@ static int lpuart_probe(struct platform_device *pdev) ...@@ -2479,9 +2467,25 @@ static int lpuart_probe(struct platform_device *pdev)
} }
} }
ret = of_alias_get_id(np, "serial");
if (ret < 0) {
ret = ida_simple_get(&fsl_lpuart_ida, 0, UART_NR, GFP_KERNEL);
if (ret < 0) {
dev_err(&pdev->dev, "port line is full, add device failed\n");
return ret;
}
sport->id_allocated = true;
}
if (ret >= ARRAY_SIZE(lpuart_ports)) {
dev_err(&pdev->dev, "serial%d out of range\n", ret);
ret = -EINVAL;
goto failed_out_of_range;
}
sport->port.line = ret;
ret = lpuart_enable_clks(sport); ret = lpuart_enable_clks(sport);
if (ret) if (ret)
return ret; goto failed_clock_enable;
sport->port.uartclk = lpuart_get_baud_clk_rate(sport); sport->port.uartclk = lpuart_get_baud_clk_rate(sport);
lpuart_ports[sport->port.line] = sport; lpuart_ports[sport->port.line] = sport;
...@@ -2531,6 +2535,10 @@ static int lpuart_probe(struct platform_device *pdev) ...@@ -2531,6 +2535,10 @@ static int lpuart_probe(struct platform_device *pdev)
failed_attach_port: failed_attach_port:
failed_irq_request: failed_irq_request:
lpuart_disable_clks(sport); lpuart_disable_clks(sport);
failed_clock_enable:
failed_out_of_range:
if (sport->id_allocated)
ida_simple_remove(&fsl_lpuart_ida, sport->port.line);
return ret; return ret;
} }
...@@ -2540,6 +2548,7 @@ static int lpuart_remove(struct platform_device *pdev) ...@@ -2540,6 +2548,7 @@ static int lpuart_remove(struct platform_device *pdev)
uart_remove_one_port(&lpuart_reg, &sport->port); uart_remove_one_port(&lpuart_reg, &sport->port);
if (sport->id_allocated)
ida_simple_remove(&fsl_lpuart_ida, sport->port.line); ida_simple_remove(&fsl_lpuart_ida, sport->port.line);
lpuart_disable_clks(sport); lpuart_disable_clks(sport);
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment