| .. | .. |
|---|
| 15 | 15 | #include <linux/of.h> |
|---|
| 16 | 16 | #include <linux/of_device.h> |
|---|
| 17 | 17 | #include <linux/platform_device.h> |
|---|
| 18 | | -#include <linux/pm_runtime.h> |
|---|
| 19 | 18 | #include <linux/slab.h> |
|---|
| 20 | 19 | |
|---|
| 21 | 20 | #include "hwspinlock_internal.h" |
|---|
| .. | .. |
|---|
| 79 | 78 | .relax = sprd_hwspinlock_relax, |
|---|
| 80 | 79 | }; |
|---|
| 81 | 80 | |
|---|
| 81 | +static void sprd_hwspinlock_disable(void *data) |
|---|
| 82 | +{ |
|---|
| 83 | + struct sprd_hwspinlock_dev *sprd_hwlock = data; |
|---|
| 84 | + |
|---|
| 85 | + clk_disable_unprepare(sprd_hwlock->clk); |
|---|
| 86 | +} |
|---|
| 87 | + |
|---|
| 82 | 88 | static int sprd_hwspinlock_probe(struct platform_device *pdev) |
|---|
| 83 | 89 | { |
|---|
| 84 | 90 | struct sprd_hwspinlock_dev *sprd_hwlock; |
|---|
| 85 | 91 | struct hwspinlock *lock; |
|---|
| 86 | | - struct resource *res; |
|---|
| 87 | 92 | int i, ret; |
|---|
| 88 | 93 | |
|---|
| 89 | 94 | if (!pdev->dev.of_node) |
|---|
| .. | .. |
|---|
| 96 | 101 | if (!sprd_hwlock) |
|---|
| 97 | 102 | return -ENOMEM; |
|---|
| 98 | 103 | |
|---|
| 99 | | - res = platform_get_resource(pdev, IORESOURCE_MEM, 0); |
|---|
| 100 | | - sprd_hwlock->base = devm_ioremap_resource(&pdev->dev, res); |
|---|
| 104 | + sprd_hwlock->base = devm_platform_ioremap_resource(pdev, 0); |
|---|
| 101 | 105 | if (IS_ERR(sprd_hwlock->base)) |
|---|
| 102 | 106 | return PTR_ERR(sprd_hwlock->base); |
|---|
| 103 | 107 | |
|---|
| .. | .. |
|---|
| 107 | 111 | return PTR_ERR(sprd_hwlock->clk); |
|---|
| 108 | 112 | } |
|---|
| 109 | 113 | |
|---|
| 110 | | - clk_prepare_enable(sprd_hwlock->clk); |
|---|
| 114 | + ret = clk_prepare_enable(sprd_hwlock->clk); |
|---|
| 115 | + if (ret) |
|---|
| 116 | + return ret; |
|---|
| 117 | + |
|---|
| 118 | + ret = devm_add_action_or_reset(&pdev->dev, sprd_hwspinlock_disable, |
|---|
| 119 | + sprd_hwlock); |
|---|
| 120 | + if (ret) { |
|---|
| 121 | + dev_err(&pdev->dev, |
|---|
| 122 | + "Failed to add hwspinlock disable action\n"); |
|---|
| 123 | + return ret; |
|---|
| 124 | + } |
|---|
| 111 | 125 | |
|---|
| 112 | 126 | /* set the hwspinlock to record user id to identify subsystems */ |
|---|
| 113 | 127 | writel(HWSPINLOCK_USER_BITS, sprd_hwlock->base + HWSPINLOCK_RECCTRL); |
|---|
| .. | .. |
|---|
| 118 | 132 | } |
|---|
| 119 | 133 | |
|---|
| 120 | 134 | platform_set_drvdata(pdev, sprd_hwlock); |
|---|
| 121 | | - pm_runtime_enable(&pdev->dev); |
|---|
| 122 | 135 | |
|---|
| 123 | | - ret = hwspin_lock_register(&sprd_hwlock->bank, &pdev->dev, |
|---|
| 124 | | - &sprd_hwspinlock_ops, 0, SPRD_HWLOCKS_NUM); |
|---|
| 125 | | - if (ret) { |
|---|
| 126 | | - pm_runtime_disable(&pdev->dev); |
|---|
| 127 | | - clk_disable_unprepare(sprd_hwlock->clk); |
|---|
| 128 | | - return ret; |
|---|
| 129 | | - } |
|---|
| 130 | | - |
|---|
| 131 | | - return 0; |
|---|
| 132 | | -} |
|---|
| 133 | | - |
|---|
| 134 | | -static int sprd_hwspinlock_remove(struct platform_device *pdev) |
|---|
| 135 | | -{ |
|---|
| 136 | | - struct sprd_hwspinlock_dev *sprd_hwlock = platform_get_drvdata(pdev); |
|---|
| 137 | | - |
|---|
| 138 | | - hwspin_lock_unregister(&sprd_hwlock->bank); |
|---|
| 139 | | - pm_runtime_disable(&pdev->dev); |
|---|
| 140 | | - clk_disable_unprepare(sprd_hwlock->clk); |
|---|
| 141 | | - return 0; |
|---|
| 136 | + return devm_hwspin_lock_register(&pdev->dev, &sprd_hwlock->bank, |
|---|
| 137 | + &sprd_hwspinlock_ops, 0, |
|---|
| 138 | + SPRD_HWLOCKS_NUM); |
|---|
| 142 | 139 | } |
|---|
| 143 | 140 | |
|---|
| 144 | 141 | static const struct of_device_id sprd_hwspinlock_of_match[] = { |
|---|
| .. | .. |
|---|
| 149 | 146 | |
|---|
| 150 | 147 | static struct platform_driver sprd_hwspinlock_driver = { |
|---|
| 151 | 148 | .probe = sprd_hwspinlock_probe, |
|---|
| 152 | | - .remove = sprd_hwspinlock_remove, |
|---|
| 153 | 149 | .driver = { |
|---|
| 154 | 150 | .name = "sprd_hwspinlock", |
|---|
| 155 | 151 | .of_match_table = of_match_ptr(sprd_hwspinlock_of_match), |
|---|