drivers/thermal/loongson2_thermal.c

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