1 // SPDX-License-Identifier: GPL-2.0-only
3 * Copyright (c) 2015-2017, NVIDIA CORPORATION. All rights reserved.
6 * Mikko Perttunen <mperttunen@nvidia.com>
7 * Aapo Vienamo <avienamo@nvidia.com>
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>
16 #include <soc/tegra/bpmp.h>
17 #include <soc/tegra/bpmp-abi.h>
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;
26 struct tegra_bpmp_thermal {
28 struct tegra_bpmp *bpmp;
29 unsigned int num_zones;
30 struct tegra_bpmp_thermal_zone **zones;
33 static int tegra_bpmp_thermal_get_temp(void *data, int *out_temp)
35 struct tegra_bpmp_thermal_zone *zone = data;
36 struct mrq_thermal_host_to_bpmp_request req;
37 union mrq_thermal_bpmp_to_host_response reply;
38 struct tegra_bpmp_message msg;
41 memset(&req, 0, sizeof(req));
42 req.type = CMD_THERMAL_GET_TEMP;
43 req.get_temp.zone = zone->idx;
45 memset(&msg, 0, sizeof(msg));
46 msg.mrq = MRQ_THERMAL;
48 msg.tx.size = sizeof(req);
50 msg.rx.size = sizeof(reply);
52 err = tegra_bpmp_transfer(zone->tegra->bpmp, &msg);
58 *out_temp = reply.get_temp.temp;
63 static int tegra_bpmp_thermal_set_trips(void *data, int low, int high)
65 struct tegra_bpmp_thermal_zone *zone = data;
66 struct mrq_thermal_host_to_bpmp_request req;
67 struct tegra_bpmp_message msg;
70 memset(&req, 0, sizeof(req));
71 req.type = CMD_THERMAL_SET_TRIP;
72 req.set_trip.zone = zone->idx;
73 req.set_trip.enabled = true;
74 req.set_trip.low = low;
75 req.set_trip.high = high;
77 memset(&msg, 0, sizeof(msg));
78 msg.mrq = MRQ_THERMAL;
80 msg.tx.size = sizeof(req);
82 err = tegra_bpmp_transfer(zone->tegra->bpmp, &msg);
91 static void tz_device_update_work_fn(struct work_struct *work)
93 struct tegra_bpmp_thermal_zone *zone;
95 zone = container_of(work, struct tegra_bpmp_thermal_zone,
96 tz_device_update_work);
98 thermal_zone_device_update(zone->tzd, THERMAL_TRIP_VIOLATED);
101 static void bpmp_mrq_thermal(unsigned int mrq, struct tegra_bpmp_channel *ch,
104 struct mrq_thermal_bpmp_to_host_request *req;
105 struct tegra_bpmp_thermal *tegra = data;
108 req = (struct mrq_thermal_bpmp_to_host_request *)ch->ib->data;
110 if (req->type != CMD_THERMAL_HOST_TRIP_REACHED) {
111 dev_err(tegra->dev, "%s: invalid request type: %d\n",
112 __func__, req->type);
113 tegra_bpmp_mrq_return(ch, -EINVAL, NULL, 0);
117 for (i = 0; i < tegra->num_zones; ++i) {
118 if (tegra->zones[i]->idx != req->host_trip_reached.zone)
121 schedule_work(&tegra->zones[i]->tz_device_update_work);
122 tegra_bpmp_mrq_return(ch, 0, NULL, 0);
126 dev_err(tegra->dev, "%s: invalid thermal zone: %d\n", __func__,
127 req->host_trip_reached.zone);
128 tegra_bpmp_mrq_return(ch, -EINVAL, NULL, 0);
131 static int tegra_bpmp_thermal_get_num_zones(struct tegra_bpmp *bpmp,
134 struct mrq_thermal_host_to_bpmp_request req;
135 union mrq_thermal_bpmp_to_host_response reply;
136 struct tegra_bpmp_message msg;
139 memset(&req, 0, sizeof(req));
140 req.type = CMD_THERMAL_GET_NUM_ZONES;
142 memset(&msg, 0, sizeof(msg));
143 msg.mrq = MRQ_THERMAL;
145 msg.tx.size = sizeof(req);
146 msg.rx.data = &reply;
147 msg.rx.size = sizeof(reply);
149 err = tegra_bpmp_transfer(bpmp, &msg);
155 *num_zones = reply.get_num_zones.num;
160 static const struct thermal_zone_of_device_ops tegra_bpmp_of_thermal_ops = {
161 .get_temp = tegra_bpmp_thermal_get_temp,
162 .set_trips = tegra_bpmp_thermal_set_trips,
165 static int tegra_bpmp_thermal_probe(struct platform_device *pdev)
167 struct tegra_bpmp *bpmp = dev_get_drvdata(pdev->dev.parent);
168 struct tegra_bpmp_thermal *tegra;
169 struct thermal_zone_device *tzd;
170 unsigned int i, max_num_zones;
173 tegra = devm_kzalloc(&pdev->dev, sizeof(*tegra), GFP_KERNEL);
177 tegra->dev = &pdev->dev;
180 err = tegra_bpmp_thermal_get_num_zones(bpmp, &max_num_zones);
182 dev_err(&pdev->dev, "failed to get the number of zones: %d\n",
187 tegra->zones = devm_kcalloc(&pdev->dev, max_num_zones,
188 sizeof(*tegra->zones), GFP_KERNEL);
192 for (i = 0; i < max_num_zones; ++i) {
193 struct tegra_bpmp_thermal_zone *zone;
196 zone = devm_kzalloc(&pdev->dev, sizeof(*zone), GFP_KERNEL);
203 err = tegra_bpmp_thermal_get_temp(zone, &temp);
205 devm_kfree(&pdev->dev, zone);
209 tzd = devm_thermal_zone_of_sensor_register(
210 &pdev->dev, i, zone, &tegra_bpmp_of_thermal_ops);
212 if (PTR_ERR(tzd) == -EPROBE_DEFER)
213 return -EPROBE_DEFER;
214 devm_kfree(&pdev->dev, zone);
219 INIT_WORK(&zone->tz_device_update_work,
220 tz_device_update_work_fn);
222 tegra->zones[tegra->num_zones++] = zone;
225 err = tegra_bpmp_request_mrq(bpmp, MRQ_THERMAL, bpmp_mrq_thermal,
228 dev_err(&pdev->dev, "failed to register mrq handler: %d\n",
233 platform_set_drvdata(pdev, tegra);
238 static int tegra_bpmp_thermal_remove(struct platform_device *pdev)
240 struct tegra_bpmp_thermal *tegra = platform_get_drvdata(pdev);
242 tegra_bpmp_free_mrq(tegra->bpmp, MRQ_THERMAL, tegra);
247 static const struct of_device_id tegra_bpmp_thermal_of_match[] = {
248 { .compatible = "nvidia,tegra186-bpmp-thermal" },
251 MODULE_DEVICE_TABLE(of, tegra_bpmp_thermal_of_match);
253 static struct platform_driver tegra_bpmp_thermal_driver = {
254 .probe = tegra_bpmp_thermal_probe,
255 .remove = tegra_bpmp_thermal_remove,
257 .name = "tegra-bpmp-thermal",
258 .of_match_table = tegra_bpmp_thermal_of_match,
261 module_platform_driver(tegra_bpmp_thermal_driver);
263 MODULE_AUTHOR("Mikko Perttunen <mperttunen@nvidia.com>");
264 MODULE_DESCRIPTION("NVIDIA Tegra BPMP thermal sensor driver");
265 MODULE_LICENSE("GPL v2");