1// SPDX-License-Identifier: GPL-2.0+ 2/* 3 * Author: zhanghongchen <zhanghongchen@loongson.cn> 4 * Yinbo Zhu <zhuyinbo@loongson.cn> 5 * Copyright (C) 2022-2023 Loongson Technology Corporation Limited 6 */ 7 8#include <linux/interrupt.h> 9#include <linux/io.h> 10#include <linux/minmax.h> 11#include <linux/mod_devicetable.h> 12#include <linux/module.h> 13#include <linux/platform_device.h> 14#include <linux/property.h> 15#include <linux/thermal.h> 16#include <linux/units.h> 17#include "thermal_hwmon.h" 18 19#define LOONGSON2_MAX_SENSOR_SEL_NUM 3 20 21#define LOONGSON2_THSENS_CTRL_HI_REG 0x0 22#define LOONGSON2_THSENS_CTRL_LOW_REG 0x8 23#define LOONGSON2_THSENS_STATUS_REG 0x10 24#define LOONGSON2_THSENS_OUT_REG 0x14 25 26#define LOONGSON2_THSENS_INT_LO BIT(0) 27#define LOONGSON2_THSENS_INT_HIGH BIT(1) 28#define LOONGSON2_THSENS_OUT_MASK 0xFF 29 30struct loongson2_thermal_chip_data { 31 unsigned int thermal_sensor_sel; 32}; 33 34struct loongson2_thermal_data { 35 void __iomem *regs; 36 const struct loongson2_thermal_chip_data *chip_data; 37}; 38 39static int loongson2_thermal_set(struct loongson2_thermal_data *data, 40 int low, int high, bool enable) 41{ 42 u64 reg_ctrl = 0; 43 int reg_off = data->chip_data->thermal_sensor_sel * 2; 44 45 low = clamp(-40, low, high); 46 high = clamp(125, low, high); 47 48 low += HECTO; 49 high += HECTO; 50 51 reg_ctrl = low; 52 reg_ctrl |= enable ? 0x100 : 0; 53 writew(reg_ctrl, data->regs + LOONGSON2_THSENS_CTRL_LOW_REG + reg_off); 54 55 reg_ctrl = high; 56 reg_ctrl |= enable ? 0x100 : 0; 57 writew(reg_ctrl, data->regs + LOONGSON2_THSENS_CTRL_HI_REG + reg_off); 58 59 return 0; 60} 61 62static int loongson2_thermal_get_temp(struct thermal_zone_device *tz, int *temp) 63{ 64 u32 reg_val; 65 struct loongson2_thermal_data *data = thermal_zone_device_priv(tz); 66 67 reg_val = readl(data->regs + LOONGSON2_THSENS_OUT_REG); 68 *temp = ((reg_val & LOONGSON2_THSENS_OUT_MASK) - HECTO) * KILO; 69 70 return 0; 71} 72 73static irqreturn_t loongson2_thermal_irq_thread(int irq, void *dev) 74{ 75 struct thermal_zone_device *tzd = dev; 76 struct loongson2_thermal_data *data = thermal_zone_device_priv(tzd); 77 78 writeb(LOONGSON2_THSENS_INT_LO | LOONGSON2_THSENS_INT_HIGH, data->regs + 79 LOONGSON2_THSENS_STATUS_REG); 80 81 thermal_zone_device_update(tzd, THERMAL_EVENT_UNSPECIFIED); 82 83 return IRQ_HANDLED; 84} 85 86static int loongson2_thermal_set_trips(struct thermal_zone_device *tz, int low, int high) 87{ 88 struct loongson2_thermal_data *data = thermal_zone_device_priv(tz); 89 90 return loongson2_thermal_set(data, low/MILLI, high/MILLI, true); 91} 92 93static const struct thermal_zone_device_ops loongson2_of_thermal_ops = { 94 .get_temp = loongson2_thermal_get_temp, 95 .set_trips = loongson2_thermal_set_trips, 96}; 97 98static int loongson2_thermal_probe(struct platform_device *pdev) 99{ 100 struct device *dev = &pdev->dev; 101 struct loongson2_thermal_data *data; 102 struct thermal_zone_device *tzd; 103 int ret, irq, i; 104 105 data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL); 106 if (!data) 107 return -ENOMEM; 108 109 data->chip_data = device_get_match_data(dev); 110 111 data->regs = devm_platform_ioremap_resource(pdev, 0); 112 if (IS_ERR(data->regs)) 113 return PTR_ERR(data->regs); 114 115 irq = platform_get_irq(pdev, 0); 116 if (irq < 0) 117 return irq; 118 119 writeb(LOONGSON2_THSENS_INT_LO | LOONGSON2_THSENS_INT_HIGH, data->regs + 120 LOONGSON2_THSENS_STATUS_REG); 121 122 loongson2_thermal_set(data, 0, 0, false); 123 124 for (i = 0; i <= LOONGSON2_MAX_SENSOR_SEL_NUM; i++) { 125 tzd = devm_thermal_of_zone_register(dev, i, data, 126 &loongson2_of_thermal_ops); 127 128 if (!IS_ERR(tzd)) 129 break; 130 131 if (PTR_ERR(tzd) != -ENODEV) 132 continue; 133 134 return dev_err_probe(dev, PTR_ERR(tzd), "failed to register"); 135 } 136 137 ret = devm_request_threaded_irq(dev, irq, NULL, loongson2_thermal_irq_thread, 138 IRQF_ONESHOT, "loongson2_thermal", tzd); 139 if (ret < 0) 140 return dev_err_probe(dev, ret, "failed to request alarm irq\n"); 141 142 devm_thermal_add_hwmon_sysfs(dev, tzd); 143 144 return 0; 145} 146 147static const struct loongson2_thermal_chip_data loongson2_thermal_ls2k1000_data = { 148 .thermal_sensor_sel = 0, 149}; 150 151static const struct of_device_id of_loongson2_thermal_match[] = { 152 { 153 .compatible = "loongson,ls2k1000-thermal", 154 .data = &loongson2_thermal_ls2k1000_data, 155 }, 156 { /* end */ } 157}; 158MODULE_DEVICE_TABLE(of, of_loongson2_thermal_match); 159 160static struct platform_driver loongson2_thermal_driver = { 161 .driver = { 162 .name = "loongson2_thermal", 163 .of_match_table = of_loongson2_thermal_match, 164 }, 165 .probe = loongson2_thermal_probe, 166}; 167module_platform_driver(loongson2_thermal_driver); 168 169MODULE_DESCRIPTION("Loongson2 thermal driver"); 170MODULE_LICENSE("GPL"); 171