sunxi_thermal.c revision 1.3.2.2
1 1.3.2.2 jdolecek /* $NetBSD: sunxi_thermal.c,v 1.3.2.2 2017/12/03 11:35:56 jdolecek Exp $ */ 2 1.3.2.2 jdolecek 3 1.3.2.2 jdolecek /*- 4 1.3.2.2 jdolecek * Copyright (c) 2016-2017 Jared McNeill <jmcneill (at) invisible.ca> 5 1.3.2.2 jdolecek * All rights reserved. 6 1.3.2.2 jdolecek * 7 1.3.2.2 jdolecek * Redistribution and use in source and binary forms, with or without 8 1.3.2.2 jdolecek * modification, are permitted provided that the following conditions 9 1.3.2.2 jdolecek * are met: 10 1.3.2.2 jdolecek * 1. Redistributions of source code must retain the above copyright 11 1.3.2.2 jdolecek * notice, this list of conditions and the following disclaimer. 12 1.3.2.2 jdolecek * 2. Redistributions in binary form must reproduce the above copyright 13 1.3.2.2 jdolecek * notice, this list of conditions and the following disclaimer in the 14 1.3.2.2 jdolecek * documentation and/or other materials provided with the distribution. 15 1.3.2.2 jdolecek * 16 1.3.2.2 jdolecek * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 17 1.3.2.2 jdolecek * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 18 1.3.2.2 jdolecek * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 19 1.3.2.2 jdolecek * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 20 1.3.2.2 jdolecek * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 21 1.3.2.2 jdolecek * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; 22 1.3.2.2 jdolecek * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 23 1.3.2.2 jdolecek * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 24 1.3.2.2 jdolecek * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 25 1.3.2.2 jdolecek * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 26 1.3.2.2 jdolecek * SUCH DAMAGE. 27 1.3.2.2 jdolecek */ 28 1.3.2.2 jdolecek 29 1.3.2.2 jdolecek /* 30 1.3.2.2 jdolecek * Allwinner thermal sensor controller 31 1.3.2.2 jdolecek */ 32 1.3.2.2 jdolecek 33 1.3.2.2 jdolecek #include <sys/cdefs.h> 34 1.3.2.2 jdolecek __KERNEL_RCSID(0, "$NetBSD: sunxi_thermal.c,v 1.3.2.2 2017/12/03 11:35:56 jdolecek Exp $"); 35 1.3.2.2 jdolecek 36 1.3.2.2 jdolecek #include <sys/param.h> 37 1.3.2.2 jdolecek #include <sys/systm.h> 38 1.3.2.2 jdolecek #include <sys/device.h> 39 1.3.2.2 jdolecek #include <sys/kernel.h> 40 1.3.2.2 jdolecek #include <sys/reboot.h> 41 1.3.2.2 jdolecek 42 1.3.2.2 jdolecek #include <dev/sysmon/sysmonvar.h> 43 1.3.2.2 jdolecek #include <dev/sysmon/sysmon_taskq.h> 44 1.3.2.2 jdolecek 45 1.3.2.2 jdolecek #include <dev/fdt/fdtvar.h> 46 1.3.2.2 jdolecek 47 1.3.2.2 jdolecek #include <arm/sunxi/sunxi_sid.h> 48 1.3.2.2 jdolecek 49 1.3.2.2 jdolecek #define THS_CTRL0 0x00 50 1.3.2.2 jdolecek #define THS_CTRL1 0x04 51 1.3.2.2 jdolecek #define ADC_CALI_EN (1 << 17) 52 1.3.2.2 jdolecek #define THS_CTRL2 0x40 53 1.3.2.2 jdolecek #define SENSOR_ACQ1_SHIFT 16 54 1.3.2.2 jdolecek #define SENSOR2_EN (1 << 2) 55 1.3.2.2 jdolecek #define SENSOR1_EN (1 << 1) 56 1.3.2.2 jdolecek #define SENSOR0_EN (1 << 0) 57 1.3.2.2 jdolecek #define THS_INTC 0x44 58 1.3.2.2 jdolecek #define THS_INTS 0x48 59 1.3.2.2 jdolecek #define THS2_DATA_IRQ_STS (1 << 10) 60 1.3.2.2 jdolecek #define THS1_DATA_IRQ_STS (1 << 9) 61 1.3.2.2 jdolecek #define THS0_DATA_IRQ_STS (1 << 8) 62 1.3.2.2 jdolecek #define SHUT_INT2_STS (1 << 6) 63 1.3.2.2 jdolecek #define SHUT_INT1_STS (1 << 5) 64 1.3.2.2 jdolecek #define SHUT_INT0_STS (1 << 4) 65 1.3.2.2 jdolecek #define ALARM_INT2_STS (1 << 2) 66 1.3.2.2 jdolecek #define ALARM_INT1_STS (1 << 1) 67 1.3.2.2 jdolecek #define ALARM_INT0_STS (1 << 0) 68 1.3.2.2 jdolecek #define THS_ALARM0_CTRL 0x50 69 1.3.2.2 jdolecek #define ALARM_T_HOT_MASK 0xfff 70 1.3.2.2 jdolecek #define ALARM_T_HOT_SHIFT 16 71 1.3.2.2 jdolecek #define ALARM_T_HYST_MASK 0xfff 72 1.3.2.2 jdolecek #define ALARM_T_HYST_SHIFT 0 73 1.3.2.2 jdolecek #define THS_SHUTDOWN0_CTRL 0x60 74 1.3.2.2 jdolecek #define SHUT_T_HOT_MASK 0xfff 75 1.3.2.2 jdolecek #define SHUT_T_HOT_SHIFT 16 76 1.3.2.2 jdolecek #define THS_FILTER 0x70 77 1.3.2.2 jdolecek #define THS_CALIB0 0x74 78 1.3.2.2 jdolecek #define THS_CALIB1 0x78 79 1.3.2.2 jdolecek #define THS_DATA0 0x80 80 1.3.2.2 jdolecek #define THS_DATA1 0x84 81 1.3.2.2 jdolecek #define THS_DATA2 0x88 82 1.3.2.2 jdolecek #define DATA_MASK 0xfff 83 1.3.2.2 jdolecek 84 1.3.2.2 jdolecek #define A83T_ADC_ACQUIRE_TIME 0x17 85 1.3.2.2 jdolecek #define A83T_FILTER 0x4 86 1.3.2.2 jdolecek #define A83T_INTC 0x1000 87 1.3.2.2 jdolecek #define A83T_TEMP_BASE 2719000 88 1.3.2.2 jdolecek #define A83T_TEMP_MUL 1000 89 1.3.2.2 jdolecek #define A83T_TEMP_DIV 14186 90 1.3.2.2 jdolecek #define A83T_CLK_RATE 24000000 91 1.3.2.2 jdolecek 92 1.3.2.2 jdolecek #define A64_ADC_ACQUIRE_TIME 0x190 93 1.3.2.2 jdolecek #define A64_FILTER 0x6 94 1.3.2.2 jdolecek #define A64_INTC 0x18000 95 1.3.2.2 jdolecek #define A64_TEMP_BASE 2170000 96 1.3.2.2 jdolecek #define A64_TEMP_MUL 1000 97 1.3.2.2 jdolecek #define A64_TEMP_DIV 8560 98 1.3.2.2 jdolecek #define A64_CLK_RATE 4000000 99 1.3.2.2 jdolecek 100 1.3.2.2 jdolecek #define H3_ADC_ACQUIRE_TIME 0x3f 101 1.3.2.2 jdolecek #define H3_FILTER 0x6 102 1.3.2.2 jdolecek #define H3_INTC 0x191000 103 1.3.2.2 jdolecek #define H3_TEMP_BASE 217 104 1.3.2.2 jdolecek #define H3_TEMP_MUL 1000 105 1.3.2.2 jdolecek #define H3_TEMP_DIV 8253 106 1.3.2.2 jdolecek #define H3_TEMP_MINUS 1794000 107 1.3.2.2 jdolecek #define H3_CLK_RATE 4000000 108 1.3.2.2 jdolecek #define H3_INIT_ALARM 90 /* degC */ 109 1.3.2.2 jdolecek #define H3_INIT_SHUT 105 /* degC */ 110 1.3.2.2 jdolecek 111 1.3.2.2 jdolecek #define TEMP_C_TO_K 273150000 112 1.3.2.2 jdolecek #define SENSOR_ENABLE_ALL (SENSOR0_EN|SENSOR1_EN|SENSOR2_EN) 113 1.3.2.2 jdolecek #define SHUT_INT_ALL (SHUT_INT0_STS|SHUT_INT1_STS|SHUT_INT2_STS) 114 1.3.2.2 jdolecek #define ALARM_INT_ALL (ALARM_INT0_STS) 115 1.3.2.2 jdolecek 116 1.3.2.2 jdolecek #define MAX_SENSORS 3 117 1.3.2.2 jdolecek 118 1.3.2.2 jdolecek #if notyet 119 1.3.2.2 jdolecek #define THROTTLE_ENABLE_DEFAULT 1 120 1.3.2.2 jdolecek 121 1.3.2.2 jdolecek /* Enable thermal throttling */ 122 1.3.2.2 jdolecek static int sunxi_thermal_throttle_enable = THROTTLE_ENABLE_DEFAULT; 123 1.3.2.2 jdolecek #endif 124 1.3.2.2 jdolecek 125 1.3.2.2 jdolecek struct sunxi_thermal_sensor { 126 1.3.2.2 jdolecek const char *name; 127 1.3.2.2 jdolecek const char *desc; 128 1.3.2.2 jdolecek int init_alarm; 129 1.3.2.2 jdolecek int init_shut; 130 1.3.2.2 jdolecek }; 131 1.3.2.2 jdolecek 132 1.3.2.2 jdolecek struct sunxi_thermal_config { 133 1.3.2.2 jdolecek struct sunxi_thermal_sensor sensors[MAX_SENSORS]; 134 1.3.2.2 jdolecek int nsensors; 135 1.3.2.2 jdolecek uint64_t clk_rate; 136 1.3.2.2 jdolecek uint32_t adc_acquire_time; 137 1.3.2.2 jdolecek int adc_cali_en; 138 1.3.2.2 jdolecek uint32_t filter; 139 1.3.2.2 jdolecek uint32_t intc; 140 1.3.2.2 jdolecek int (*to_temp)(uint32_t); 141 1.3.2.2 jdolecek uint32_t (*to_reg)(int); 142 1.3.2.2 jdolecek int temp_base; 143 1.3.2.2 jdolecek int temp_mul; 144 1.3.2.2 jdolecek int temp_div; 145 1.3.2.2 jdolecek int calib0, calib1; 146 1.3.2.2 jdolecek uint32_t calib0_mask, calib1_mask; 147 1.3.2.2 jdolecek }; 148 1.3.2.2 jdolecek 149 1.3.2.2 jdolecek static int 150 1.3.2.2 jdolecek a83t_to_temp(uint32_t val) 151 1.3.2.2 jdolecek { 152 1.3.2.2 jdolecek return ((A83T_TEMP_BASE - (val * A83T_TEMP_MUL)) / A83T_TEMP_DIV); 153 1.3.2.2 jdolecek } 154 1.3.2.2 jdolecek 155 1.3.2.2 jdolecek static const struct sunxi_thermal_config a83t_config = { 156 1.3.2.2 jdolecek .nsensors = 3, 157 1.3.2.2 jdolecek .sensors = { 158 1.3.2.2 jdolecek [0] = { 159 1.3.2.2 jdolecek .name = "cluster0", 160 1.3.2.2 jdolecek .desc = "CPU cluster 0 temperature", 161 1.3.2.2 jdolecek }, 162 1.3.2.2 jdolecek [1] = { 163 1.3.2.2 jdolecek .name = "cluster1", 164 1.3.2.2 jdolecek .desc = "CPU cluster 1 temperature", 165 1.3.2.2 jdolecek }, 166 1.3.2.2 jdolecek [2] = { 167 1.3.2.2 jdolecek .name = "gpu", 168 1.3.2.2 jdolecek .desc = "GPU temperature", 169 1.3.2.2 jdolecek }, 170 1.3.2.2 jdolecek }, 171 1.3.2.2 jdolecek .clk_rate = A83T_CLK_RATE, 172 1.3.2.2 jdolecek .adc_acquire_time = A83T_ADC_ACQUIRE_TIME, 173 1.3.2.2 jdolecek .adc_cali_en = 1, 174 1.3.2.2 jdolecek .filter = A83T_FILTER, 175 1.3.2.2 jdolecek .intc = A83T_INTC, 176 1.3.2.2 jdolecek .to_temp = a83t_to_temp, 177 1.3.2.2 jdolecek .calib0_mask = 0xffffffff, 178 1.3.2.2 jdolecek .calib1_mask = 0xffffffff, 179 1.3.2.2 jdolecek }; 180 1.3.2.2 jdolecek 181 1.3.2.2 jdolecek static int 182 1.3.2.2 jdolecek a64_to_temp(uint32_t val) 183 1.3.2.2 jdolecek { 184 1.3.2.2 jdolecek return ((A64_TEMP_BASE - (val * A64_TEMP_MUL)) / A64_TEMP_DIV); 185 1.3.2.2 jdolecek } 186 1.3.2.2 jdolecek 187 1.3.2.2 jdolecek static const struct sunxi_thermal_config a64_config = { 188 1.3.2.2 jdolecek .nsensors = 3, 189 1.3.2.2 jdolecek .sensors = { 190 1.3.2.2 jdolecek [0] = { 191 1.3.2.2 jdolecek .name = "cpu", 192 1.3.2.2 jdolecek .desc = "CPU temperature", 193 1.3.2.2 jdolecek }, 194 1.3.2.2 jdolecek [1] = { 195 1.3.2.2 jdolecek .name = "gpu1", 196 1.3.2.2 jdolecek .desc = "GPU temperature 1", 197 1.3.2.2 jdolecek }, 198 1.3.2.2 jdolecek [2] = { 199 1.3.2.2 jdolecek .name = "gpu2", 200 1.3.2.2 jdolecek .desc = "GPU temperature 2", 201 1.3.2.2 jdolecek }, 202 1.3.2.2 jdolecek }, 203 1.3.2.2 jdolecek .clk_rate = A64_CLK_RATE, 204 1.3.2.2 jdolecek .adc_acquire_time = A64_ADC_ACQUIRE_TIME, 205 1.3.2.2 jdolecek .filter = A64_FILTER, 206 1.3.2.2 jdolecek .intc = A64_INTC, 207 1.3.2.2 jdolecek .to_temp = a64_to_temp, 208 1.3.2.2 jdolecek }; 209 1.3.2.2 jdolecek 210 1.3.2.2 jdolecek static int 211 1.3.2.2 jdolecek h3_to_temp(uint32_t val) 212 1.3.2.2 jdolecek { 213 1.3.2.2 jdolecek return (H3_TEMP_BASE - ((val * H3_TEMP_MUL) / H3_TEMP_DIV)); 214 1.3.2.2 jdolecek } 215 1.3.2.2 jdolecek 216 1.3.2.2 jdolecek static uint32_t 217 1.3.2.2 jdolecek h3_to_reg(int val) 218 1.3.2.2 jdolecek { 219 1.3.2.2 jdolecek return ((H3_TEMP_MINUS - (val * H3_TEMP_DIV)) / H3_TEMP_MUL); 220 1.3.2.2 jdolecek } 221 1.3.2.2 jdolecek 222 1.3.2.2 jdolecek static const struct sunxi_thermal_config h3_config = { 223 1.3.2.2 jdolecek .nsensors = 1, 224 1.3.2.2 jdolecek .sensors = { 225 1.3.2.2 jdolecek [0] = { 226 1.3.2.2 jdolecek .name = "cpu", 227 1.3.2.2 jdolecek .desc = "CPU temperature", 228 1.3.2.2 jdolecek .init_alarm = H3_INIT_ALARM, 229 1.3.2.2 jdolecek .init_shut = H3_INIT_SHUT, 230 1.3.2.2 jdolecek }, 231 1.3.2.2 jdolecek }, 232 1.3.2.2 jdolecek .clk_rate = H3_CLK_RATE, 233 1.3.2.2 jdolecek .adc_acquire_time = H3_ADC_ACQUIRE_TIME, 234 1.3.2.2 jdolecek .filter = H3_FILTER, 235 1.3.2.2 jdolecek .intc = H3_INTC, 236 1.3.2.2 jdolecek .to_temp = h3_to_temp, 237 1.3.2.2 jdolecek .to_reg = h3_to_reg, 238 1.3.2.2 jdolecek .calib0_mask = 0xfff, 239 1.3.2.2 jdolecek }; 240 1.3.2.2 jdolecek 241 1.3.2.2 jdolecek static struct of_compat_data compat_data[] = { 242 1.3.2.2 jdolecek { "allwinner,sun8i-a83t-ts", (uintptr_t)&a83t_config }, 243 1.3.2.2 jdolecek { "allwinner,sun8i-h3-ts", (uintptr_t)&h3_config }, 244 1.3.2.2 jdolecek { "allwinner,sun50i-a64-ts", (uintptr_t)&a64_config }, 245 1.3.2.2 jdolecek { NULL, (uintptr_t)NULL } 246 1.3.2.2 jdolecek }; 247 1.3.2.2 jdolecek 248 1.3.2.2 jdolecek struct sunxi_thermal_softc { 249 1.3.2.2 jdolecek device_t dev; 250 1.3.2.2 jdolecek int phandle; 251 1.3.2.2 jdolecek bus_space_tag_t bst; 252 1.3.2.2 jdolecek bus_space_handle_t bsh; 253 1.3.2.2 jdolecek struct sunxi_thermal_config *conf; 254 1.3.2.2 jdolecek 255 1.3.2.2 jdolecek kmutex_t lock; 256 1.3.2.2 jdolecek callout_t tick; 257 1.3.2.2 jdolecek 258 1.3.2.2 jdolecek struct sysmon_envsys *sme; 259 1.3.2.2 jdolecek envsys_data_t data[MAX_SENSORS]; 260 1.3.2.2 jdolecek }; 261 1.3.2.2 jdolecek 262 1.3.2.2 jdolecek #define RD4(sc, reg) \ 263 1.3.2.2 jdolecek bus_space_read_4((sc)->bst, (sc)->bsh, (reg)) 264 1.3.2.2 jdolecek #define WR4(sc, reg, val) \ 265 1.3.2.2 jdolecek bus_space_write_4((sc)->bst, (sc)->bsh, (reg), (val)) 266 1.3.2.2 jdolecek 267 1.3.2.2 jdolecek static int 268 1.3.2.2 jdolecek sunxi_thermal_init(struct sunxi_thermal_softc *sc) 269 1.3.2.2 jdolecek { 270 1.3.2.2 jdolecek uint32_t calib[2]; 271 1.3.2.2 jdolecek int error; 272 1.3.2.2 jdolecek 273 1.3.2.2 jdolecek if (sc->conf->calib0_mask != 0 || sc->conf->calib1_mask != 0) { 274 1.3.2.2 jdolecek /* Read calibration settings from SRAM */ 275 1.3.2.2 jdolecek error = sunxi_sid_read_tscalib(calib); 276 1.3.2.2 jdolecek if (error != 0) 277 1.3.2.2 jdolecek return error; 278 1.3.2.2 jdolecek 279 1.3.2.2 jdolecek calib[0] &= sc->conf->calib0_mask; 280 1.3.2.2 jdolecek calib[1] &= sc->conf->calib1_mask; 281 1.3.2.2 jdolecek 282 1.3.2.2 jdolecek /* Write calibration settings to thermal controller */ 283 1.3.2.2 jdolecek if (calib[0] != 0) 284 1.3.2.2 jdolecek WR4(sc, THS_CALIB0, calib[0]); 285 1.3.2.2 jdolecek if (calib[1] != 0) 286 1.3.2.2 jdolecek WR4(sc, THS_CALIB1, calib[1]); 287 1.3.2.2 jdolecek } 288 1.3.2.2 jdolecek 289 1.3.2.2 jdolecek /* Configure ADC acquire time (CLK_IN/(N+1)) and enable sensors */ 290 1.3.2.2 jdolecek WR4(sc, THS_CTRL1, ADC_CALI_EN); 291 1.3.2.2 jdolecek WR4(sc, THS_CTRL0, sc->conf->adc_acquire_time); 292 1.3.2.2 jdolecek WR4(sc, THS_CTRL2, sc->conf->adc_acquire_time << SENSOR_ACQ1_SHIFT); 293 1.3.2.2 jdolecek 294 1.3.2.2 jdolecek /* Enable average filter */ 295 1.3.2.2 jdolecek WR4(sc, THS_FILTER, sc->conf->filter); 296 1.3.2.2 jdolecek 297 1.3.2.2 jdolecek /* Enable interrupts */ 298 1.3.2.2 jdolecek WR4(sc, THS_INTS, RD4(sc, THS_INTS)); 299 1.3.2.2 jdolecek WR4(sc, THS_INTC, sc->conf->intc | SHUT_INT_ALL | ALARM_INT_ALL); 300 1.3.2.2 jdolecek 301 1.3.2.2 jdolecek /* Enable sensors */ 302 1.3.2.2 jdolecek WR4(sc, THS_CTRL2, RD4(sc, THS_CTRL2) | SENSOR_ENABLE_ALL); 303 1.3.2.2 jdolecek 304 1.3.2.2 jdolecek return 0; 305 1.3.2.2 jdolecek } 306 1.3.2.2 jdolecek 307 1.3.2.2 jdolecek static int 308 1.3.2.2 jdolecek sunxi_thermal_gettemp(struct sunxi_thermal_softc *sc, int sensor) 309 1.3.2.2 jdolecek { 310 1.3.2.2 jdolecek uint32_t val; 311 1.3.2.2 jdolecek 312 1.3.2.2 jdolecek val = RD4(sc, THS_DATA0 + (sensor * 4)); 313 1.3.2.2 jdolecek 314 1.3.2.2 jdolecek return sc->conf->to_temp(val); 315 1.3.2.2 jdolecek } 316 1.3.2.2 jdolecek 317 1.3.2.2 jdolecek static int 318 1.3.2.2 jdolecek sunxi_thermal_getshut(struct sunxi_thermal_softc *sc, int sensor) 319 1.3.2.2 jdolecek { 320 1.3.2.2 jdolecek uint32_t val; 321 1.3.2.2 jdolecek 322 1.3.2.2 jdolecek val = RD4(sc, THS_SHUTDOWN0_CTRL + (sensor * 4)); 323 1.3.2.2 jdolecek val = (val >> SHUT_T_HOT_SHIFT) & SHUT_T_HOT_MASK; 324 1.3.2.2 jdolecek 325 1.3.2.2 jdolecek return sc->conf->to_temp(val); 326 1.3.2.2 jdolecek } 327 1.3.2.2 jdolecek 328 1.3.2.2 jdolecek static void 329 1.3.2.2 jdolecek sunxi_thermal_setshut(struct sunxi_thermal_softc *sc, int sensor, int temp) 330 1.3.2.2 jdolecek { 331 1.3.2.2 jdolecek uint32_t val; 332 1.3.2.2 jdolecek 333 1.3.2.2 jdolecek val = RD4(sc, THS_SHUTDOWN0_CTRL + (sensor * 4)); 334 1.3.2.2 jdolecek val &= ~(SHUT_T_HOT_MASK << SHUT_T_HOT_SHIFT); 335 1.3.2.2 jdolecek val |= (sc->conf->to_reg(temp) << SHUT_T_HOT_SHIFT); 336 1.3.2.2 jdolecek WR4(sc, THS_SHUTDOWN0_CTRL + (sensor * 4), val); 337 1.3.2.2 jdolecek } 338 1.3.2.2 jdolecek 339 1.3.2.2 jdolecek static int 340 1.3.2.2 jdolecek sunxi_thermal_gethyst(struct sunxi_thermal_softc *sc, int sensor) 341 1.3.2.2 jdolecek { 342 1.3.2.2 jdolecek uint32_t val; 343 1.3.2.2 jdolecek 344 1.3.2.2 jdolecek val = RD4(sc, THS_ALARM0_CTRL + (sensor * 4)); 345 1.3.2.2 jdolecek val = (val >> ALARM_T_HYST_SHIFT) & ALARM_T_HYST_MASK; 346 1.3.2.2 jdolecek 347 1.3.2.2 jdolecek return sc->conf->to_temp(val); 348 1.3.2.2 jdolecek } 349 1.3.2.2 jdolecek 350 1.3.2.2 jdolecek static int 351 1.3.2.2 jdolecek sunxi_thermal_getalarm(struct sunxi_thermal_softc *sc, int sensor) 352 1.3.2.2 jdolecek { 353 1.3.2.2 jdolecek uint32_t val; 354 1.3.2.2 jdolecek 355 1.3.2.2 jdolecek val = RD4(sc, THS_ALARM0_CTRL + (sensor * 4)); 356 1.3.2.2 jdolecek val = (val >> ALARM_T_HOT_SHIFT) & ALARM_T_HOT_MASK; 357 1.3.2.2 jdolecek 358 1.3.2.2 jdolecek return sc->conf->to_temp(val); 359 1.3.2.2 jdolecek } 360 1.3.2.2 jdolecek 361 1.3.2.2 jdolecek static void 362 1.3.2.2 jdolecek sunxi_thermal_setalarm(struct sunxi_thermal_softc *sc, int sensor, int temp) 363 1.3.2.2 jdolecek { 364 1.3.2.2 jdolecek uint32_t val; 365 1.3.2.2 jdolecek 366 1.3.2.2 jdolecek val = RD4(sc, THS_ALARM0_CTRL + (sensor * 4)); 367 1.3.2.2 jdolecek val &= ~(ALARM_T_HOT_MASK << ALARM_T_HOT_SHIFT); 368 1.3.2.2 jdolecek val |= (sc->conf->to_reg(temp) << ALARM_T_HOT_SHIFT); 369 1.3.2.2 jdolecek WR4(sc, THS_ALARM0_CTRL + (sensor * 4), val); 370 1.3.2.2 jdolecek } 371 1.3.2.2 jdolecek 372 1.3.2.2 jdolecek static void 373 1.3.2.2 jdolecek sunxi_thermal_task_shut(void *arg) 374 1.3.2.2 jdolecek { 375 1.3.2.2 jdolecek struct sunxi_thermal_softc * const sc = arg; 376 1.3.2.2 jdolecek 377 1.3.2.2 jdolecek device_printf(sc->dev, 378 1.3.2.2 jdolecek "WARNING - current temperature exceeds safe limits\n"); 379 1.3.2.2 jdolecek 380 1.3.2.2 jdolecek cpu_reboot(RB_POWERDOWN, NULL); 381 1.3.2.2 jdolecek } 382 1.3.2.2 jdolecek 383 1.3.2.2 jdolecek static void 384 1.3.2.2 jdolecek sunxi_thermal_task_alarm(void *arg) 385 1.3.2.2 jdolecek { 386 1.3.2.2 jdolecek struct sunxi_thermal_softc * const sc = arg; 387 1.3.2.2 jdolecek 388 1.3.2.2 jdolecek const int alarm_val = sunxi_thermal_getalarm(sc, 0); 389 1.3.2.2 jdolecek const int temp_val = sunxi_thermal_gettemp(sc, 0); 390 1.3.2.2 jdolecek 391 1.3.2.2 jdolecek if (temp_val < alarm_val) 392 1.3.2.2 jdolecek pmf_event_inject(NULL, PMFE_THROTTLE_DISABLE); 393 1.3.2.2 jdolecek else 394 1.3.2.2 jdolecek callout_schedule(&sc->tick, hz); 395 1.3.2.2 jdolecek } 396 1.3.2.2 jdolecek 397 1.3.2.2 jdolecek static void 398 1.3.2.2 jdolecek sunxi_thermal_tick(void *arg) 399 1.3.2.2 jdolecek { 400 1.3.2.2 jdolecek struct sunxi_thermal_softc * const sc = arg; 401 1.3.2.2 jdolecek 402 1.3.2.2 jdolecek sysmon_task_queue_sched(0, sunxi_thermal_task_alarm, sc); 403 1.3.2.2 jdolecek } 404 1.3.2.2 jdolecek 405 1.3.2.2 jdolecek static int 406 1.3.2.2 jdolecek sunxi_thermal_intr(void *arg) 407 1.3.2.2 jdolecek { 408 1.3.2.2 jdolecek struct sunxi_thermal_softc * const sc = arg; 409 1.3.2.2 jdolecek uint32_t ints; 410 1.3.2.2 jdolecek 411 1.3.2.2 jdolecek mutex_enter(&sc->lock); 412 1.3.2.2 jdolecek 413 1.3.2.2 jdolecek ints = RD4(sc, THS_INTS); 414 1.3.2.2 jdolecek WR4(sc, THS_INTS, ints); 415 1.3.2.2 jdolecek 416 1.3.2.2 jdolecek if ((ints & SHUT_INT_ALL) != 0) 417 1.3.2.2 jdolecek sysmon_task_queue_sched(0, sunxi_thermal_task_shut, sc); 418 1.3.2.2 jdolecek 419 1.3.2.2 jdolecek if ((ints & ALARM_INT_ALL) != 0) { 420 1.3.2.2 jdolecek pmf_event_inject(NULL, PMFE_THROTTLE_ENABLE); 421 1.3.2.2 jdolecek sysmon_task_queue_sched(0, sunxi_thermal_task_alarm, sc); 422 1.3.2.2 jdolecek } 423 1.3.2.2 jdolecek 424 1.3.2.2 jdolecek mutex_exit(&sc->lock); 425 1.3.2.2 jdolecek 426 1.3.2.2 jdolecek return 1; 427 1.3.2.2 jdolecek } 428 1.3.2.2 jdolecek 429 1.3.2.2 jdolecek static void 430 1.3.2.2 jdolecek sunxi_thermal_refresh(struct sysmon_envsys *sme, envsys_data_t *edata) 431 1.3.2.2 jdolecek { 432 1.3.2.2 jdolecek struct sunxi_thermal_softc * const sc = sme->sme_cookie; 433 1.3.2.2 jdolecek 434 1.3.2.2 jdolecek const int64_t temp = sunxi_thermal_gettemp(sc, edata->private); 435 1.3.2.2 jdolecek 436 1.3.2.2 jdolecek edata->value_cur = temp * 1000000 + TEMP_C_TO_K; 437 1.3.2.2 jdolecek edata->state = ENVSYS_SVALID; 438 1.3.2.2 jdolecek } 439 1.3.2.2 jdolecek 440 1.3.2.2 jdolecek static int 441 1.3.2.2 jdolecek sunxi_thermal_init_clocks(struct sunxi_thermal_softc *sc) 442 1.3.2.2 jdolecek { 443 1.3.2.2 jdolecek struct fdtbus_reset *rst; 444 1.3.2.2 jdolecek struct clk *clk; 445 1.3.2.2 jdolecek int error; 446 1.3.2.2 jdolecek 447 1.3.2.2 jdolecek clk = fdtbus_clock_get(sc->phandle, "ahb"); 448 1.3.2.2 jdolecek if (clk == NULL) 449 1.3.2.2 jdolecek return ENXIO; 450 1.3.2.2 jdolecek error = clk_enable(clk); 451 1.3.2.2 jdolecek if (error != 0) 452 1.3.2.2 jdolecek return error; 453 1.3.2.2 jdolecek 454 1.3.2.2 jdolecek clk = fdtbus_clock_get(sc->phandle, "ths"); 455 1.3.2.2 jdolecek if (clk == NULL) 456 1.3.2.2 jdolecek return ENXIO; 457 1.3.2.2 jdolecek error = clk_set_rate(clk, sc->conf->clk_rate); 458 1.3.2.2 jdolecek if (error != 0) 459 1.3.2.2 jdolecek return error; 460 1.3.2.2 jdolecek error = clk_enable(clk); 461 1.3.2.2 jdolecek if (error != 0) 462 1.3.2.2 jdolecek return error; 463 1.3.2.2 jdolecek 464 1.3.2.2 jdolecek rst = fdtbus_reset_get_index(sc->phandle, 0); 465 1.3.2.2 jdolecek if (rst == NULL) 466 1.3.2.2 jdolecek return ENXIO; 467 1.3.2.2 jdolecek error = fdtbus_reset_deassert(rst); 468 1.3.2.2 jdolecek if (error != 0) 469 1.3.2.2 jdolecek return error; 470 1.3.2.2 jdolecek 471 1.3.2.2 jdolecek return 0; 472 1.3.2.2 jdolecek } 473 1.3.2.2 jdolecek 474 1.3.2.2 jdolecek static int 475 1.3.2.2 jdolecek sunxi_thermal_match(device_t parent, cfdata_t cf, void *aux) 476 1.3.2.2 jdolecek { 477 1.3.2.2 jdolecek struct fdt_attach_args * const faa = aux; 478 1.3.2.2 jdolecek 479 1.3.2.2 jdolecek return of_match_compat_data(faa->faa_phandle, compat_data); 480 1.3.2.2 jdolecek } 481 1.3.2.2 jdolecek 482 1.3.2.2 jdolecek static void 483 1.3.2.2 jdolecek sunxi_thermal_attach(device_t parent, device_t self, void *aux) 484 1.3.2.2 jdolecek { 485 1.3.2.2 jdolecek struct sunxi_thermal_softc * const sc = device_private(self); 486 1.3.2.2 jdolecek struct fdt_attach_args * const faa = aux; 487 1.3.2.2 jdolecek const int phandle = faa->faa_phandle; 488 1.3.2.2 jdolecek char intrstr[128]; 489 1.3.2.2 jdolecek bus_addr_t addr; 490 1.3.2.2 jdolecek bus_size_t size; 491 1.3.2.2 jdolecek void *ih; 492 1.3.2.2 jdolecek int i; 493 1.3.2.2 jdolecek 494 1.3.2.2 jdolecek if (fdtbus_get_reg(phandle, 0, &addr, &size) != 0) { 495 1.3.2.2 jdolecek aprint_error(": couldn't get registers\n"); 496 1.3.2.2 jdolecek return; 497 1.3.2.2 jdolecek } 498 1.3.2.2 jdolecek 499 1.3.2.2 jdolecek sc->dev = self; 500 1.3.2.2 jdolecek sc->phandle = phandle; 501 1.3.2.2 jdolecek sc->bst = faa->faa_bst; 502 1.3.2.2 jdolecek sc->conf = (void *)of_search_compatible(phandle, compat_data)->data; 503 1.3.2.2 jdolecek if (bus_space_map(sc->bst, addr, size, 0, &sc->bsh) != 0) { 504 1.3.2.2 jdolecek aprint_error(": couldn't map registers\n"); 505 1.3.2.2 jdolecek return; 506 1.3.2.2 jdolecek } 507 1.3.2.2 jdolecek mutex_init(&sc->lock, MUTEX_DEFAULT, IPL_VM); 508 1.3.2.2 jdolecek callout_init(&sc->tick, CALLOUT_MPSAFE); 509 1.3.2.2 jdolecek callout_setfunc(&sc->tick, sunxi_thermal_tick, sc); 510 1.3.2.2 jdolecek 511 1.3.2.2 jdolecek if (sunxi_thermal_init_clocks(sc) != 0) { 512 1.3.2.2 jdolecek aprint_error(": couldn't enable clocks\n"); 513 1.3.2.2 jdolecek return; 514 1.3.2.2 jdolecek } 515 1.3.2.2 jdolecek 516 1.3.2.2 jdolecek if (!fdtbus_intr_str(phandle, 0, intrstr, sizeof(intrstr))) { 517 1.3.2.2 jdolecek aprint_error(": couldn't decode interrupt\n"); 518 1.3.2.2 jdolecek return; 519 1.3.2.2 jdolecek } 520 1.3.2.2 jdolecek 521 1.3.2.2 jdolecek aprint_naive("\n"); 522 1.3.2.2 jdolecek aprint_normal(": Thermal sensor controller\n"); 523 1.3.2.2 jdolecek 524 1.3.2.2 jdolecek ih = fdtbus_intr_establish(phandle, 0, IPL_VM, FDT_INTR_MPSAFE, 525 1.3.2.2 jdolecek sunxi_thermal_intr, sc); 526 1.3.2.2 jdolecek if (ih == NULL) { 527 1.3.2.2 jdolecek aprint_error_dev(self, "couldn't establish interrupt on %s\n", 528 1.3.2.2 jdolecek intrstr); 529 1.3.2.2 jdolecek return; 530 1.3.2.2 jdolecek } 531 1.3.2.2 jdolecek aprint_normal_dev(self, "interrupting on %s\n", intrstr); 532 1.3.2.2 jdolecek 533 1.3.2.2 jdolecek for (i = 0; i < sc->conf->nsensors; i++) { 534 1.3.2.2 jdolecek if (sc->conf->sensors[i].init_alarm > 0) 535 1.3.2.2 jdolecek sunxi_thermal_setalarm(sc, i, 536 1.3.2.2 jdolecek sc->conf->sensors[i].init_alarm); 537 1.3.2.2 jdolecek if (sc->conf->sensors[i].init_shut > 0) 538 1.3.2.2 jdolecek sunxi_thermal_setshut(sc, i, 539 1.3.2.2 jdolecek sc->conf->sensors[i].init_shut); 540 1.3.2.2 jdolecek } 541 1.3.2.2 jdolecek 542 1.3.2.2 jdolecek if (sunxi_thermal_init(sc) != 0) { 543 1.3.2.2 jdolecek aprint_error_dev(self, "failed to initialize sensors\n"); 544 1.3.2.2 jdolecek return; 545 1.3.2.2 jdolecek } 546 1.3.2.2 jdolecek 547 1.3.2.2 jdolecek sc->sme = sysmon_envsys_create(); 548 1.3.2.2 jdolecek sc->sme->sme_name = device_xname(self); 549 1.3.2.2 jdolecek sc->sme->sme_cookie = sc; 550 1.3.2.2 jdolecek sc->sme->sme_refresh = sunxi_thermal_refresh; 551 1.3.2.2 jdolecek for (i = 0; i < sc->conf->nsensors; i++) { 552 1.3.2.2 jdolecek sc->data[i].private = i; 553 1.3.2.2 jdolecek sc->data[i].units = ENVSYS_STEMP; 554 1.3.2.2 jdolecek sc->data[i].state = ENVSYS_SINVALID; 555 1.3.2.2 jdolecek strlcpy(sc->data[1].desc, sc->conf->sensors[i].desc, 556 1.3.2.2 jdolecek sizeof(sc->data[1].desc)); 557 1.3.2.2 jdolecek sysmon_envsys_sensor_attach(sc->sme, &sc->data[i]); 558 1.3.2.2 jdolecek } 559 1.3.2.2 jdolecek sysmon_envsys_register(sc->sme); 560 1.3.2.2 jdolecek 561 1.3.2.2 jdolecek for (i = 0; i < sc->conf->nsensors; i++) { 562 1.3.2.2 jdolecek device_printf(self, 563 1.3.2.2 jdolecek "%s: alarm %dC hyst %dC shut %dC\n", 564 1.3.2.2 jdolecek sc->conf->sensors[i].name, 565 1.3.2.2 jdolecek sunxi_thermal_getalarm(sc, i), 566 1.3.2.2 jdolecek sunxi_thermal_gethyst(sc, i), 567 1.3.2.2 jdolecek sunxi_thermal_getshut(sc, i)); 568 1.3.2.2 jdolecek } 569 1.3.2.2 jdolecek } 570 1.3.2.2 jdolecek 571 1.3.2.2 jdolecek CFATTACH_DECL_NEW(sunxi_thermal, sizeof(struct sunxi_thermal_softc), 572 1.3.2.2 jdolecek sunxi_thermal_match, sunxi_thermal_attach, NULL, NULL); 573
Indexes created Wed Oct 22 00:09:40 GMT 2025