Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 1 | /* |
Vadim Pasternak | 1f976f6 | 2018-01-17 18:21:53 +0000 | [diff] [blame] | 2 | * Copyright (c) 2016-2018 Mellanox Technologies. All rights reserved. |
| 3 | * Copyright (c) 2016-2018 Vadim Pasternak <vadimp@mellanox.com> |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 4 | * |
| 5 | * Redistribution and use in source and binary forms, with or without |
| 6 | * modification, are permitted provided that the following conditions are met: |
| 7 | * |
| 8 | * 1. Redistributions of source code must retain the above copyright |
| 9 | * notice, this list of conditions and the following disclaimer. |
| 10 | * 2. Redistributions in binary form must reproduce the above copyright |
| 11 | * notice, this list of conditions and the following disclaimer in the |
| 12 | * documentation and/or other materials provided with the distribution. |
| 13 | * 3. Neither the names of the copyright holders nor the names of its |
| 14 | * contributors may be used to endorse or promote products derived from |
| 15 | * this software without specific prior written permission. |
| 16 | * |
| 17 | * Alternatively, this software may be distributed under the terms of the |
| 18 | * GNU General Public License ("GPL") version 2 as published by the Free |
| 19 | * Software Foundation. |
| 20 | * |
| 21 | * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" |
| 22 | * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE |
| 23 | * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE |
| 24 | * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE |
| 25 | * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR |
| 26 | * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF |
| 27 | * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS |
| 28 | * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN |
| 29 | * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) |
| 30 | * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE |
| 31 | * POSSIBILITY OF SUCH DAMAGE. |
| 32 | */ |
| 33 | |
| 34 | #include <linux/bitops.h> |
| 35 | #include <linux/device.h> |
| 36 | #include <linux/hwmon.h> |
| 37 | #include <linux/hwmon-sysfs.h> |
| 38 | #include <linux/i2c.h> |
| 39 | #include <linux/interrupt.h> |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 40 | #include <linux/module.h> |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 41 | #include <linux/of_device.h> |
Vadim Pasternak | 1f976f6 | 2018-01-17 18:21:53 +0000 | [diff] [blame] | 42 | #include <linux/platform_data/mlxreg.h> |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 43 | #include <linux/platform_device.h> |
| 44 | #include <linux/spinlock.h> |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 45 | #include <linux/regmap.h> |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 46 | #include <linux/workqueue.h> |
| 47 | |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 48 | /* Offset of event and mask registers from status register. */ |
Vadim Pasternak | 1f976f6 | 2018-01-17 18:21:53 +0000 | [diff] [blame] | 49 | #define MLXREG_HOTPLUG_EVENT_OFF 1 |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 50 | #define MLXREG_HOTPLUG_MASK_OFF 2 |
Vadim Pasternak | 1f976f6 | 2018-01-17 18:21:53 +0000 | [diff] [blame] | 51 | #define MLXREG_HOTPLUG_AGGR_MASK_OFF 1 |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 52 | |
Vadim Pasternak | 66342d1 | 2018-07-26 22:40:58 +0000 | [diff] [blame] | 53 | /* ASIC good health mask. */ |
| 54 | #define MLXREG_HOTPLUG_GOOD_HEALTH_MASK 0x02 |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 55 | |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 56 | #define MLXREG_HOTPLUG_ATTRS_MAX 24 |
Vadim Pasternak | 4b5e32d | 2018-05-07 06:48:51 +0000 | [diff] [blame] | 57 | #define MLXREG_HOTPLUG_NOT_ASSERT 3 |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 58 | |
| 59 | /** |
Vadim Pasternak | 1f976f6 | 2018-01-17 18:21:53 +0000 | [diff] [blame] | 60 | * struct mlxreg_hotplug_priv_data - platform private data: |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 61 | * @irq: platform device interrupt number; |
Vadim Pasternak | 321089a | 2018-03-27 10:02:02 +0000 | [diff] [blame] | 62 | * @dev: basic device; |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 63 | * @pdev: platform device; |
| 64 | * @plat: platform data; |
Vadim Pasternak | 321089a | 2018-03-27 10:02:02 +0000 | [diff] [blame] | 65 | * @regmap: register map handle; |
| 66 | * @dwork_irq: delayed work template; |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 67 | * @lock: spin lock; |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 68 | * @hwmon: hwmon device; |
Vadim Pasternak | 1f976f6 | 2018-01-17 18:21:53 +0000 | [diff] [blame] | 69 | * @mlxreg_hotplug_attr: sysfs attributes array; |
| 70 | * @mlxreg_hotplug_dev_attr: sysfs sensor device attribute array; |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 71 | * @group: sysfs attribute group; |
| 72 | * @groups: list of sysfs attribute group for hwmon registration; |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 73 | * @cell: location of top aggregation interrupt register; |
| 74 | * @mask: top aggregation interrupt common mask; |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 75 | * @aggr_cache: last value of aggregation register status; |
Vadim Pasternak | 321089a | 2018-03-27 10:02:02 +0000 | [diff] [blame] | 76 | * @after_probe: flag indication probing completion; |
Vadim Pasternak | 4b5e32d | 2018-05-07 06:48:51 +0000 | [diff] [blame] | 77 | * @not_asserted: number of entries in workqueue with no signal assertion; |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 78 | */ |
Vadim Pasternak | 1f976f6 | 2018-01-17 18:21:53 +0000 | [diff] [blame] | 79 | struct mlxreg_hotplug_priv_data { |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 80 | int irq; |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 81 | struct device *dev; |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 82 | struct platform_device *pdev; |
Vadim Pasternak | 1f976f6 | 2018-01-17 18:21:53 +0000 | [diff] [blame] | 83 | struct mlxreg_hotplug_platform_data *plat; |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 84 | struct regmap *regmap; |
| 85 | struct delayed_work dwork_irq; |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 86 | spinlock_t lock; /* sync with interrupt */ |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 87 | struct device *hwmon; |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 88 | struct attribute *mlxreg_hotplug_attr[MLXREG_HOTPLUG_ATTRS_MAX + 1]; |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 89 | struct sensor_device_attribute_2 |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 90 | mlxreg_hotplug_dev_attr[MLXREG_HOTPLUG_ATTRS_MAX]; |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 91 | struct attribute_group group; |
| 92 | const struct attribute_group *groups[2]; |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 93 | u32 cell; |
| 94 | u32 mask; |
| 95 | u32 aggr_cache; |
| 96 | bool after_probe; |
Vadim Pasternak | 4b5e32d | 2018-05-07 06:48:51 +0000 | [diff] [blame] | 97 | u8 not_asserted; |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 98 | }; |
| 99 | |
Vadim Pasternak | f709e1b | 2018-02-13 22:09:35 +0000 | [diff] [blame] | 100 | static int mlxreg_hotplug_device_create(struct mlxreg_hotplug_priv_data *priv, |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 101 | struct mlxreg_core_data *data) |
Vadim Pasternak | 752849e | 2018-01-22 18:50:20 -0800 | [diff] [blame] | 102 | { |
Vadim Pasternak | ef0f622 | 2018-02-13 22:09:36 +0000 | [diff] [blame] | 103 | struct mlxreg_core_hotplug_platform_data *pdata; |
| 104 | |
Vadim Pasternak | 9272d2d | 2018-07-26 22:40:59 +0000 | [diff] [blame] | 105 | /* Notify user by sending hwmon uevent. */ |
| 106 | kobject_uevent(&priv->hwmon->kobj, KOBJ_CHANGE); |
| 107 | |
Vadim Pasternak | 7805fa8d | 2018-01-26 19:03:45 +0000 | [diff] [blame] | 108 | /* |
| 109 | * Return if adapter number is negative. It could be in case hotplug |
| 110 | * event is not associated with hotplug device. |
| 111 | */ |
| 112 | if (data->hpdev.nr < 0) |
| 113 | return 0; |
| 114 | |
Vadim Pasternak | ef0f622 | 2018-02-13 22:09:36 +0000 | [diff] [blame] | 115 | pdata = dev_get_platdata(&priv->pdev->dev); |
| 116 | data->hpdev.adapter = i2c_get_adapter(data->hpdev.nr + |
| 117 | pdata->shift_nr); |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 118 | if (!data->hpdev.adapter) { |
Vadim Pasternak | f709e1b | 2018-02-13 22:09:35 +0000 | [diff] [blame] | 119 | dev_err(priv->dev, "Failed to get adapter for bus %d\n", |
Vadim Pasternak | ef0f622 | 2018-02-13 22:09:36 +0000 | [diff] [blame] | 120 | data->hpdev.nr + pdata->shift_nr); |
Vadim Pasternak | 752849e | 2018-01-22 18:50:20 -0800 | [diff] [blame] | 121 | return -EFAULT; |
| 122 | } |
| 123 | |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 124 | data->hpdev.client = i2c_new_device(data->hpdev.adapter, |
| 125 | data->hpdev.brdinfo); |
| 126 | if (!data->hpdev.client) { |
Vadim Pasternak | f709e1b | 2018-02-13 22:09:35 +0000 | [diff] [blame] | 127 | dev_err(priv->dev, "Failed to create client %s at bus %d at addr 0x%02x\n", |
Vadim Pasternak | ef0f622 | 2018-02-13 22:09:36 +0000 | [diff] [blame] | 128 | data->hpdev.brdinfo->type, data->hpdev.nr + |
| 129 | pdata->shift_nr, data->hpdev.brdinfo->addr); |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 130 | |
| 131 | i2c_put_adapter(data->hpdev.adapter); |
| 132 | data->hpdev.adapter = NULL; |
Vadim Pasternak | 752849e | 2018-01-22 18:50:20 -0800 | [diff] [blame] | 133 | return -EFAULT; |
| 134 | } |
| 135 | |
| 136 | return 0; |
| 137 | } |
| 138 | |
Vadim Pasternak | 9272d2d | 2018-07-26 22:40:59 +0000 | [diff] [blame] | 139 | static void |
| 140 | mlxreg_hotplug_device_destroy(struct mlxreg_hotplug_priv_data *priv, |
| 141 | struct mlxreg_core_data *data) |
Vadim Pasternak | 752849e | 2018-01-22 18:50:20 -0800 | [diff] [blame] | 142 | { |
Vadim Pasternak | 9272d2d | 2018-07-26 22:40:59 +0000 | [diff] [blame] | 143 | /* Notify user by sending hwmon uevent. */ |
| 144 | kobject_uevent(&priv->hwmon->kobj, KOBJ_CHANGE); |
| 145 | |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 146 | if (data->hpdev.client) { |
| 147 | i2c_unregister_device(data->hpdev.client); |
| 148 | data->hpdev.client = NULL; |
Vadim Pasternak | 752849e | 2018-01-22 18:50:20 -0800 | [diff] [blame] | 149 | } |
| 150 | |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 151 | if (data->hpdev.adapter) { |
| 152 | i2c_put_adapter(data->hpdev.adapter); |
| 153 | data->hpdev.adapter = NULL; |
Vadim Pasternak | 752849e | 2018-01-22 18:50:20 -0800 | [diff] [blame] | 154 | } |
| 155 | } |
| 156 | |
Vadim Pasternak | 1f976f6 | 2018-01-17 18:21:53 +0000 | [diff] [blame] | 157 | static ssize_t mlxreg_hotplug_attr_show(struct device *dev, |
| 158 | struct device_attribute *attr, |
| 159 | char *buf) |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 160 | { |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 161 | struct mlxreg_hotplug_priv_data *priv = dev_get_drvdata(dev); |
| 162 | struct mlxreg_core_hotplug_platform_data *pdata; |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 163 | int index = to_sensor_dev_attr_2(attr)->index; |
| 164 | int nr = to_sensor_dev_attr_2(attr)->nr; |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 165 | struct mlxreg_core_item *item; |
| 166 | struct mlxreg_core_data *data; |
| 167 | u32 regval; |
| 168 | int ret; |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 169 | |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 170 | pdata = dev_get_platdata(&priv->pdev->dev); |
| 171 | item = pdata->items + nr; |
| 172 | data = item->data + index; |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 173 | |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 174 | ret = regmap_read(priv->regmap, data->reg, ®val); |
| 175 | if (ret) |
| 176 | return ret; |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 177 | |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 178 | if (item->health) { |
| 179 | regval &= data->mask; |
| 180 | } else { |
| 181 | /* Bit = 0 : functional if item->inversed is true. */ |
| 182 | if (item->inversed) |
| 183 | regval = !(regval & data->mask); |
| 184 | else |
| 185 | regval = !!(regval & data->mask); |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 186 | } |
| 187 | |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 188 | return sprintf(buf, "%u\n", regval); |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 189 | } |
| 190 | |
Vadim Pasternak | 1f976f6 | 2018-01-17 18:21:53 +0000 | [diff] [blame] | 191 | #define PRIV_ATTR(i) priv->mlxreg_hotplug_attr[i] |
| 192 | #define PRIV_DEV_ATTR(i) priv->mlxreg_hotplug_dev_attr[i] |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 193 | |
Vadim Pasternak | 1f976f6 | 2018-01-17 18:21:53 +0000 | [diff] [blame] | 194 | static int mlxreg_hotplug_attr_init(struct mlxreg_hotplug_priv_data *priv) |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 195 | { |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 196 | struct mlxreg_core_hotplug_platform_data *pdata; |
| 197 | struct mlxreg_core_item *item; |
| 198 | struct mlxreg_core_data *data; |
| 199 | int num_attrs = 0, id = 0, i, j; |
| 200 | |
| 201 | pdata = dev_get_platdata(&priv->pdev->dev); |
| 202 | item = pdata->items; |
| 203 | |
| 204 | /* Go over all kinds of items - psu, pwr, fan. */ |
| 205 | for (i = 0; i < pdata->counter; i++, item++) { |
| 206 | num_attrs += item->count; |
| 207 | data = item->data; |
| 208 | /* Go over all units within the item. */ |
| 209 | for (j = 0; j < item->count; j++, data++, id++) { |
| 210 | PRIV_ATTR(id) = &PRIV_DEV_ATTR(id).dev_attr.attr; |
| 211 | PRIV_ATTR(id)->name = devm_kasprintf(&priv->pdev->dev, |
| 212 | GFP_KERNEL, |
| 213 | data->label); |
| 214 | |
| 215 | if (!PRIV_ATTR(id)->name) { |
| 216 | dev_err(priv->dev, "Memory allocation failed for attr %d.\n", |
| 217 | id); |
| 218 | return -ENOMEM; |
| 219 | } |
| 220 | |
| 221 | PRIV_DEV_ATTR(id).dev_attr.attr.name = |
| 222 | PRIV_ATTR(id)->name; |
| 223 | PRIV_DEV_ATTR(id).dev_attr.attr.mode = 0444; |
| 224 | PRIV_DEV_ATTR(id).dev_attr.show = |
| 225 | mlxreg_hotplug_attr_show; |
| 226 | PRIV_DEV_ATTR(id).nr = i; |
| 227 | PRIV_DEV_ATTR(id).index = j; |
| 228 | sysfs_attr_init(&PRIV_DEV_ATTR(id).dev_attr.attr); |
| 229 | } |
| 230 | } |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 231 | |
Kees Cook | a86854d | 2018-06-12 14:07:58 -0700 | [diff] [blame] | 232 | priv->group.attrs = devm_kcalloc(&priv->pdev->dev, |
| 233 | num_attrs, |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 234 | sizeof(struct attribute *), |
| 235 | GFP_KERNEL); |
| 236 | if (!priv->group.attrs) |
| 237 | return -ENOMEM; |
| 238 | |
Vadim Pasternak | 1f976f6 | 2018-01-17 18:21:53 +0000 | [diff] [blame] | 239 | priv->group.attrs = priv->mlxreg_hotplug_attr; |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 240 | priv->groups[0] = &priv->group; |
| 241 | priv->groups[1] = NULL; |
| 242 | |
| 243 | return 0; |
| 244 | } |
| 245 | |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 246 | static void |
| 247 | mlxreg_hotplug_work_helper(struct mlxreg_hotplug_priv_data *priv, |
| 248 | struct mlxreg_core_item *item) |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 249 | { |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 250 | struct mlxreg_core_data *data; |
Vadim Pasternak | e4c275f | 2019-02-17 18:15:30 +0000 | [diff] [blame] | 251 | unsigned long asserted; |
| 252 | u32 regval, bit; |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 253 | int ret; |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 254 | |
| 255 | /* |
| 256 | * Validate if item related to received signal type is valid. |
| 257 | * It should never happen, excepted the situation when some |
| 258 | * piece of hardware is broken. In such situation just produce |
| 259 | * error message and return. Caller must continue to handle the |
| 260 | * signals from other devices if any. |
| 261 | */ |
| 262 | if (unlikely(!item)) { |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 263 | dev_err(priv->dev, "False signal: at offset:mask 0x%02x:0x%02x.\n", |
| 264 | item->reg, item->mask); |
| 265 | |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 266 | return; |
| 267 | } |
| 268 | |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 269 | /* Mask event. */ |
| 270 | ret = regmap_write(priv->regmap, item->reg + MLXREG_HOTPLUG_MASK_OFF, |
| 271 | 0); |
| 272 | if (ret) |
| 273 | goto out; |
| 274 | |
| 275 | /* Read status. */ |
| 276 | ret = regmap_read(priv->regmap, item->reg, ®val); |
| 277 | if (ret) |
| 278 | goto out; |
| 279 | |
| 280 | /* Set asserted bits and save last status. */ |
| 281 | regval &= item->mask; |
| 282 | asserted = item->cache ^ regval; |
| 283 | item->cache = regval; |
| 284 | |
Vadim Pasternak | e4c275f | 2019-02-17 18:15:30 +0000 | [diff] [blame] | 285 | for_each_set_bit(bit, &asserted, 8) { |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 286 | data = item->data + bit; |
| 287 | if (regval & BIT(bit)) { |
| 288 | if (item->inversed) |
Vadim Pasternak | 9272d2d | 2018-07-26 22:40:59 +0000 | [diff] [blame] | 289 | mlxreg_hotplug_device_destroy(priv, data); |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 290 | else |
Vadim Pasternak | f709e1b | 2018-02-13 22:09:35 +0000 | [diff] [blame] | 291 | mlxreg_hotplug_device_create(priv, data); |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 292 | } else { |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 293 | if (item->inversed) |
Vadim Pasternak | f709e1b | 2018-02-13 22:09:35 +0000 | [diff] [blame] | 294 | mlxreg_hotplug_device_create(priv, data); |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 295 | else |
Vadim Pasternak | 9272d2d | 2018-07-26 22:40:59 +0000 | [diff] [blame] | 296 | mlxreg_hotplug_device_destroy(priv, data); |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 297 | } |
| 298 | } |
| 299 | |
| 300 | /* Acknowledge event. */ |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 301 | ret = regmap_write(priv->regmap, item->reg + MLXREG_HOTPLUG_EVENT_OFF, |
| 302 | 0); |
| 303 | if (ret) |
| 304 | goto out; |
| 305 | |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 306 | /* Unmask event. */ |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 307 | ret = regmap_write(priv->regmap, item->reg + MLXREG_HOTPLUG_MASK_OFF, |
| 308 | item->mask); |
| 309 | |
| 310 | out: |
| 311 | if (ret) |
| 312 | dev_err(priv->dev, "Failed to complete workqueue.\n"); |
| 313 | } |
| 314 | |
| 315 | static void |
| 316 | mlxreg_hotplug_health_work_helper(struct mlxreg_hotplug_priv_data *priv, |
| 317 | struct mlxreg_core_item *item) |
| 318 | { |
| 319 | struct mlxreg_core_data *data = item->data; |
| 320 | u32 regval; |
Geert Uytterhoeven | b81e830 | 2018-02-07 10:12:04 +0100 | [diff] [blame] | 321 | int i, ret = 0; |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 322 | |
| 323 | for (i = 0; i < item->count; i++, data++) { |
| 324 | /* Mask event. */ |
| 325 | ret = regmap_write(priv->regmap, data->reg + |
| 326 | MLXREG_HOTPLUG_MASK_OFF, 0); |
| 327 | if (ret) |
| 328 | goto out; |
| 329 | |
| 330 | /* Read status. */ |
| 331 | ret = regmap_read(priv->regmap, data->reg, ®val); |
| 332 | if (ret) |
| 333 | goto out; |
| 334 | |
| 335 | regval &= data->mask; |
Vadim Pasternak | 66342d1 | 2018-07-26 22:40:58 +0000 | [diff] [blame] | 336 | |
| 337 | if (item->cache == regval) |
| 338 | goto ack_event; |
| 339 | |
| 340 | /* |
| 341 | * ASIC health indication is provided through two bits. Bits |
| 342 | * value 0x2 indicates that ASIC reached the good health, value |
| 343 | * 0x0 indicates ASIC the bad health or dormant state and value |
| 344 | * 0x3 indicates the booting state. During ASIC reset it should |
| 345 | * pass the following states: dormant -> booting -> good. |
| 346 | */ |
| 347 | if (regval == MLXREG_HOTPLUG_GOOD_HEALTH_MASK) { |
| 348 | if (!data->attached) { |
| 349 | /* |
| 350 | * ASIC is in steady state. Connect associated |
| 351 | * device, if configured. |
| 352 | */ |
Vadim Pasternak | f709e1b | 2018-02-13 22:09:35 +0000 | [diff] [blame] | 353 | mlxreg_hotplug_device_create(priv, data); |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 354 | data->attached = true; |
| 355 | } |
| 356 | } else { |
| 357 | if (data->attached) { |
Vadim Pasternak | 66342d1 | 2018-07-26 22:40:58 +0000 | [diff] [blame] | 358 | /* |
| 359 | * ASIC health is failed after ASIC has been |
| 360 | * in steady state. Disconnect associated |
| 361 | * device, if it has been connected. |
| 362 | */ |
Vadim Pasternak | 9272d2d | 2018-07-26 22:40:59 +0000 | [diff] [blame] | 363 | mlxreg_hotplug_device_destroy(priv, data); |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 364 | data->attached = false; |
| 365 | data->health_cntr = 0; |
| 366 | } |
| 367 | } |
Vadim Pasternak | 66342d1 | 2018-07-26 22:40:58 +0000 | [diff] [blame] | 368 | item->cache = regval; |
| 369 | ack_event: |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 370 | /* Acknowledge event. */ |
| 371 | ret = regmap_write(priv->regmap, data->reg + |
| 372 | MLXREG_HOTPLUG_EVENT_OFF, 0); |
| 373 | if (ret) |
| 374 | goto out; |
| 375 | |
| 376 | /* Unmask event. */ |
| 377 | ret = regmap_write(priv->regmap, data->reg + |
| 378 | MLXREG_HOTPLUG_MASK_OFF, data->mask); |
| 379 | if (ret) |
| 380 | goto out; |
| 381 | } |
| 382 | |
| 383 | out: |
| 384 | if (ret) |
| 385 | dev_err(priv->dev, "Failed to complete workqueue.\n"); |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 386 | } |
| 387 | |
| 388 | /* |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 389 | * mlxreg_hotplug_work_handler - performs traversing of device interrupt |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 390 | * registers according to the below hierarchy schema: |
| 391 | * |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 392 | * Aggregation registers (status/mask) |
| 393 | * PSU registers: *---* |
| 394 | * *-----------------* | | |
| 395 | * |status/event/mask|-----> | * | |
| 396 | * *-----------------* | | |
| 397 | * Power registers: | | |
| 398 | * *-----------------* | | |
| 399 | * |status/event/mask|-----> | * | |
| 400 | * *-----------------* | | |
| 401 | * FAN registers: | |--> CPU |
| 402 | * *-----------------* | | |
| 403 | * |status/event/mask|-----> | * | |
| 404 | * *-----------------* | | |
| 405 | * ASIC registers: | | |
| 406 | * *-----------------* | | |
| 407 | * |status/event/mask|-----> | * | |
| 408 | * *-----------------* | | |
| 409 | * *---* |
| 410 | * |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 411 | * In case some system changed are detected: FAN in/out, PSU in/out, power |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 412 | * cable attached/detached, ASIC health good/bad, relevant device is created |
| 413 | * or destroyed. |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 414 | */ |
Vadim Pasternak | 1f976f6 | 2018-01-17 18:21:53 +0000 | [diff] [blame] | 415 | static void mlxreg_hotplug_work_handler(struct work_struct *work) |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 416 | { |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 417 | struct mlxreg_core_hotplug_platform_data *pdata; |
| 418 | struct mlxreg_hotplug_priv_data *priv; |
| 419 | struct mlxreg_core_item *item; |
| 420 | u32 regval, aggr_asserted; |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 421 | unsigned long flags; |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 422 | int i, ret; |
| 423 | |
| 424 | priv = container_of(work, struct mlxreg_hotplug_priv_data, |
| 425 | dwork_irq.work); |
| 426 | pdata = dev_get_platdata(&priv->pdev->dev); |
| 427 | item = pdata->items; |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 428 | |
| 429 | /* Mask aggregation event. */ |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 430 | ret = regmap_write(priv->regmap, pdata->cell + |
| 431 | MLXREG_HOTPLUG_AGGR_MASK_OFF, 0); |
| 432 | if (ret < 0) |
| 433 | goto out; |
| 434 | |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 435 | /* Read aggregation status. */ |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 436 | ret = regmap_read(priv->regmap, pdata->cell, ®val); |
| 437 | if (ret) |
| 438 | goto out; |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 439 | |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 440 | regval &= pdata->mask; |
| 441 | aggr_asserted = priv->aggr_cache ^ regval; |
| 442 | priv->aggr_cache = regval; |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 443 | |
Vadim Pasternak | 4b5e32d | 2018-05-07 06:48:51 +0000 | [diff] [blame] | 444 | /* |
| 445 | * Handler is invoked, but no assertion is detected at top aggregation |
| 446 | * status level. Set aggr_asserted to mask value to allow handler extra |
| 447 | * run over all relevant signals to recover any missed signal. |
| 448 | */ |
| 449 | if (priv->not_asserted == MLXREG_HOTPLUG_NOT_ASSERT) { |
| 450 | priv->not_asserted = 0; |
| 451 | aggr_asserted = pdata->mask; |
| 452 | } |
| 453 | if (!aggr_asserted) |
| 454 | goto unmask_event; |
| 455 | |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 456 | /* Handle topology and health configuration changes. */ |
| 457 | for (i = 0; i < pdata->counter; i++, item++) { |
| 458 | if (aggr_asserted & item->aggr_mask) { |
| 459 | if (item->health) |
| 460 | mlxreg_hotplug_health_work_helper(priv, item); |
| 461 | else |
| 462 | mlxreg_hotplug_work_helper(priv, item); |
| 463 | } |
| 464 | } |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 465 | |
Vadim Pasternak | 4b5e32d | 2018-05-07 06:48:51 +0000 | [diff] [blame] | 466 | spin_lock_irqsave(&priv->lock, flags); |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 467 | |
Vadim Pasternak | 4b5e32d | 2018-05-07 06:48:51 +0000 | [diff] [blame] | 468 | /* |
| 469 | * It is possible, that some signals have been inserted, while |
| 470 | * interrupt has been masked by mlxreg_hotplug_work_handler. In this |
| 471 | * case such signals will be missed. In order to handle these signals |
| 472 | * delayed work is canceled and work task re-scheduled for immediate |
| 473 | * execution. It allows to handle missed signals, if any. In other case |
| 474 | * work handler just validates that no new signals have been received |
| 475 | * during masking. |
| 476 | */ |
| 477 | cancel_delayed_work(&priv->dwork_irq); |
| 478 | schedule_delayed_work(&priv->dwork_irq, 0); |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 479 | |
Vadim Pasternak | 4b5e32d | 2018-05-07 06:48:51 +0000 | [diff] [blame] | 480 | spin_unlock_irqrestore(&priv->lock, flags); |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 481 | |
Vadim Pasternak | 4b5e32d | 2018-05-07 06:48:51 +0000 | [diff] [blame] | 482 | return; |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 483 | |
Vadim Pasternak | 4b5e32d | 2018-05-07 06:48:51 +0000 | [diff] [blame] | 484 | unmask_event: |
| 485 | priv->not_asserted++; |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 486 | /* Unmask aggregation event (no need acknowledge). */ |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 487 | ret = regmap_write(priv->regmap, pdata->cell + |
| 488 | MLXREG_HOTPLUG_AGGR_MASK_OFF, pdata->mask); |
| 489 | |
| 490 | out: |
| 491 | if (ret) |
| 492 | dev_err(priv->dev, "Failed to complete workqueue.\n"); |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 493 | } |
| 494 | |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 495 | static int mlxreg_hotplug_set_irq(struct mlxreg_hotplug_priv_data *priv) |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 496 | { |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 497 | struct mlxreg_core_hotplug_platform_data *pdata; |
| 498 | struct mlxreg_core_item *item; |
Vadim Pasternak | 83cdb2c | 2018-12-12 23:59:15 +0000 | [diff] [blame] | 499 | struct mlxreg_core_data *data; |
| 500 | u32 regval; |
| 501 | int i, j, ret; |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 502 | |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 503 | pdata = dev_get_platdata(&priv->pdev->dev); |
| 504 | item = pdata->items; |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 505 | |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 506 | for (i = 0; i < pdata->counter; i++, item++) { |
| 507 | /* Clear group presense event. */ |
| 508 | ret = regmap_write(priv->regmap, item->reg + |
| 509 | MLXREG_HOTPLUG_EVENT_OFF, 0); |
| 510 | if (ret) |
| 511 | goto out; |
| 512 | |
Vadim Pasternak | 83cdb2c | 2018-12-12 23:59:15 +0000 | [diff] [blame] | 513 | /* |
| 514 | * Verify if hardware configuration requires to disable |
| 515 | * interrupt capability for some of components. |
| 516 | */ |
| 517 | data = item->data; |
| 518 | for (j = 0; j < item->count; j++, data++) { |
| 519 | /* Verify if the attribute has capability register. */ |
| 520 | if (data->capability) { |
| 521 | /* Read capability register. */ |
| 522 | ret = regmap_read(priv->regmap, |
| 523 | data->capability, ®val); |
| 524 | if (ret) |
| 525 | goto out; |
| 526 | |
| 527 | if (!(regval & data->bit)) |
| 528 | item->mask &= ~BIT(j); |
| 529 | } |
| 530 | } |
| 531 | |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 532 | /* Set group initial status as mask and unmask group event. */ |
| 533 | if (item->inversed) { |
| 534 | item->cache = item->mask; |
| 535 | ret = regmap_write(priv->regmap, item->reg + |
| 536 | MLXREG_HOTPLUG_MASK_OFF, |
| 537 | item->mask); |
| 538 | if (ret) |
| 539 | goto out; |
| 540 | } |
| 541 | } |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 542 | |
| 543 | /* Keep aggregation initial status as zero and unmask events. */ |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 544 | ret = regmap_write(priv->regmap, pdata->cell + |
| 545 | MLXREG_HOTPLUG_AGGR_MASK_OFF, pdata->mask); |
| 546 | if (ret) |
| 547 | goto out; |
| 548 | |
| 549 | /* Keep low aggregation initial status as zero and unmask events. */ |
| 550 | if (pdata->cell_low) { |
| 551 | ret = regmap_write(priv->regmap, pdata->cell_low + |
| 552 | MLXREG_HOTPLUG_AGGR_MASK_OFF, |
| 553 | pdata->mask_low); |
| 554 | if (ret) |
| 555 | goto out; |
| 556 | } |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 557 | |
| 558 | /* Invoke work handler for initializing hot plug devices setting. */ |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 559 | mlxreg_hotplug_work_handler(&priv->dwork_irq.work); |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 560 | |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 561 | out: |
| 562 | if (ret) |
| 563 | dev_err(priv->dev, "Failed to set interrupts.\n"); |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 564 | enable_irq(priv->irq); |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 565 | return ret; |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 566 | } |
| 567 | |
Vadim Pasternak | 1f976f6 | 2018-01-17 18:21:53 +0000 | [diff] [blame] | 568 | static void mlxreg_hotplug_unset_irq(struct mlxreg_hotplug_priv_data *priv) |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 569 | { |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 570 | struct mlxreg_core_hotplug_platform_data *pdata; |
| 571 | struct mlxreg_core_item *item; |
| 572 | struct mlxreg_core_data *data; |
| 573 | int count, i, j; |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 574 | |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 575 | pdata = dev_get_platdata(&priv->pdev->dev); |
| 576 | item = pdata->items; |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 577 | disable_irq(priv->irq); |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 578 | cancel_delayed_work_sync(&priv->dwork_irq); |
| 579 | |
| 580 | /* Mask low aggregation event, if defined. */ |
| 581 | if (pdata->cell_low) |
| 582 | regmap_write(priv->regmap, pdata->cell_low + |
| 583 | MLXREG_HOTPLUG_AGGR_MASK_OFF, 0); |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 584 | |
| 585 | /* Mask aggregation event. */ |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 586 | regmap_write(priv->regmap, pdata->cell + MLXREG_HOTPLUG_AGGR_MASK_OFF, |
| 587 | 0); |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 588 | |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 589 | /* Clear topology configurations. */ |
| 590 | for (i = 0; i < pdata->counter; i++, item++) { |
| 591 | data = item->data; |
| 592 | /* Mask group presense event. */ |
| 593 | regmap_write(priv->regmap, data->reg + MLXREG_HOTPLUG_MASK_OFF, |
| 594 | 0); |
| 595 | /* Clear group presense event. */ |
| 596 | regmap_write(priv->regmap, data->reg + |
| 597 | MLXREG_HOTPLUG_EVENT_OFF, 0); |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 598 | |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 599 | /* Remove all the attached devices in group. */ |
| 600 | count = item->count; |
| 601 | for (j = 0; j < count; j++, data++) |
Vadim Pasternak | 9272d2d | 2018-07-26 22:40:59 +0000 | [diff] [blame] | 602 | mlxreg_hotplug_device_destroy(priv, data); |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 603 | } |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 604 | } |
| 605 | |
Vadim Pasternak | 1f976f6 | 2018-01-17 18:21:53 +0000 | [diff] [blame] | 606 | static irqreturn_t mlxreg_hotplug_irq_handler(int irq, void *dev) |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 607 | { |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 608 | struct mlxreg_hotplug_priv_data *priv; |
| 609 | |
| 610 | priv = (struct mlxreg_hotplug_priv_data *)dev; |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 611 | |
| 612 | /* Schedule work task for immediate execution.*/ |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 613 | schedule_delayed_work(&priv->dwork_irq, 0); |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 614 | |
| 615 | return IRQ_HANDLED; |
| 616 | } |
| 617 | |
Vadim Pasternak | 1f976f6 | 2018-01-17 18:21:53 +0000 | [diff] [blame] | 618 | static int mlxreg_hotplug_probe(struct platform_device *pdev) |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 619 | { |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 620 | struct mlxreg_core_hotplug_platform_data *pdata; |
Vadim Pasternak | 1f976f6 | 2018-01-17 18:21:53 +0000 | [diff] [blame] | 621 | struct mlxreg_hotplug_priv_data *priv; |
Vadim Pasternak | d726f6b | 2018-02-13 22:09:34 +0000 | [diff] [blame] | 622 | struct i2c_adapter *deferred_adap; |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 623 | int err; |
| 624 | |
| 625 | pdata = dev_get_platdata(&pdev->dev); |
| 626 | if (!pdata) { |
| 627 | dev_err(&pdev->dev, "Failed to get platform data.\n"); |
| 628 | return -EINVAL; |
| 629 | } |
| 630 | |
Vadim Pasternak | d726f6b | 2018-02-13 22:09:34 +0000 | [diff] [blame] | 631 | /* Defer probing if the necessary adapter is not configured yet. */ |
| 632 | deferred_adap = i2c_get_adapter(pdata->deferred_nr); |
| 633 | if (!deferred_adap) |
| 634 | return -EPROBE_DEFER; |
| 635 | i2c_put_adapter(deferred_adap); |
| 636 | |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 637 | priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL); |
| 638 | if (!priv) |
| 639 | return -ENOMEM; |
| 640 | |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 641 | if (pdata->irq) { |
| 642 | priv->irq = pdata->irq; |
| 643 | } else { |
| 644 | priv->irq = platform_get_irq(pdev, 0); |
| 645 | if (priv->irq < 0) { |
| 646 | dev_err(&pdev->dev, "Failed to get platform irq: %d\n", |
| 647 | priv->irq); |
| 648 | return priv->irq; |
| 649 | } |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 650 | } |
| 651 | |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 652 | priv->regmap = pdata->regmap; |
| 653 | priv->dev = pdev->dev.parent; |
| 654 | priv->pdev = pdev; |
| 655 | |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 656 | err = devm_request_irq(&pdev->dev, priv->irq, |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 657 | mlxreg_hotplug_irq_handler, IRQF_TRIGGER_FALLING |
| 658 | | IRQF_SHARED, "mlxreg-hotplug", priv); |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 659 | if (err) { |
| 660 | dev_err(&pdev->dev, "Failed to request irq: %d\n", err); |
| 661 | return err; |
| 662 | } |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 663 | |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 664 | disable_irq(priv->irq); |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 665 | spin_lock_init(&priv->lock); |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 666 | INIT_DELAYED_WORK(&priv->dwork_irq, mlxreg_hotplug_work_handler); |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 667 | dev_set_drvdata(&pdev->dev, priv); |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 668 | |
Vadim Pasternak | 1f976f6 | 2018-01-17 18:21:53 +0000 | [diff] [blame] | 669 | err = mlxreg_hotplug_attr_init(priv); |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 670 | if (err) { |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 671 | dev_err(&pdev->dev, "Failed to allocate attributes: %d\n", |
| 672 | err); |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 673 | return err; |
| 674 | } |
| 675 | |
| 676 | priv->hwmon = devm_hwmon_device_register_with_groups(&pdev->dev, |
Vadim Pasternak | 1f976f6 | 2018-01-17 18:21:53 +0000 | [diff] [blame] | 677 | "mlxreg_hotplug", priv, priv->groups); |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 678 | if (IS_ERR(priv->hwmon)) { |
| 679 | dev_err(&pdev->dev, "Failed to register hwmon device %ld\n", |
| 680 | PTR_ERR(priv->hwmon)); |
| 681 | return PTR_ERR(priv->hwmon); |
| 682 | } |
| 683 | |
Vadim Pasternak | 9272d2d | 2018-07-26 22:40:59 +0000 | [diff] [blame] | 684 | /* Perform initial interrupts setup. */ |
| 685 | mlxreg_hotplug_set_irq(priv); |
| 686 | priv->after_probe = true; |
| 687 | |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 688 | return 0; |
| 689 | } |
| 690 | |
Vadim Pasternak | 1f976f6 | 2018-01-17 18:21:53 +0000 | [diff] [blame] | 691 | static int mlxreg_hotplug_remove(struct platform_device *pdev) |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 692 | { |
Vadim Pasternak | c6acad6 | 2018-01-22 19:55:11 -0800 | [diff] [blame] | 693 | struct mlxreg_hotplug_priv_data *priv = dev_get_drvdata(&pdev->dev); |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 694 | |
| 695 | /* Clean interrupts setup. */ |
Vadim Pasternak | 1f976f6 | 2018-01-17 18:21:53 +0000 | [diff] [blame] | 696 | mlxreg_hotplug_unset_irq(priv); |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 697 | |
| 698 | return 0; |
| 699 | } |
| 700 | |
Vadim Pasternak | 1f976f6 | 2018-01-17 18:21:53 +0000 | [diff] [blame] | 701 | static struct platform_driver mlxreg_hotplug_driver = { |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 702 | .driver = { |
Vadim Pasternak | 1f976f6 | 2018-01-17 18:21:53 +0000 | [diff] [blame] | 703 | .name = "mlxreg-hotplug", |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 704 | }, |
Vadim Pasternak | 1f976f6 | 2018-01-17 18:21:53 +0000 | [diff] [blame] | 705 | .probe = mlxreg_hotplug_probe, |
| 706 | .remove = mlxreg_hotplug_remove, |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 707 | }; |
| 708 | |
Vadim Pasternak | 1f976f6 | 2018-01-17 18:21:53 +0000 | [diff] [blame] | 709 | module_platform_driver(mlxreg_hotplug_driver); |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 710 | |
| 711 | MODULE_AUTHOR("Vadim Pasternak <vadimp@mellanox.com>"); |
Vadim Pasternak | 1f976f6 | 2018-01-17 18:21:53 +0000 | [diff] [blame] | 712 | MODULE_DESCRIPTION("Mellanox regmap hotplug platform driver"); |
Vadim Pasternak | 3048870 | 2016-10-20 16:28:01 +0000 | [diff] [blame] | 713 | MODULE_LICENSE("Dual BSD/GPL"); |
Vadim Pasternak | 1f976f6 | 2018-01-17 18:21:53 +0000 | [diff] [blame] | 714 | MODULE_ALIAS("platform:mlxreg-hotplug"); |