1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * Windfarm PowerMac thermal control. LM87 sensor
4 *
5 * Copyright 2012 Benjamin Herrenschmidt, IBM Corp.
6 */
7
8 #include <linux/types.h>
9 #include <linux/errno.h>
10 #include <linux/kernel.h>
11 #include <linux/delay.h>
12 #include <linux/slab.h>
13 #include <linux/init.h>
14 #include <linux/wait.h>
15 #include <linux/i2c.h>
16
17 #include <asm/machdep.h>
18 #include <asm/io.h>
19 #include <asm/sections.h>
20 #include <asm/pmac_low_i2c.h>
21
22 #include "windfarm.h"
23
24 #define VERSION "1.0"
25
26 #undef DEBUG
27
28 #ifdef DEBUG
29 #define DBG(args...) printk(args)
30 #else
31 #define DBG(args...) do { } while(0)
32 #endif
33
34 struct wf_lm87_sensor {
35 struct i2c_client *i2c;
36 struct wf_sensor sens;
37 };
38 #define wf_to_lm87(c) container_of(c, struct wf_lm87_sensor, sens)
39
40
wf_lm87_read_reg(struct i2c_client * chip,int reg)41 static int wf_lm87_read_reg(struct i2c_client *chip, int reg)
42 {
43 int rc, tries = 0;
44 u8 buf;
45
46 for (;;) {
47 /* Set address */
48 buf = (u8)reg;
49 rc = i2c_master_send(chip, &buf, 1);
50 if (rc <= 0)
51 goto error;
52 rc = i2c_master_recv(chip, &buf, 1);
53 if (rc <= 0)
54 goto error;
55 return (int)buf;
56 error:
57 DBG("wf_lm87: Error reading LM87, retrying...\n");
58 if (++tries > 10) {
59 printk(KERN_ERR "wf_lm87: Error reading LM87 !\n");
60 return -EIO;
61 }
62 msleep(10);
63 }
64 }
65
wf_lm87_get(struct wf_sensor * sr,s32 * value)66 static int wf_lm87_get(struct wf_sensor *sr, s32 *value)
67 {
68 struct wf_lm87_sensor *lm = sr->priv;
69 s32 temp;
70
71 if (lm->i2c == NULL)
72 return -ENODEV;
73
74 #define LM87_INT_TEMP 0x27
75
76 /* Read temperature register */
77 temp = wf_lm87_read_reg(lm->i2c, LM87_INT_TEMP);
78 if (temp < 0)
79 return temp;
80 *value = temp << 16;
81
82 return 0;
83 }
84
wf_lm87_release(struct wf_sensor * sr)85 static void wf_lm87_release(struct wf_sensor *sr)
86 {
87 struct wf_lm87_sensor *lm = wf_to_lm87(sr);
88
89 kfree(lm);
90 }
91
92 static const struct wf_sensor_ops wf_lm87_ops = {
93 .get_value = wf_lm87_get,
94 .release = wf_lm87_release,
95 .owner = THIS_MODULE,
96 };
97
wf_lm87_probe(struct i2c_client * client,const struct i2c_device_id * id)98 static int wf_lm87_probe(struct i2c_client *client,
99 const struct i2c_device_id *id)
100 {
101 struct wf_lm87_sensor *lm;
102 const char *name = NULL, *loc;
103 struct device_node *np = NULL;
104 int rc;
105
106 /*
107 * The lm87 contains a whole pile of sensors, additionally,
108 * the Xserve G5 has several lm87's. However, for now we only
109 * care about the internal temperature sensor
110 */
111 for_each_child_of_node(client->dev.of_node, np) {
112 if (!of_node_name_eq(np, "int-temp"))
113 continue;
114 loc = of_get_property(np, "location", NULL);
115 if (!loc)
116 continue;
117 if (strstr(loc, "DIMM"))
118 name = "dimms-temp";
119 else if (strstr(loc, "Processors"))
120 name = "between-cpus-temp";
121 if (name) {
122 of_node_put(np);
123 break;
124 }
125 }
126 if (!name) {
127 pr_warn("wf_lm87: Unsupported sensor %pOF\n",
128 client->dev.of_node);
129 return -ENODEV;
130 }
131
132 lm = kzalloc(sizeof(struct wf_lm87_sensor), GFP_KERNEL);
133 if (lm == NULL)
134 return -ENODEV;
135
136 lm->i2c = client;
137 lm->sens.name = name;
138 lm->sens.ops = &wf_lm87_ops;
139 lm->sens.priv = lm;
140 i2c_set_clientdata(client, lm);
141
142 rc = wf_register_sensor(&lm->sens);
143 if (rc)
144 kfree(lm);
145 return rc;
146 }
147
wf_lm87_remove(struct i2c_client * client)148 static void wf_lm87_remove(struct i2c_client *client)
149 {
150 struct wf_lm87_sensor *lm = i2c_get_clientdata(client);
151
152 /* Mark client detached */
153 lm->i2c = NULL;
154
155 /* release sensor */
156 wf_unregister_sensor(&lm->sens);
157 }
158
159 static const struct i2c_device_id wf_lm87_id[] = {
160 { "MAC,lm87cimt", 0 },
161 { }
162 };
163 MODULE_DEVICE_TABLE(i2c, wf_lm87_id);
164
165 static const struct of_device_id wf_lm87_of_id[] = {
166 { .compatible = "lm87cimt", },
167 { }
168 };
169 MODULE_DEVICE_TABLE(of, wf_lm87_of_id);
170
171 static struct i2c_driver wf_lm87_driver = {
172 .driver = {
173 .name = "wf_lm87",
174 .of_match_table = wf_lm87_of_id,
175 },
176 .probe = wf_lm87_probe,
177 .remove = wf_lm87_remove,
178 .id_table = wf_lm87_id,
179 };
180
wf_lm87_sensor_init(void)181 static int __init wf_lm87_sensor_init(void)
182 {
183 /* We only support this on the Xserve */
184 if (!of_machine_is_compatible("RackMac3,1"))
185 return -ENODEV;
186
187 return i2c_add_driver(&wf_lm87_driver);
188 }
189
wf_lm87_sensor_exit(void)190 static void __exit wf_lm87_sensor_exit(void)
191 {
192 i2c_del_driver(&wf_lm87_driver);
193 }
194
195
196 module_init(wf_lm87_sensor_init);
197 module_exit(wf_lm87_sensor_exit);
198
199 MODULE_AUTHOR("Benjamin Herrenschmidt <benh@kernel.crashing.org>");
200 MODULE_DESCRIPTION("LM87 sensor objects for PowerMacs thermal control");
201 MODULE_LICENSE("GPL");
202
203