^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0-only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * Windfarm PowerMac thermal control. FCU fan control
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * Copyright 2012 Benjamin Herrenschmidt, IBM Corp.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) #undef DEBUG
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) #include <linux/types.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <linux/errno.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <linux/delay.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <linux/init.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include <linux/wait.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include <linux/i2c.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #include <asm/prom.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) #include <asm/machdep.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) #include <asm/io.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) #include <asm/sections.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) #include "windfarm.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) #include "windfarm_mpu.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) #define VERSION "1.0"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) #ifdef DEBUG
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) #define DBG(args...) printk(args)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) #else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) #define DBG(args...) do { } while(0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) * This option is "weird" :) Basically, if you define this to 1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) * the control loop for the RPMs fans (not PWMs) will apply the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) * correction factor obtained from the PID to the actual RPM
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) * speed read from the FCU.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) * If you define the below constant to 0, then it will be
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) * applied to the setpoint RPM speed, that is basically the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) * speed we proviously "asked" for.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) * I'm using 0 for now which is what therm_pm72 used to do and
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) * what Darwin -apparently- does based on observed behaviour.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) #define RPM_PID_USE_ACTUAL_SPEED 0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) /* Default min/max for pumps */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) #define CPU_PUMP_OUTPUT_MAX 3200
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) #define CPU_PUMP_OUTPUT_MIN 1250
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) #define FCU_FAN_RPM 0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) #define FCU_FAN_PWM 1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) struct wf_fcu_priv {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) struct kref ref;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) struct i2c_client *i2c;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) struct mutex lock;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) struct list_head fan_list;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) int rpm_shift;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) struct wf_fcu_fan {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) struct list_head link;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) int id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) s32 min, max, target;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) struct wf_fcu_priv *fcu_priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) struct wf_control ctrl;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) static void wf_fcu_release(struct kref *ref)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) struct wf_fcu_priv *pv = container_of(ref, struct wf_fcu_priv, ref);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) kfree(pv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) static void wf_fcu_fan_release(struct wf_control *ct)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) struct wf_fcu_fan *fan = ct->priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) kref_put(&fan->fcu_priv->ref, wf_fcu_release);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) kfree(fan);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) static int wf_fcu_read_reg(struct wf_fcu_priv *pv, int reg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) unsigned char *buf, int nb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) int tries, nr, nw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) mutex_lock(&pv->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) buf[0] = reg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) tries = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) for (;;) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) nw = i2c_master_send(pv->i2c, buf, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) if (nw > 0 || (nw < 0 && nw != -EIO) || tries >= 100)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) msleep(10);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) ++tries;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) if (nw <= 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) pr_err("Failure writing address to FCU: %d", nw);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) nr = nw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) goto bail;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) tries = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) for (;;) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) nr = i2c_master_recv(pv->i2c, buf, nb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) if (nr > 0 || (nr < 0 && nr != -ENODEV) || tries >= 100)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) msleep(10);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) ++tries;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) if (nr <= 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) pr_err("wf_fcu: Failure reading data from FCU: %d", nw);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) bail:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) mutex_unlock(&pv->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) return nr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) static int wf_fcu_write_reg(struct wf_fcu_priv *pv, int reg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) const unsigned char *ptr, int nb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) int tries, nw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) unsigned char buf[16];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) buf[0] = reg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) memcpy(buf+1, ptr, nb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) ++nb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) tries = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) for (;;) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) nw = i2c_master_send(pv->i2c, buf, nb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) if (nw > 0 || (nw < 0 && nw != -EIO) || tries >= 100)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) msleep(10);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) ++tries;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) if (nw < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) pr_err("wf_fcu: Failure writing to FCU: %d", nw);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) return nw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) static int wf_fcu_fan_set_rpm(struct wf_control *ct, s32 value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) struct wf_fcu_fan *fan = ct->priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) struct wf_fcu_priv *pv = fan->fcu_priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) int rc, shift = pv->rpm_shift;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) unsigned char buf[2];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) if (value < fan->min)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) value = fan->min;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) if (value > fan->max)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) value = fan->max;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) fan->target = value;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) buf[0] = value >> (8 - shift);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) buf[1] = value << shift;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) rc = wf_fcu_write_reg(pv, 0x10 + (fan->id * 2), buf, 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) if (rc < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) static int wf_fcu_fan_get_rpm(struct wf_control *ct, s32 *value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) struct wf_fcu_fan *fan = ct->priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) struct wf_fcu_priv *pv = fan->fcu_priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) int rc, reg_base, shift = pv->rpm_shift;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) unsigned char failure;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) unsigned char active;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) unsigned char buf[2];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) rc = wf_fcu_read_reg(pv, 0xb, &failure, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) if (rc != 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) if ((failure & (1 << fan->id)) != 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) return -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) rc = wf_fcu_read_reg(pv, 0xd, &active, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) if (rc != 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) if ((active & (1 << fan->id)) == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) return -ENXIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) /* Programmed value or real current speed */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) #if RPM_PID_USE_ACTUAL_SPEED
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) reg_base = 0x11;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) #else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) reg_base = 0x10;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) rc = wf_fcu_read_reg(pv, reg_base + (fan->id * 2), buf, 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) if (rc != 2)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) *value = (buf[0] << (8 - shift)) | buf[1] >> shift;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) static int wf_fcu_fan_set_pwm(struct wf_control *ct, s32 value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) struct wf_fcu_fan *fan = ct->priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) struct wf_fcu_priv *pv = fan->fcu_priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) unsigned char buf[2];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) if (value < fan->min)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) value = fan->min;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) if (value > fan->max)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) value = fan->max;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) fan->target = value;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) value = (value * 2559) / 1000;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) buf[0] = value;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) rc = wf_fcu_write_reg(pv, 0x30 + (fan->id * 2), buf, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) if (rc < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) static int wf_fcu_fan_get_pwm(struct wf_control *ct, s32 *value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) struct wf_fcu_fan *fan = ct->priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) struct wf_fcu_priv *pv = fan->fcu_priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) unsigned char failure;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) unsigned char active;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) unsigned char buf[2];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) rc = wf_fcu_read_reg(pv, 0x2b, &failure, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) if (rc != 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) if ((failure & (1 << fan->id)) != 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) return -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) rc = wf_fcu_read_reg(pv, 0x2d, &active, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) if (rc != 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) if ((active & (1 << fan->id)) == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) return -ENXIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) rc = wf_fcu_read_reg(pv, 0x30 + (fan->id * 2), buf, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) if (rc != 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) *value = (((s32)buf[0]) * 1000) / 2559;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) static s32 wf_fcu_fan_min(struct wf_control *ct)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) struct wf_fcu_fan *fan = ct->priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) return fan->min;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) static s32 wf_fcu_fan_max(struct wf_control *ct)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) struct wf_fcu_fan *fan = ct->priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) return fan->max;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) static const struct wf_control_ops wf_fcu_fan_rpm_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) .set_value = wf_fcu_fan_set_rpm,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) .get_value = wf_fcu_fan_get_rpm,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) .get_min = wf_fcu_fan_min,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) .get_max = wf_fcu_fan_max,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) .release = wf_fcu_fan_release,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) .owner = THIS_MODULE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) static const struct wf_control_ops wf_fcu_fan_pwm_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) .set_value = wf_fcu_fan_set_pwm,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) .get_value = wf_fcu_fan_get_pwm,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) .get_min = wf_fcu_fan_min,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) .get_max = wf_fcu_fan_max,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) .release = wf_fcu_fan_release,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) .owner = THIS_MODULE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) static void wf_fcu_get_pump_minmax(struct wf_fcu_fan *fan)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) const struct mpu_data *mpu = wf_get_mpu(0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) u16 pump_min = 0, pump_max = 0xffff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) u16 tmp[4];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) /* Try to fetch pumps min/max infos from eeprom */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) if (mpu) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) memcpy(&tmp, mpu->processor_part_num, 8);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) if (tmp[0] != 0xffff && tmp[1] != 0xffff) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) pump_min = max(pump_min, tmp[0]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) pump_max = min(pump_max, tmp[1]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) if (tmp[2] != 0xffff && tmp[3] != 0xffff) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) pump_min = max(pump_min, tmp[2]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) pump_max = min(pump_max, tmp[3]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) /* Double check the values, this _IS_ needed as the EEPROM on
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) * some dual 2.5Ghz G5s seem, at least, to have both min & max
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) * same to the same value ... (grrrr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) if (pump_min == pump_max || pump_min == 0 || pump_max == 0xffff) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) pump_min = CPU_PUMP_OUTPUT_MIN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) pump_max = CPU_PUMP_OUTPUT_MAX;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) fan->min = pump_min;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) fan->max = pump_max;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) DBG("wf_fcu: pump min/max for %s set to: [%d..%d] RPM\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) fan->ctrl.name, pump_min, pump_max);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) static void wf_fcu_get_rpmfan_minmax(struct wf_fcu_fan *fan)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) struct wf_fcu_priv *pv = fan->fcu_priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) const struct mpu_data *mpu0 = wf_get_mpu(0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) const struct mpu_data *mpu1 = wf_get_mpu(1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) /* Default */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) fan->min = 2400 >> pv->rpm_shift;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) fan->max = 56000 >> pv->rpm_shift;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) /* CPU fans have min/max in MPU */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) if (mpu0 && !strcmp(fan->ctrl.name, "cpu-front-fan-0")) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) fan->min = max(fan->min, (s32)mpu0->rminn_intake_fan);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) fan->max = min(fan->max, (s32)mpu0->rmaxn_intake_fan);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) goto bail;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) if (mpu1 && !strcmp(fan->ctrl.name, "cpu-front-fan-1")) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) fan->min = max(fan->min, (s32)mpu1->rminn_intake_fan);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) fan->max = min(fan->max, (s32)mpu1->rmaxn_intake_fan);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) goto bail;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) if (mpu0 && !strcmp(fan->ctrl.name, "cpu-rear-fan-0")) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) fan->min = max(fan->min, (s32)mpu0->rminn_exhaust_fan);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) fan->max = min(fan->max, (s32)mpu0->rmaxn_exhaust_fan);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) goto bail;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) if (mpu1 && !strcmp(fan->ctrl.name, "cpu-rear-fan-1")) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) fan->min = max(fan->min, (s32)mpu1->rminn_exhaust_fan);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) fan->max = min(fan->max, (s32)mpu1->rmaxn_exhaust_fan);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) goto bail;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) /* Rackmac variants, we just use mpu0 intake */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) if (!strncmp(fan->ctrl.name, "cpu-fan", 7)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) fan->min = max(fan->min, (s32)mpu0->rminn_intake_fan);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) fan->max = min(fan->max, (s32)mpu0->rmaxn_intake_fan);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) goto bail;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) bail:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) DBG("wf_fcu: fan min/max for %s set to: [%d..%d] RPM\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) fan->ctrl.name, fan->min, fan->max);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) static void wf_fcu_add_fan(struct wf_fcu_priv *pv, const char *name,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) int type, int id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) struct wf_fcu_fan *fan;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) fan = kzalloc(sizeof(*fan), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) if (!fan)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) fan->fcu_priv = pv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) fan->id = id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) fan->ctrl.name = name;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) fan->ctrl.priv = fan;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) /* min/max is oddball but the code comes from
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) * therm_pm72 which seems to work so ...
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) if (type == FCU_FAN_RPM) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) if (!strncmp(name, "cpu-pump", strlen("cpu-pump")))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) wf_fcu_get_pump_minmax(fan);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) wf_fcu_get_rpmfan_minmax(fan);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) fan->ctrl.type = WF_CONTROL_RPM_FAN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) fan->ctrl.ops = &wf_fcu_fan_rpm_ops;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) fan->min = 10;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) fan->max = 100;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) fan->ctrl.type = WF_CONTROL_PWM_FAN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) fan->ctrl.ops = &wf_fcu_fan_pwm_ops;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) if (wf_register_control(&fan->ctrl)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) pr_err("wf_fcu: Failed to register fan %s\n", name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) kfree(fan);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) list_add(&fan->link, &pv->fan_list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) kref_get(&pv->ref);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) static void wf_fcu_lookup_fans(struct wf_fcu_priv *pv)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) /* Translation of device-tree location properties to
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) * windfarm fan names
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) static const struct {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) const char *dt_name; /* Device-tree name */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) const char *ct_name; /* Control name */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) } loc_trans[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) { "BACKSIDE", "backside-fan", },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) { "SYS CTRLR FAN", "backside-fan", },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) { "DRIVE BAY", "drive-bay-fan", },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) { "SLOT", "slots-fan", },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) { "PCI FAN", "slots-fan", },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) { "CPU A INTAKE", "cpu-front-fan-0", },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) { "CPU A EXHAUST", "cpu-rear-fan-0", },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) { "CPU B INTAKE", "cpu-front-fan-1", },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) { "CPU B EXHAUST", "cpu-rear-fan-1", },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) { "CPU A PUMP", "cpu-pump-0", },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) { "CPU B PUMP", "cpu-pump-1", },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) { "CPU A 1", "cpu-fan-a-0", },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) { "CPU A 2", "cpu-fan-b-0", },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) { "CPU A 3", "cpu-fan-c-0", },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) { "CPU B 1", "cpu-fan-a-1", },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) { "CPU B 2", "cpu-fan-b-1", },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) { "CPU B 3", "cpu-fan-c-1", },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) struct device_node *np, *fcu = pv->i2c->dev.of_node;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430) DBG("Looking up FCU controls in device-tree...\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) for_each_child_of_node(fcu, np) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433) int id, type = -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434) const char *loc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435) const char *name;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436) const u32 *reg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) DBG(" control: %pOFn, type: %s\n", np, of_node_get_device_type(np));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440) /* Detect control type */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441) if (of_node_is_type(np, "fan-rpm-control") ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442) of_node_is_type(np, "fan-rpm"))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443) type = FCU_FAN_RPM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444) if (of_node_is_type(np, "fan-pwm-control") ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) of_node_is_type(np, "fan-pwm"))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) type = FCU_FAN_PWM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447) /* Only care about fans for now */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448) if (type == -1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451) /* Lookup for a matching location */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452) loc = of_get_property(np, "location", NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453) reg = of_get_property(np, "reg", NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454) if (loc == NULL || reg == NULL)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456) DBG(" matching location: %s, reg: 0x%08x\n", loc, *reg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458) for (i = 0; i < ARRAY_SIZE(loc_trans); i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459) if (strncmp(loc, loc_trans[i].dt_name,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460) strlen(loc_trans[i].dt_name)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462) name = loc_trans[i].ct_name;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 464) DBG(" location match, name: %s\n", name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 465)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 466) if (type == FCU_FAN_RPM)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 467) id = ((*reg) - 0x10) / 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 468) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 469) id = ((*reg) - 0x30) / 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 470) if (id > 7) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 471) pr_warn("wf_fcu: Can't parse fan ID in device-tree for %pOF\n", np);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 472) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 473) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 474) wf_fcu_add_fan(pv, name, type, id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 475) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 476) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 477) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 478) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 479)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 480) static void wf_fcu_default_fans(struct wf_fcu_priv *pv)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 481) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 482) /* We only support the default fans for PowerMac7,2 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 483) if (!of_machine_is_compatible("PowerMac7,2"))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 484) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 485)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 486) wf_fcu_add_fan(pv, "backside-fan", FCU_FAN_PWM, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 487) wf_fcu_add_fan(pv, "drive-bay-fan", FCU_FAN_RPM, 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 488) wf_fcu_add_fan(pv, "slots-fan", FCU_FAN_PWM, 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 489) wf_fcu_add_fan(pv, "cpu-front-fan-0", FCU_FAN_RPM, 3);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 490) wf_fcu_add_fan(pv, "cpu-rear-fan-0", FCU_FAN_RPM, 4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 491) wf_fcu_add_fan(pv, "cpu-front-fan-1", FCU_FAN_RPM, 5);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 492) wf_fcu_add_fan(pv, "cpu-rear-fan-1", FCU_FAN_RPM, 6);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 493) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 494)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 495) static int wf_fcu_init_chip(struct wf_fcu_priv *pv)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 496) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 497) unsigned char buf = 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 498) int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 499)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 500) rc = wf_fcu_write_reg(pv, 0xe, &buf, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 501) if (rc < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 502) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 503) rc = wf_fcu_write_reg(pv, 0x2e, &buf, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 504) if (rc < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 505) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 506) rc = wf_fcu_read_reg(pv, 0, &buf, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 507) if (rc < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 508) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 509) pv->rpm_shift = (buf == 1) ? 2 : 3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 510)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 511) pr_debug("wf_fcu: FCU Initialized, RPM fan shift is %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 512) pv->rpm_shift);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 513)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 514) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 515) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 516)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 517) static int wf_fcu_probe(struct i2c_client *client,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 518) const struct i2c_device_id *id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 519) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 520) struct wf_fcu_priv *pv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 521)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 522) pv = kzalloc(sizeof(*pv), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 523) if (!pv)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 524) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 525)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 526) kref_init(&pv->ref);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 527) mutex_init(&pv->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 528) INIT_LIST_HEAD(&pv->fan_list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 529) pv->i2c = client;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 530)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 531) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 532) * First we must start the FCU which will query the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 533) * shift value to apply to RPMs
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 534) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 535) if (wf_fcu_init_chip(pv)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 536) pr_err("wf_fcu: Initialization failed !\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 537) kfree(pv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 538) return -ENXIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 539) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 540)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 541) /* First lookup fans in the device-tree */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 542) wf_fcu_lookup_fans(pv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 543)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 544) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 545) * Older machines don't have the device-tree entries
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 546) * we are looking for, just hard code the list
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 547) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 548) if (list_empty(&pv->fan_list))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 549) wf_fcu_default_fans(pv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 550)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 551) /* Still no fans ? FAIL */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 552) if (list_empty(&pv->fan_list)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 553) pr_err("wf_fcu: Failed to find fans for your machine\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 554) kfree(pv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 555) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 556) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 557)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 558) dev_set_drvdata(&client->dev, pv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 559)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 560) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 561) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 562)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 563) static int wf_fcu_remove(struct i2c_client *client)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 564) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 565) struct wf_fcu_priv *pv = dev_get_drvdata(&client->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 566) struct wf_fcu_fan *fan;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 567)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 568) while (!list_empty(&pv->fan_list)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 569) fan = list_first_entry(&pv->fan_list, struct wf_fcu_fan, link);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 570) list_del(&fan->link);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 571) wf_unregister_control(&fan->ctrl);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 572) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 573) kref_put(&pv->ref, wf_fcu_release);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 574) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 575) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 576)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 577) static const struct i2c_device_id wf_fcu_id[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 578) { "MAC,fcu", 0 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 579) { }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 580) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 581) MODULE_DEVICE_TABLE(i2c, wf_fcu_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 582)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 583) static const struct of_device_id wf_fcu_of_id[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 584) { .compatible = "fcu", },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 585) { }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 586) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 587) MODULE_DEVICE_TABLE(of, wf_fcu_of_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 588)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 589) static struct i2c_driver wf_fcu_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 590) .driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 591) .name = "wf_fcu",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 592) .of_match_table = wf_fcu_of_id,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 593) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 594) .probe = wf_fcu_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 595) .remove = wf_fcu_remove,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 596) .id_table = wf_fcu_id,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 597) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 598)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 599) module_i2c_driver(wf_fcu_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 600)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 601) MODULE_AUTHOR("Benjamin Herrenschmidt <benh@kernel.crashing.org>");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 602) MODULE_DESCRIPTION("FCU control objects for PowerMacs thermal control");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 603) MODULE_LICENSE("GPL");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 604)
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags