|
| 1 | +From b1bcedb44c54a65a8e494158385eb23199572217 Mon Sep 17 00:00:00 2001 |
| 2 | +From: Phil Elwell < [email protected]> |
| 3 | +Date: Mon, 3 Feb 2025 14:51:52 +0000 |
| 4 | +Subject: [PATCH] firmware: rp1: Linger on firmware failure |
| 5 | + |
| 6 | +To avoid pointless retries, let the probe function succeed if the |
| 7 | +firmware interface is configured correctly but the firmware is |
| 8 | +incompatible. The value of the private drvdata field holds the outcome. |
| 9 | + |
| 10 | +Link: https://github.com/raspberrypi/linux/issues/6642 |
| 11 | + |
| 12 | +Signed-off-by: Phil Elwell < [email protected]> |
| 13 | +--- |
| 14 | + drivers/firmware/rp1.c | 28 ++++++++++++++-------------- |
| 15 | + 1 file changed, 14 insertions(+), 14 deletions(-) |
| 16 | + |
| 17 | +diff --git a/drivers/firmware/rp1.c b/drivers/firmware/rp1.c |
| 18 | +index 0b0760ca77764..a258452c8b33e 100644 |
| 19 | +--- a/drivers/firmware/rp1.c |
| 20 | ++++ b/drivers/firmware/rp1.c |
| 21 | +@@ -114,7 +114,8 @@ static void rp1_firmware_delete(struct kref *kref) |
| 22 | + |
| 23 | + void rp1_firmware_put(struct rp1_firmware *fw) |
| 24 | + { |
| 25 | +- kref_put(&fw->consumers, rp1_firmware_delete); |
| 26 | ++ if (!IS_ERR_OR_NULL(fw)) |
| 27 | ++ kref_put(&fw->consumers, rp1_firmware_delete); |
| 28 | + } |
| 29 | + EXPORT_SYMBOL_GPL(rp1_firmware_put); |
| 30 | + |
| 31 | +@@ -157,7 +158,7 @@ struct rp1_firmware *rp1_firmware_get(struct device_node *client) |
| 32 | + const char *match = rp1_firmware_of_match[0].compatible; |
| 33 | + struct platform_device *pdev; |
| 34 | + struct device_node *fwnode; |
| 35 | +- struct rp1_firmware *fw; |
| 36 | ++ struct rp1_firmware *fw = NULL; |
| 37 | + |
| 38 | + if (!client) |
| 39 | + return NULL; |
| 40 | +@@ -166,17 +167,17 @@ struct rp1_firmware *rp1_firmware_get(struct device_node *client) |
| 41 | + return NULL; |
| 42 | + if (!of_device_is_compatible(fwnode, match)) { |
| 43 | + of_node_put(fwnode); |
| 44 | +- return NULL; |
| 45 | ++ return ERR_PTR(-ENXIO); |
| 46 | + } |
| 47 | + |
| 48 | + pdev = of_find_device_by_node(fwnode); |
| 49 | + of_node_put(fwnode); |
| 50 | + |
| 51 | + if (!pdev) |
| 52 | +- goto err_exit; |
| 53 | ++ return ERR_PTR(-ENXIO); |
| 54 | + |
| 55 | + fw = platform_get_drvdata(pdev); |
| 56 | +- if (!fw) |
| 57 | ++ if (IS_ERR_OR_NULL(fw)) |
| 58 | + goto err_exit; |
| 59 | + |
| 60 | + if (!kref_get_unless_zero(&fw->consumers)) |
| 61 | +@@ -188,7 +189,7 @@ struct rp1_firmware *rp1_firmware_get(struct device_node *client) |
| 62 | + |
| 63 | + err_exit: |
| 64 | + put_device(&pdev->dev); |
| 65 | +- return NULL; |
| 66 | ++ return fw; |
| 67 | + } |
| 68 | + EXPORT_SYMBOL_GPL(rp1_firmware_get); |
| 69 | + |
| 70 | +@@ -204,8 +205,8 @@ struct rp1_firmware *devm_rp1_firmware_get(struct device *dev, struct device_nod |
| 71 | + int ret; |
| 72 | + |
| 73 | + fw = rp1_firmware_get(client); |
| 74 | +- if (!fw) |
| 75 | +- return NULL; |
| 76 | ++ if (IS_ERR_OR_NULL(fw)) |
| 77 | ++ return fw; |
| 78 | + |
| 79 | + ret = devm_add_action_or_reset(dev, devm_rp1_firmware_put, fw); |
| 80 | + if (ret) |
| 81 | +@@ -270,19 +271,18 @@ static int rp1_firmware_probe(struct platform_device *pdev) |
| 82 | + init_completion(&fw->c); |
| 83 | + kref_init(&fw->consumers); |
| 84 | + |
| 85 | +- platform_set_drvdata(pdev, fw); |
| 86 | +- |
| 87 | + ret = rp1_firmware_message(fw, GET_FIRMWARE_VERSION, |
| 88 | + NULL, 0, &version, sizeof(version)); |
| 89 | + if (ret == sizeof(version)) { |
| 90 | + dev_info(dev, "RP1 Firmware version %08x%08x%08x%08x%08x\n", |
| 91 | + version[0], version[1], version[2], version[3], version[4]); |
| 92 | +- ret = 0; |
| 93 | +- } else if (ret >= 0) { |
| 94 | +- ret = -EIO; |
| 95 | ++ platform_set_drvdata(pdev, fw); |
| 96 | ++ } else { |
| 97 | ++ rp1_firmware_put(fw); |
| 98 | ++ platform_set_drvdata(pdev, ERR_PTR(-ENOENT)); |
| 99 | + } |
| 100 | + |
| 101 | +- return ret; |
| 102 | ++ return 0; |
| 103 | + } |
| 104 | + |
| 105 | + static int rp1_firmware_remove(struct platform_device *pdev) |
0 commit comments