1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * Copyright (c) 2015-2017, NVIDIA CORPORATION. All rights reserved. 4 * 5 * Author: 6 * Mikko Perttunen <mperttunen@nvidia.com> 7 * Aapo Vienamo <avienamo@nvidia.com> 8 */ 9 10 #include <linux/err.h> 11 #include <linux/module.h> 12 #include <linux/platform_device.h> 13 #include <linux/thermal.h> 14 #include <linux/workqueue.h> 15 16 #include <soc/tegra/bpmp.h> 17 #include <soc/tegra/bpmp-abi.h> 18 19 struct tegra_bpmp_thermal_zone { 20 struct tegra_bpmp_thermal *tegra; 21 struct thermal_zone_device *tzd; 22 struct work_struct tz_device_update_work; 23 unsigned int idx; 24 }; 25 26 struct tegra_bpmp_thermal { 27 struct device *dev; 28 struct tegra_bpmp *bpmp; 29 unsigned int num_zones; 30 struct tegra_bpmp_thermal_zone **zones; 31 }; 32 33 static int __tegra_bpmp_thermal_get_temp(struct tegra_bpmp_thermal_zone *zone, 34 int *out_temp) 35 { 36 struct mrq_thermal_host_to_bpmp_request req; 37 union mrq_thermal_bpmp_to_host_response reply; 38 struct tegra_bpmp_message msg; 39 int err; 40 41 memset(&req, 0, sizeof(req)); 42 req.type = CMD_THERMAL_GET_TEMP; 43 req.get_temp.zone = zone->idx; 44 45 memset(&msg, 0, sizeof(msg)); 46 msg.mrq = MRQ_THERMAL; 47 msg.tx.data = &req; 48 msg.tx.size = sizeof(req); 49 msg.rx.data = &reply; 50 msg.rx.size = sizeof(reply); 51 52 err = tegra_bpmp_transfer(zone->tegra->bpmp, &msg); 53 if (err) 54 return err; 55 if (msg.rx.ret == -BPMP_EFAULT) 56 return -EAGAIN; 57 if (msg.rx.ret) 58 return -EINVAL; 59 60 *out_temp = reply.get_temp.temp; 61 62 return 0; 63 } 64 65 static int tegra_bpmp_thermal_get_temp(struct thermal_zone_device *tz, int *out_temp) 66 { 67 struct tegra_bpmp_thermal_zone *zone = thermal_zone_device_priv(tz); 68 69 return __tegra_bpmp_thermal_get_temp(zone, out_temp); 70 } 71 72 static int tegra_bpmp_thermal_set_trips(struct thermal_zone_device *tz, int low, int high) 73 { 74 struct tegra_bpmp_thermal_zone *zone = thermal_zone_device_priv(tz); 75 struct mrq_thermal_host_to_bpmp_request req; 76 struct tegra_bpmp_message msg; 77 int err; 78 79 memset(&req, 0, sizeof(req)); 80 req.type = CMD_THERMAL_SET_TRIP; 81 req.set_trip.zone = zone->idx; 82 req.set_trip.enabled = true; 83 req.set_trip.low = low; 84 req.set_trip.high = high; 85 86 memset(&msg, 0, sizeof(msg)); 87 msg.mrq = MRQ_THERMAL; 88 msg.tx.data = &req; 89 msg.tx.size = sizeof(req); 90 91 err = tegra_bpmp_transfer(zone->tegra->bpmp, &msg); 92 if (err) 93 return err; 94 if (msg.rx.ret) 95 return -EINVAL; 96 97 return 0; 98 } 99 100 static void tz_device_update_work_fn(struct work_struct *work) 101 { 102 struct tegra_bpmp_thermal_zone *zone; 103 104 zone = container_of(work, struct tegra_bpmp_thermal_zone, 105 tz_device_update_work); 106 107 thermal_zone_device_update(zone->tzd, THERMAL_TRIP_VIOLATED); 108 } 109 110 static void bpmp_mrq_thermal(unsigned int mrq, struct tegra_bpmp_channel *ch, 111 void *data) 112 { 113 struct mrq_thermal_bpmp_to_host_request req; 114 struct tegra_bpmp_thermal *tegra = data; 115 size_t offset; 116 int i; 117 118 offset = offsetof(struct tegra_bpmp_mb_data, data); 119 iosys_map_memcpy_from(&req, &ch->ib, offset, sizeof(req)); 120 121 if (req.type != CMD_THERMAL_HOST_TRIP_REACHED) { 122 dev_err(tegra->dev, "%s: invalid request type: %d\n", __func__, req.type); 123 tegra_bpmp_mrq_return(ch, -EINVAL, NULL, 0); 124 return; 125 } 126 127 for (i = 0; i < tegra->num_zones; ++i) { 128 if (tegra->zones[i]->idx != req.host_trip_reached.zone) 129 continue; 130 131 schedule_work(&tegra->zones[i]->tz_device_update_work); 132 tegra_bpmp_mrq_return(ch, 0, NULL, 0); 133 return; 134 } 135 136 dev_err(tegra->dev, "%s: invalid thermal zone: %d\n", __func__, 137 req.host_trip_reached.zone); 138 tegra_bpmp_mrq_return(ch, -EINVAL, NULL, 0); 139 } 140 141 static int tegra_bpmp_thermal_get_num_zones(struct tegra_bpmp *bpmp, 142 int *num_zones) 143 { 144 struct mrq_thermal_host_to_bpmp_request req; 145 union mrq_thermal_bpmp_to_host_response reply; 146 struct tegra_bpmp_message msg; 147 int err; 148 149 memset(&req, 0, sizeof(req)); 150 req.type = CMD_THERMAL_GET_NUM_ZONES; 151 152 memset(&msg, 0, sizeof(msg)); 153 msg.mrq = MRQ_THERMAL; 154 msg.tx.data = &req; 155 msg.tx.size = sizeof(req); 156 msg.rx.data = &reply; 157 msg.rx.size = sizeof(reply); 158 159 err = tegra_bpmp_transfer(bpmp, &msg); 160 if (err) 161 return err; 162 if (msg.rx.ret) 163 return -EINVAL; 164 165 *num_zones = reply.get_num_zones.num; 166 167 return 0; 168 } 169 170 static const struct thermal_zone_device_ops tegra_bpmp_of_thermal_ops = { 171 .get_temp = tegra_bpmp_thermal_get_temp, 172 .set_trips = tegra_bpmp_thermal_set_trips, 173 }; 174 175 static int tegra_bpmp_thermal_probe(struct platform_device *pdev) 176 { 177 struct tegra_bpmp *bpmp = dev_get_drvdata(pdev->dev.parent); 178 struct tegra_bpmp_thermal *tegra; 179 struct thermal_zone_device *tzd; 180 unsigned int i, max_num_zones; 181 int err; 182 183 tegra = devm_kzalloc(&pdev->dev, sizeof(*tegra), GFP_KERNEL); 184 if (!tegra) 185 return -ENOMEM; 186 187 tegra->dev = &pdev->dev; 188 tegra->bpmp = bpmp; 189 190 err = tegra_bpmp_thermal_get_num_zones(bpmp, &max_num_zones); 191 if (err) { 192 dev_err(&pdev->dev, "failed to get the number of zones: %d\n", 193 err); 194 return err; 195 } 196 197 tegra->zones = devm_kcalloc(&pdev->dev, max_num_zones, 198 sizeof(*tegra->zones), GFP_KERNEL); 199 if (!tegra->zones) 200 return -ENOMEM; 201 202 for (i = 0; i < max_num_zones; ++i) { 203 struct tegra_bpmp_thermal_zone *zone; 204 int temp; 205 206 zone = devm_kzalloc(&pdev->dev, sizeof(*zone), GFP_KERNEL); 207 if (!zone) 208 return -ENOMEM; 209 210 zone->idx = i; 211 zone->tegra = tegra; 212 213 err = __tegra_bpmp_thermal_get_temp(zone, &temp); 214 215 /* 216 * Sensors in powergated domains may temporarily fail to be read 217 * (-EAGAIN), but will become accessible when the domain is powered on. 218 */ 219 if (err < 0 && err != -EAGAIN) { 220 devm_kfree(&pdev->dev, zone); 221 continue; 222 } 223 224 tzd = devm_thermal_of_zone_register( 225 &pdev->dev, i, zone, &tegra_bpmp_of_thermal_ops); 226 if (IS_ERR(tzd)) { 227 if (PTR_ERR(tzd) == -EPROBE_DEFER) 228 return -EPROBE_DEFER; 229 devm_kfree(&pdev->dev, zone); 230 continue; 231 } 232 233 zone->tzd = tzd; 234 INIT_WORK(&zone->tz_device_update_work, 235 tz_device_update_work_fn); 236 237 tegra->zones[tegra->num_zones++] = zone; 238 } 239 240 err = tegra_bpmp_request_mrq(bpmp, MRQ_THERMAL, bpmp_mrq_thermal, 241 tegra); 242 if (err) { 243 dev_err(&pdev->dev, "failed to register mrq handler: %d\n", 244 err); 245 return err; 246 } 247 248 platform_set_drvdata(pdev, tegra); 249 250 return 0; 251 } 252 253 static int tegra_bpmp_thermal_remove(struct platform_device *pdev) 254 { 255 struct tegra_bpmp_thermal *tegra = platform_get_drvdata(pdev); 256 257 tegra_bpmp_free_mrq(tegra->bpmp, MRQ_THERMAL, tegra); 258 259 return 0; 260 } 261 262 static const struct of_device_id tegra_bpmp_thermal_of_match[] = { 263 { .compatible = "nvidia,tegra186-bpmp-thermal" }, 264 { }, 265 }; 266 MODULE_DEVICE_TABLE(of, tegra_bpmp_thermal_of_match); 267 268 static struct platform_driver tegra_bpmp_thermal_driver = { 269 .probe = tegra_bpmp_thermal_probe, 270 .remove = tegra_bpmp_thermal_remove, 271 .driver = { 272 .name = "tegra-bpmp-thermal", 273 .of_match_table = tegra_bpmp_thermal_of_match, 274 }, 275 }; 276 module_platform_driver(tegra_bpmp_thermal_driver); 277 278 MODULE_AUTHOR("Mikko Perttunen <mperttunen@nvidia.com>"); 279 MODULE_DESCRIPTION("NVIDIA Tegra BPMP thermal sensor driver"); 280 MODULE_LICENSE("GPL v2"); 281