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 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 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 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 98 static int wf_lm87_probe(struct i2c_client *client) 99 { 100 struct wf_lm87_sensor *lm; 101 const char *name = NULL, *loc; 102 struct device_node *np = NULL; 103 int rc; 104 105 /* 106 * The lm87 contains a whole pile of sensors, additionally, 107 * the Xserve G5 has several lm87's. However, for now we only 108 * care about the internal temperature sensor 109 */ 110 for_each_child_of_node(client->dev.of_node, np) { 111 if (!of_node_name_eq(np, "int-temp")) 112 continue; 113 loc = of_get_property(np, "location", NULL); 114 if (!loc) 115 continue; 116 if (strstr(loc, "DIMM")) 117 name = "dimms-temp"; 118 else if (strstr(loc, "Processors")) 119 name = "between-cpus-temp"; 120 if (name) { 121 of_node_put(np); 122 break; 123 } 124 } 125 if (!name) { 126 pr_warn("wf_lm87: Unsupported sensor %pOF\n", 127 client->dev.of_node); 128 return -ENODEV; 129 } 130 131 lm = kzalloc(sizeof(struct wf_lm87_sensor), GFP_KERNEL); 132 if (lm == NULL) 133 return -ENODEV; 134 135 lm->i2c = client; 136 lm->sens.name = name; 137 lm->sens.ops = &wf_lm87_ops; 138 lm->sens.priv = lm; 139 i2c_set_clientdata(client, lm); 140 141 rc = wf_register_sensor(&lm->sens); 142 if (rc) 143 kfree(lm); 144 return rc; 145 } 146 147 static void wf_lm87_remove(struct i2c_client *client) 148 { 149 struct wf_lm87_sensor *lm = i2c_get_clientdata(client); 150 151 /* Mark client detached */ 152 lm->i2c = NULL; 153 154 /* release sensor */ 155 wf_unregister_sensor(&lm->sens); 156 } 157 158 static const struct i2c_device_id wf_lm87_id[] = { 159 { "MAC,lm87cimt", 0 }, 160 { } 161 }; 162 MODULE_DEVICE_TABLE(i2c, wf_lm87_id); 163 164 static const struct of_device_id wf_lm87_of_id[] = { 165 { .compatible = "lm87cimt", }, 166 { } 167 }; 168 MODULE_DEVICE_TABLE(of, wf_lm87_of_id); 169 170 static struct i2c_driver wf_lm87_driver = { 171 .driver = { 172 .name = "wf_lm87", 173 .of_match_table = wf_lm87_of_id, 174 }, 175 .probe_new = wf_lm87_probe, 176 .remove = wf_lm87_remove, 177 .id_table = wf_lm87_id, 178 }; 179 180 static int __init wf_lm87_sensor_init(void) 181 { 182 /* We only support this on the Xserve */ 183 if (!of_machine_is_compatible("RackMac3,1")) 184 return -ENODEV; 185 186 return i2c_add_driver(&wf_lm87_driver); 187 } 188 189 static void __exit wf_lm87_sensor_exit(void) 190 { 191 i2c_del_driver(&wf_lm87_driver); 192 } 193 194 195 module_init(wf_lm87_sensor_init); 196 module_exit(wf_lm87_sensor_exit); 197 198 MODULE_AUTHOR("Benjamin Herrenschmidt <benh@kernel.crashing.org>"); 199 MODULE_DESCRIPTION("LM87 sensor objects for PowerMacs thermal control"); 200 MODULE_LICENSE("GPL"); 201 202