f797118391ce5 (Thomas Gleixner 2019-05-31 01:09:35 -0700 1) // SPDX-License-Identifier: GPL-2.0-only
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 2) /*
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 3) * Windfarm PowerMac thermal control. SMU "satellite" controller sensors.
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 4) *
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 5) * Copyright (C) 2005 Paul Mackerras, IBM Corp. <paulus@samba.org>
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 6) */
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 7)
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 8) #include <linux/types.h>
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 9) #include <linux/errno.h>
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 10) #include <linux/kernel.h>
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 11) #include <linux/slab.h>
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 12) #include <linux/init.h>
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 13) #include <linux/wait.h>
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 14) #include <linux/i2c.h>
56783c5e4dd32 (Daniel Walker 2008-05-03 06:34:02 +1000 15) #include <linux/mutex.h>
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 16) #include <asm/prom.h>
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 17) #include <asm/smu.h>
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 18) #include <asm/pmac_low_i2c.h>
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 19)
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 20) #include "windfarm.h"
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 21)
e326b30fda9a9 (Benjamin Herrenschmidt 2012-04-18 22:16:46 +0000 22) #define VERSION "1.0"
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 23)
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 24) /* If the cache is older than 800ms we'll refetch it */
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 25) #define MAX_AGE msecs_to_jiffies(800)
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 26)
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 27) struct wf_sat {
e326b30fda9a9 (Benjamin Herrenschmidt 2012-04-18 22:16:46 +0000 28) struct kref ref;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 29) int nr;
56783c5e4dd32 (Daniel Walker 2008-05-03 06:34:02 +1000 30) struct mutex mutex;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 31) unsigned long last_read; /* jiffies when cache last updated */
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 32) u8 cache[16];
e326b30fda9a9 (Benjamin Herrenschmidt 2012-04-18 22:16:46 +0000 33) struct list_head sensors;
351ca3e311979 (Jean Delvare 2009-06-15 18:01:51 +0200 34) struct i2c_client *i2c;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 35) struct device_node *node;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 36) };
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 37)
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 38) static struct wf_sat *sats[2];
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 39)
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 40) struct wf_sat_sensor {
e326b30fda9a9 (Benjamin Herrenschmidt 2012-04-18 22:16:46 +0000 41) struct list_head link;
e326b30fda9a9 (Benjamin Herrenschmidt 2012-04-18 22:16:46 +0000 42) int index;
e326b30fda9a9 (Benjamin Herrenschmidt 2012-04-18 22:16:46 +0000 43) int index2; /* used for power sensors */
e326b30fda9a9 (Benjamin Herrenschmidt 2012-04-18 22:16:46 +0000 44) int shift;
e326b30fda9a9 (Benjamin Herrenschmidt 2012-04-18 22:16:46 +0000 45) struct wf_sat *sat;
e326b30fda9a9 (Benjamin Herrenschmidt 2012-04-18 22:16:46 +0000 46) struct wf_sensor sens;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 47) };
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 48)
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 49) #define wf_to_sat(c) container_of(c, struct wf_sat_sensor, sens)
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 50)
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 51) struct smu_sdbp_header *smu_sat_get_sdb_partition(unsigned int sat_id, int id,
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 52) unsigned int *size)
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 53) {
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 54) struct wf_sat *sat;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 55) int err;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 56) unsigned int i, len;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 57) u8 *buf;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 58) u8 data[4];
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 59)
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 60) /* TODO: Add the resulting partition to the device-tree */
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 61)
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 62) if (sat_id > 1 || (sat = sats[sat_id]) == NULL)
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 63) return NULL;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 64)
351ca3e311979 (Jean Delvare 2009-06-15 18:01:51 +0200 65) err = i2c_smbus_write_word_data(sat->i2c, 8, id << 8);
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 66) if (err) {
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 67) printk(KERN_ERR "smu_sat_get_sdb_part wr error %d\n", err);
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 68) return NULL;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 69) }
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 70)
351ca3e311979 (Jean Delvare 2009-06-15 18:01:51 +0200 71) err = i2c_smbus_read_word_data(sat->i2c, 9);
2fd091f3eebc5 (roel kluin 2008-11-29 01:17:27 +0000 72) if (err < 0) {
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 73) printk(KERN_ERR "smu_sat_get_sdb_part rd len error\n");
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 74) return NULL;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 75) }
2fd091f3eebc5 (roel kluin 2008-11-29 01:17:27 +0000 76) len = err;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 77) if (len == 0) {
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 78) printk(KERN_ERR "smu_sat_get_sdb_part no partition %x\n", id);
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 79) return NULL;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 80) }
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 81)
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 82) len = le16_to_cpu(len);
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 83) len = (len + 3) & ~3;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 84) buf = kmalloc(len, GFP_KERNEL);
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 85) if (buf == NULL)
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 86) return NULL;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 87)
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 88) for (i = 0; i < len; i += 4) {
351ca3e311979 (Jean Delvare 2009-06-15 18:01:51 +0200 89) err = i2c_smbus_read_i2c_block_data(sat->i2c, 0xa, 4, data);
4b2643d7d9bdc (Jean Delvare 2007-07-12 14:12:29 +0200 90) if (err < 0) {
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 91) printk(KERN_ERR "smu_sat_get_sdb_part rd err %d\n",
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 92) err);
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 93) goto fail;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 94) }
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 95) buf[i] = data[1];
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 96) buf[i+1] = data[0];
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 97) buf[i+2] = data[3];
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 98) buf[i+3] = data[2];
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 99) }
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 100)
fc0c8b36d379a (Benjamin Herrenschmidt 2018-10-15 11:18:49 +1100 101) printk(KERN_DEBUG "sat %d partition %x:", sat_id, id);
fc0c8b36d379a (Benjamin Herrenschmidt 2018-10-15 11:18:49 +1100 102) print_hex_dump(KERN_DEBUG, " ", DUMP_PREFIX_OFFSET,
fc0c8b36d379a (Benjamin Herrenschmidt 2018-10-15 11:18:49 +1100 103) 16, 1, buf, len, false);
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 104) if (size)
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 105) *size = len;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 106) return (struct smu_sdbp_header *) buf;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 107)
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 108) fail:
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 109) kfree(buf);
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 110) return NULL;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 111) }
9127dd1aace4e (Johannes Berg 2006-02-17 13:52:54 -0800 112) EXPORT_SYMBOL_GPL(smu_sat_get_sdb_partition);
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 113)
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 114) /* refresh the cache */
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 115) static int wf_sat_read_cache(struct wf_sat *sat)
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 116) {
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 117) int err;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 118)
351ca3e311979 (Jean Delvare 2009-06-15 18:01:51 +0200 119) err = i2c_smbus_read_i2c_block_data(sat->i2c, 0x3f, 16, sat->cache);
4b2643d7d9bdc (Jean Delvare 2007-07-12 14:12:29 +0200 120) if (err < 0)
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 121) return err;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 122) sat->last_read = jiffies;
fc0c8b36d379a (Benjamin Herrenschmidt 2018-10-15 11:18:49 +1100 123)
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 124) #ifdef LOTSA_DEBUG
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 125) {
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 126) int i;
fc0c8b36d379a (Benjamin Herrenschmidt 2018-10-15 11:18:49 +1100 127) printk(KERN_DEBUG "wf_sat_get: data is");
fc0c8b36d379a (Benjamin Herrenschmidt 2018-10-15 11:18:49 +1100 128) print_hex_dump(KERN_DEBUG, " ", DUMP_PREFIX_OFFSET,
fc0c8b36d379a (Benjamin Herrenschmidt 2018-10-15 11:18:49 +1100 129) 16, 1, sat->cache, 16, false);
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 130) }
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 131) #endif
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 132) return 0;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 133) }
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 134)
e326b30fda9a9 (Benjamin Herrenschmidt 2012-04-18 22:16:46 +0000 135) static int wf_sat_sensor_get(struct wf_sensor *sr, s32 *value)
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 136) {
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 137) struct wf_sat_sensor *sens = wf_to_sat(sr);
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 138) struct wf_sat *sat = sens->sat;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 139) int i, err;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 140) s32 val;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 141)
351ca3e311979 (Jean Delvare 2009-06-15 18:01:51 +0200 142) if (sat->i2c == NULL)
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 143) return -ENODEV;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 144)
56783c5e4dd32 (Daniel Walker 2008-05-03 06:34:02 +1000 145) mutex_lock(&sat->mutex);
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 146) if (time_after(jiffies, (sat->last_read + MAX_AGE))) {
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 147) err = wf_sat_read_cache(sat);
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 148) if (err)
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 149) goto fail;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 150) }
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 151)
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 152) i = sens->index * 2;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 153) val = ((sat->cache[i] << 8) + sat->cache[i+1]) << sens->shift;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 154) if (sens->index2 >= 0) {
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 155) i = sens->index2 * 2;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 156) /* 4.12 * 8.8 -> 12.20; shift right 4 to get 16.16 */
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 157) val = (val * ((sat->cache[i] << 8) + sat->cache[i+1])) >> 4;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 158) }
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 159)
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 160) *value = val;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 161) err = 0;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 162)
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 163) fail:
56783c5e4dd32 (Daniel Walker 2008-05-03 06:34:02 +1000 164) mutex_unlock(&sat->mutex);
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 165) return err;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 166) }
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 167)
e326b30fda9a9 (Benjamin Herrenschmidt 2012-04-18 22:16:46 +0000 168) static void wf_sat_release(struct kref *ref)
e326b30fda9a9 (Benjamin Herrenschmidt 2012-04-18 22:16:46 +0000 169) {
e326b30fda9a9 (Benjamin Herrenschmidt 2012-04-18 22:16:46 +0000 170) struct wf_sat *sat = container_of(ref, struct wf_sat, ref);
e326b30fda9a9 (Benjamin Herrenschmidt 2012-04-18 22:16:46 +0000 171)
e326b30fda9a9 (Benjamin Herrenschmidt 2012-04-18 22:16:46 +0000 172) if (sat->nr >= 0)
e326b30fda9a9 (Benjamin Herrenschmidt 2012-04-18 22:16:46 +0000 173) sats[sat->nr] = NULL;
e326b30fda9a9 (Benjamin Herrenschmidt 2012-04-18 22:16:46 +0000 174) kfree(sat);
e326b30fda9a9 (Benjamin Herrenschmidt 2012-04-18 22:16:46 +0000 175) }
e326b30fda9a9 (Benjamin Herrenschmidt 2012-04-18 22:16:46 +0000 176)
e326b30fda9a9 (Benjamin Herrenschmidt 2012-04-18 22:16:46 +0000 177) static void wf_sat_sensor_release(struct wf_sensor *sr)
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 178) {
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 179) struct wf_sat_sensor *sens = wf_to_sat(sr);
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 180) struct wf_sat *sat = sens->sat;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 181)
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 182) kfree(sens);
e326b30fda9a9 (Benjamin Herrenschmidt 2012-04-18 22:16:46 +0000 183) kref_put(&sat->ref, wf_sat_release);
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 184) }
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 185)
de854e54d79bc (Julia Lawall 2017-08-02 23:01:45 +0200 186) static const struct wf_sensor_ops wf_sat_ops = {
e326b30fda9a9 (Benjamin Herrenschmidt 2012-04-18 22:16:46 +0000 187) .get_value = wf_sat_sensor_get,
e326b30fda9a9 (Benjamin Herrenschmidt 2012-04-18 22:16:46 +0000 188) .release = wf_sat_sensor_release,
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 189) .owner = THIS_MODULE,
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 190) };
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 191)
351ca3e311979 (Jean Delvare 2009-06-15 18:01:51 +0200 192) static int wf_sat_probe(struct i2c_client *client,
351ca3e311979 (Jean Delvare 2009-06-15 18:01:51 +0200 193) const struct i2c_device_id *id)
351ca3e311979 (Jean Delvare 2009-06-15 18:01:51 +0200 194) {
9525a08b30b1c (Benjamin Herrenschmidt 2012-05-08 13:28:37 +1000 195) struct device_node *dev = client->dev.of_node;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 196) struct wf_sat *sat;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 197) struct wf_sat_sensor *sens;
018a3d1db7cdb (Jeremy Kerr 2006-07-12 15:40:29 +1000 198) const u32 *reg;
bf82d3758d4a0 (Rob Herring 2018-11-16 16:11:01 -0600 199) const char *loc;
351ca3e311979 (Jean Delvare 2009-06-15 18:01:51 +0200 200) u8 chip, core;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 201) struct device_node *child;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 202) int shift, cpu, index;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 203) char *name;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 204) int vsens[2], isens[2];
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 205)
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 206) sat = kzalloc(sizeof(struct wf_sat), GFP_KERNEL);
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 207) if (sat == NULL)
351ca3e311979 (Jean Delvare 2009-06-15 18:01:51 +0200 208) return -ENOMEM;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 209) sat->nr = -1;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 210) sat->node = of_node_get(dev);
e326b30fda9a9 (Benjamin Herrenschmidt 2012-04-18 22:16:46 +0000 211) kref_init(&sat->ref);
56783c5e4dd32 (Daniel Walker 2008-05-03 06:34:02 +1000 212) mutex_init(&sat->mutex);
351ca3e311979 (Jean Delvare 2009-06-15 18:01:51 +0200 213) sat->i2c = client;
e326b30fda9a9 (Benjamin Herrenschmidt 2012-04-18 22:16:46 +0000 214) INIT_LIST_HEAD(&sat->sensors);
351ca3e311979 (Jean Delvare 2009-06-15 18:01:51 +0200 215) i2c_set_clientdata(client, sat);
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 216)
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 217) vsens[0] = vsens[1] = -1;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 218) isens[0] = isens[1] = -1;
8f7e57e8e29c4 (Qinglang Miao 2020-09-14 14:14:11 +0800 219) for_each_child_of_node(dev, child) {
01b2726dd11ef (Stephen Rothwell 2007-04-27 13:41:15 +1000 220) reg = of_get_property(child, "reg", NULL);
01b2726dd11ef (Stephen Rothwell 2007-04-27 13:41:15 +1000 221) loc = of_get_property(child, "location", NULL);
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 222) if (reg == NULL || loc == NULL)
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 223) continue;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 224)
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 225) /* the cooked sensors are between 0x30 and 0x37 */
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 226) if (*reg < 0x30 || *reg > 0x37)
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 227) continue;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 228) index = *reg - 0x30;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 229)
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 230) /* expect location to be CPU [AB][01] ... */
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 231) if (strncmp(loc, "CPU ", 4) != 0)
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 232) continue;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 233) chip = loc[4] - 'A';
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 234) core = loc[5] - '0';
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 235) if (chip > 1 || core > 1) {
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 236) printk(KERN_ERR "wf_sat_create: don't understand "
b6a945ae03fd3 (Rob Herring 2017-07-18 16:43:12 -0500 237) "location %s for %pOF\n", loc, child);
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 238) continue;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 239) }
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 240) cpu = 2 * chip + core;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 241) if (sat->nr < 0)
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 242) sat->nr = chip;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 243) else if (sat->nr != chip) {
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 244) printk(KERN_ERR "wf_sat_create: can't cope with "
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 245) "multiple CPU chips on one SAT (%s)\n", loc);
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 246) continue;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 247) }
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 248)
bf82d3758d4a0 (Rob Herring 2018-11-16 16:11:01 -0600 249) if (of_node_is_type(child, "voltage-sensor")) {
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 250) name = "cpu-voltage";
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 251) shift = 4;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 252) vsens[core] = index;
bf82d3758d4a0 (Rob Herring 2018-11-16 16:11:01 -0600 253) } else if (of_node_is_type(child, "current-sensor")) {
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 254) name = "cpu-current";
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 255) shift = 8;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 256) isens[core] = index;
bf82d3758d4a0 (Rob Herring 2018-11-16 16:11:01 -0600 257) } else if (of_node_is_type(child, "temp-sensor")) {
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 258) name = "cpu-temp";
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 259) shift = 10;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 260) } else
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 261) continue; /* hmmm shouldn't happen */
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 262)
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 263) /* the +16 is enough for "cpu-voltage-n" */
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 264) sens = kzalloc(sizeof(struct wf_sat_sensor) + 16, GFP_KERNEL);
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 265) if (sens == NULL) {
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 266) printk(KERN_ERR "wf_sat_create: couldn't create "
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 267) "%s sensor %d (no memory)\n", name, cpu);
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 268) continue;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 269) }
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 270) sens->index = index;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 271) sens->index2 = -1;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 272) sens->shift = shift;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 273) sens->sat = sat;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 274) sens->sens.ops = &wf_sat_ops;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 275) sens->sens.name = (char *) (sens + 1);
43671cc96e584 (Stephen Rothwell 2012-05-02 20:19:43 +0000 276) snprintf((char *)sens->sens.name, 16, "%s-%d", name, cpu);
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 277)
e326b30fda9a9 (Benjamin Herrenschmidt 2012-04-18 22:16:46 +0000 278) if (wf_register_sensor(&sens->sens))
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 279) kfree(sens);
e326b30fda9a9 (Benjamin Herrenschmidt 2012-04-18 22:16:46 +0000 280) else {
e326b30fda9a9 (Benjamin Herrenschmidt 2012-04-18 22:16:46 +0000 281) list_add(&sens->link, &sat->sensors);
e326b30fda9a9 (Benjamin Herrenschmidt 2012-04-18 22:16:46 +0000 282) kref_get(&sat->ref);
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 283) }
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 284) }
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 285)
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 286) /* make the power sensors */
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 287) for (core = 0; core < 2; ++core) {
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 288) if (vsens[core] < 0 || isens[core] < 0)
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 289) continue;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 290) cpu = 2 * sat->nr + core;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 291) sens = kzalloc(sizeof(struct wf_sat_sensor) + 16, GFP_KERNEL);
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 292) if (sens == NULL) {
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 293) printk(KERN_ERR "wf_sat_create: couldn't create power "
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 294) "sensor %d (no memory)\n", cpu);
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 295) continue;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 296) }
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 297) sens->index = vsens[core];
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 298) sens->index2 = isens[core];
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 299) sens->shift = 0;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 300) sens->sat = sat;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 301) sens->sens.ops = &wf_sat_ops;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 302) sens->sens.name = (char *) (sens + 1);
43671cc96e584 (Stephen Rothwell 2012-05-02 20:19:43 +0000 303) snprintf((char *)sens->sens.name, 16, "cpu-power-%d", cpu);
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 304)
e326b30fda9a9 (Benjamin Herrenschmidt 2012-04-18 22:16:46 +0000 305) if (wf_register_sensor(&sens->sens))
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 306) kfree(sens);
e326b30fda9a9 (Benjamin Herrenschmidt 2012-04-18 22:16:46 +0000 307) else {
e326b30fda9a9 (Benjamin Herrenschmidt 2012-04-18 22:16:46 +0000 308) list_add(&sens->link, &sat->sensors);
e326b30fda9a9 (Benjamin Herrenschmidt 2012-04-18 22:16:46 +0000 309) kref_get(&sat->ref);
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 310) }
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 311) }
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 312)
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 313) if (sat->nr >= 0)
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 314) sats[sat->nr] = sat;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 315)
351ca3e311979 (Jean Delvare 2009-06-15 18:01:51 +0200 316) return 0;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 317) }
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 318)
351ca3e311979 (Jean Delvare 2009-06-15 18:01:51 +0200 319) static int wf_sat_remove(struct i2c_client *client)
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 320) {
351ca3e311979 (Jean Delvare 2009-06-15 18:01:51 +0200 321) struct wf_sat *sat = i2c_get_clientdata(client);
e326b30fda9a9 (Benjamin Herrenschmidt 2012-04-18 22:16:46 +0000 322) struct wf_sat_sensor *sens;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 323)
e326b30fda9a9 (Benjamin Herrenschmidt 2012-04-18 22:16:46 +0000 324) /* release sensors */
e326b30fda9a9 (Benjamin Herrenschmidt 2012-04-18 22:16:46 +0000 325) while(!list_empty(&sat->sensors)) {
e326b30fda9a9 (Benjamin Herrenschmidt 2012-04-18 22:16:46 +0000 326) sens = list_first_entry(&sat->sensors,
e326b30fda9a9 (Benjamin Herrenschmidt 2012-04-18 22:16:46 +0000 327) struct wf_sat_sensor, link);
e326b30fda9a9 (Benjamin Herrenschmidt 2012-04-18 22:16:46 +0000 328) list_del(&sens->link);
e326b30fda9a9 (Benjamin Herrenschmidt 2012-04-18 22:16:46 +0000 329) wf_unregister_sensor(&sens->sens);
e326b30fda9a9 (Benjamin Herrenschmidt 2012-04-18 22:16:46 +0000 330) }
351ca3e311979 (Jean Delvare 2009-06-15 18:01:51 +0200 331) sat->i2c = NULL;
e326b30fda9a9 (Benjamin Herrenschmidt 2012-04-18 22:16:46 +0000 332) kref_put(&sat->ref, wf_sat_release);
e326b30fda9a9 (Benjamin Herrenschmidt 2012-04-18 22:16:46 +0000 333)
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 334) return 0;
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 335) }
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 336)
351ca3e311979 (Jean Delvare 2009-06-15 18:01:51 +0200 337) static const struct i2c_device_id wf_sat_id[] = {
e326b30fda9a9 (Benjamin Herrenschmidt 2012-04-18 22:16:46 +0000 338) { "MAC,smu-sat", 0 },
351ca3e311979 (Jean Delvare 2009-06-15 18:01:51 +0200 339) { }
351ca3e311979 (Jean Delvare 2009-06-15 18:01:51 +0200 340) };
e326b30fda9a9 (Benjamin Herrenschmidt 2012-04-18 22:16:46 +0000 341) MODULE_DEVICE_TABLE(i2c, wf_sat_id);
351ca3e311979 (Jean Delvare 2009-06-15 18:01:51 +0200 342)
bcf3588d8ed35 (Wolfram Sang 2020-03-03 13:50:46 +0100 343) static const struct of_device_id wf_sat_of_id[] = {
bcf3588d8ed35 (Wolfram Sang 2020-03-03 13:50:46 +0100 344) { .compatible = "smu-sat", },
bcf3588d8ed35 (Wolfram Sang 2020-03-03 13:50:46 +0100 345) { }
bcf3588d8ed35 (Wolfram Sang 2020-03-03 13:50:46 +0100 346) };
bcf3588d8ed35 (Wolfram Sang 2020-03-03 13:50:46 +0100 347) MODULE_DEVICE_TABLE(of, wf_sat_of_id);
bcf3588d8ed35 (Wolfram Sang 2020-03-03 13:50:46 +0100 348)
351ca3e311979 (Jean Delvare 2009-06-15 18:01:51 +0200 349) static struct i2c_driver wf_sat_driver = {
351ca3e311979 (Jean Delvare 2009-06-15 18:01:51 +0200 350) .driver = {
351ca3e311979 (Jean Delvare 2009-06-15 18:01:51 +0200 351) .name = "wf_smu_sat",
bcf3588d8ed35 (Wolfram Sang 2020-03-03 13:50:46 +0100 352) .of_match_table = wf_sat_of_id,
351ca3e311979 (Jean Delvare 2009-06-15 18:01:51 +0200 353) },
351ca3e311979 (Jean Delvare 2009-06-15 18:01:51 +0200 354) .probe = wf_sat_probe,
351ca3e311979 (Jean Delvare 2009-06-15 18:01:51 +0200 355) .remove = wf_sat_remove,
351ca3e311979 (Jean Delvare 2009-06-15 18:01:51 +0200 356) .id_table = wf_sat_id,
351ca3e311979 (Jean Delvare 2009-06-15 18:01:51 +0200 357) };
351ca3e311979 (Jean Delvare 2009-06-15 18:01:51 +0200 358)
f7fb862b84326 (Wei Yongjun 2012-10-08 03:00:04 +0000 359) module_i2c_driver(wf_sat_driver);
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 360)
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 361) MODULE_AUTHOR("Paul Mackerras <paulus@samba.org>");
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 362) MODULE_DESCRIPTION("SMU satellite sensors for PowerMac thermal control");
ac171c46667c1 (Benjamin Herrenschmidt 2006-02-08 16:42:51 +1100 363) MODULE_LICENSE("GPL");
VisionFive2 Linux kernel
StarFive Tech Linux Kernel for VisionFive (JH7110) boards (mirror)
More than 9999 Commits
32 Branches
54 Tags