| .. | .. |
|---|
| 1 | +// SPDX-License-Identifier: GPL-2.0-only |
|---|
| 1 | 2 | /* |
|---|
| 2 | 3 | * Copyright (C) 2014-2015 Pengutronix, Markus Pargmann <mpa@pengutronix.de> |
|---|
| 3 | | - * |
|---|
| 4 | | - * This program is free software; you can redistribute it and/or modify it under |
|---|
| 5 | | - * the terms of the GNU General Public License version 2 as published by the |
|---|
| 6 | | - * Free Software Foundation. |
|---|
| 7 | 4 | */ |
|---|
| 8 | 5 | |
|---|
| 9 | 6 | #include <linux/clk.h> |
|---|
| .. | .. |
|---|
| 72 | 69 | int irq; |
|---|
| 73 | 70 | |
|---|
| 74 | 71 | irq = platform_get_irq(pdev, 0); |
|---|
| 75 | | - if (irq <= 0) { |
|---|
| 76 | | - dev_err(dev, "Failed to get irq\n"); |
|---|
| 72 | + if (irq < 0) |
|---|
| 77 | 73 | return irq; |
|---|
| 78 | | - } |
|---|
| 79 | 74 | |
|---|
| 80 | 75 | tsadc->domain = irq_domain_add_simple(np, 2, 0, &mx25_tsadc_domain_ops, |
|---|
| 81 | 76 | tsadc); |
|---|
| .. | .. |
|---|
| 85 | 80 | } |
|---|
| 86 | 81 | |
|---|
| 87 | 82 | irq_set_chained_handler_and_data(irq, mx25_tsadc_irq_handler, tsadc); |
|---|
| 83 | + |
|---|
| 84 | + return 0; |
|---|
| 85 | +} |
|---|
| 86 | + |
|---|
| 87 | +static int mx25_tsadc_unset_irq(struct platform_device *pdev) |
|---|
| 88 | +{ |
|---|
| 89 | + struct mx25_tsadc *tsadc = platform_get_drvdata(pdev); |
|---|
| 90 | + int irq = platform_get_irq(pdev, 0); |
|---|
| 91 | + |
|---|
| 92 | + if (irq >= 0) { |
|---|
| 93 | + irq_set_chained_handler_and_data(irq, NULL, NULL); |
|---|
| 94 | + irq_domain_remove(tsadc->domain); |
|---|
| 95 | + } |
|---|
| 88 | 96 | |
|---|
| 89 | 97 | return 0; |
|---|
| 90 | 98 | } |
|---|
| .. | .. |
|---|
| 176 | 184 | |
|---|
| 177 | 185 | platform_set_drvdata(pdev, tsadc); |
|---|
| 178 | 186 | |
|---|
| 179 | | - return devm_of_platform_populate(dev); |
|---|
| 187 | + ret = devm_of_platform_populate(dev); |
|---|
| 188 | + if (ret) |
|---|
| 189 | + goto err_irq; |
|---|
| 190 | + |
|---|
| 191 | + return 0; |
|---|
| 192 | + |
|---|
| 193 | +err_irq: |
|---|
| 194 | + mx25_tsadc_unset_irq(pdev); |
|---|
| 195 | + |
|---|
| 196 | + return ret; |
|---|
| 180 | 197 | } |
|---|
| 181 | 198 | |
|---|
| 182 | 199 | static int mx25_tsadc_remove(struct platform_device *pdev) |
|---|
| 183 | 200 | { |
|---|
| 184 | | - struct mx25_tsadc *tsadc = platform_get_drvdata(pdev); |
|---|
| 185 | | - int irq = platform_get_irq(pdev, 0); |
|---|
| 186 | | - |
|---|
| 187 | | - if (irq) { |
|---|
| 188 | | - irq_set_chained_handler_and_data(irq, NULL, NULL); |
|---|
| 189 | | - irq_domain_remove(tsadc->domain); |
|---|
| 190 | | - } |
|---|
| 201 | + mx25_tsadc_unset_irq(pdev); |
|---|
| 191 | 202 | |
|---|
| 192 | 203 | return 0; |
|---|
| 193 | 204 | } |
|---|