1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
|
/*
* ST Thermal Sensor Driver for syscfg based sensors.
* Author: Ajit Pal Singh <ajitpal.singh@st.com>
*
* Copyright (C) 2003-2014 STMicroelectronics (R&D) Limited
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; either version 2 of the License, or
* (at your option) any later version.
*/
#include <linux/of.h>
#include <linux/module.h>
#include <linux/mfd/syscon.h>
#include "st_thermal.h"
/* STiH415 */
#define STIH415_SYSCFG_FRONT(num) ((num - 100) * 4)
#define STIH415_SAS_THSENS_CONF STIH415_SYSCFG_FRONT(178)
#define STIH415_SAS_THSENS_STATUS STIH415_SYSCFG_FRONT(198)
#define STIH415_SYSCFG_MPE(num) ((num - 600) * 4)
#define STIH415_MPE_THSENS_CONF STIH415_SYSCFG_MPE(607)
#define STIH415_MPE_THSENS_STATUS STIH415_SYSCFG_MPE(667)
/* STiH416 */
#define STIH416_SYSCFG_FRONT(num) ((num - 1000) * 4)
#define STIH416_SAS_THSENS_CONF STIH416_SYSCFG_FRONT(1552)
#define STIH416_SAS_THSENS_STATUS1 STIH416_SYSCFG_FRONT(1554)
#define STIH416_SAS_THSENS_STATUS2 STIH416_SYSCFG_FRONT(1594)
/* STiD127 */
#define STID127_SYSCFG_CPU(num) ((num - 700) * 4)
#define STID127_THSENS_CONF STID127_SYSCFG_CPU(743)
#define STID127_THSENS_STATUS STID127_SYSCFG_CPU(767)
static const struct reg_field st_415sas_regfields[MAX_REGFIELDS] = {
[TEMP_PWR] = REG_FIELD(STIH415_SAS_THSENS_CONF, 9, 9),
[DCORRECT] = REG_FIELD(STIH415_SAS_THSENS_CONF, 4, 8),
[OVERFLOW] = REG_FIELD(STIH415_SAS_THSENS_STATUS, 8, 8),
[DATA] = REG_FIELD(STIH415_SAS_THSENS_STATUS, 10, 16),
};
static const struct reg_field st_415mpe_regfields[MAX_REGFIELDS] = {
[TEMP_PWR] = REG_FIELD(STIH415_MPE_THSENS_CONF, 8, 8),
[DCORRECT] = REG_FIELD(STIH415_MPE_THSENS_CONF, 3, 7),
[OVERFLOW] = REG_FIELD(STIH415_MPE_THSENS_STATUS, 9, 9),
[DATA] = REG_FIELD(STIH415_MPE_THSENS_STATUS, 11, 18),
};
static const struct reg_field st_416sas_regfields[MAX_REGFIELDS] = {
[TEMP_PWR] = REG_FIELD(STIH416_SAS_THSENS_CONF, 9, 9),
[DCORRECT] = REG_FIELD(STIH416_SAS_THSENS_CONF, 4, 8),
[OVERFLOW] = REG_FIELD(STIH416_SAS_THSENS_STATUS1, 8, 8),
[DATA] = REG_FIELD(STIH416_SAS_THSENS_STATUS2, 10, 16),
};
static const struct reg_field st_127_regfields[MAX_REGFIELDS] = {
[TEMP_PWR] = REG_FIELD(STID127_THSENS_CONF, 7, 7),
[DCORRECT] = REG_FIELD(STID127_THSENS_CONF, 2, 6),
[OVERFLOW] = REG_FIELD(STID127_THSENS_STATUS, 9, 9),
[DATA] = REG_FIELD(STID127_THSENS_STATUS, 11, 18),
};
/* Private OPs for System Configuration Register based thermal sensors */
static int st_syscfg_power_ctrl(struct st_thermal_sensor *sensor,
enum st_thermal_power_state power_state)
{
return regmap_field_write(sensor->pwr, power_state);
}
static int st_syscfg_alloc_regfields(struct st_thermal_sensor *sensor)
{
struct device *dev = sensor->dev;
sensor->pwr = devm_regmap_field_alloc(dev, sensor->regmap,
sensor->cdata->reg_fields[TEMP_PWR]);
if (IS_ERR(sensor->pwr)) {
dev_err(dev, "failed to alloc syscfg regfields\n");
return PTR_ERR(sensor->pwr);
}
return 0;
}
static int st_syscfg_regmap_init(struct st_thermal_sensor *sensor)
{
sensor->regmap =
syscon_regmap_lookup_by_compatible(sensor->cdata->sys_compat);
if (IS_ERR(sensor->regmap)) {
dev_err(sensor->dev, "failed to find syscfg regmap\n");
return PTR_ERR(sensor->regmap);
}
return 0;
}
static const struct st_thermal_sensor_ops st_syscfg_sensor_ops = {
.power_ctrl = st_syscfg_power_ctrl,
.alloc_regfields = st_syscfg_alloc_regfields,
.regmap_init = st_syscfg_regmap_init,
};
/* Compatible device data for stih415 sas thermal sensor */
const struct st_thermal_compat_data st_415sas_cdata = {
.sys_compat = "st,stih415-front-syscfg",
.reg_fields = st_415sas_regfields,
.ops = &st_syscfg_sensor_ops,
.calibration_val = 16,
.temp_adjust_val = 20,
.crit_temp = 120,
};
/* Compatible device data for stih415 mpe thermal sensor */
const struct st_thermal_compat_data st_415mpe_cdata = {
.sys_compat = "st,stih415-system-syscfg",
.reg_fields = st_415mpe_regfields,
.ops = &st_syscfg_sensor_ops,
.calibration_val = 16,
.temp_adjust_val = -103,
.crit_temp = 120,
};
/* Compatible device data for stih416 sas thermal sensor */
const struct st_thermal_compat_data st_416sas_cdata = {
.sys_compat = "st,stih416-front-syscfg",
.reg_fields = st_416sas_regfields,
.ops = &st_syscfg_sensor_ops,
.calibration_val = 16,
.temp_adjust_val = 20,
.crit_temp = 120,
};
/* Compatible device data for stid127 thermal sensor */
const struct st_thermal_compat_data st_127_cdata = {
.sys_compat = "st,stid127-cpu-syscfg",
.reg_fields = st_127_regfields,
.ops = &st_syscfg_sensor_ops,
.calibration_val = 8,
.temp_adjust_val = -103,
.crit_temp = 120,
};
static struct of_device_id st_syscfg_thermal_of_match[] = {
{ .compatible = "st,stih415-sas-thermal", .data = &st_415sas_cdata },
{ .compatible = "st,stih415-mpe-thermal", .data = &st_415mpe_cdata },
{ .compatible = "st,stih416-sas-thermal", .data = &st_416sas_cdata },
{ .compatible = "st,stid127-thermal", .data = &st_127_cdata },
{ /* sentinel */ }
};
MODULE_DEVICE_TABLE(of, st_syscfg_thermal_of_match);
int st_syscfg_probe(struct platform_device *pdev)
{
return st_thermal_register(pdev, st_syscfg_thermal_of_match);
}
int st_syscfg_remove(struct platform_device *pdev)
{
return st_thermal_unregister(pdev);
}
static struct platform_driver st_syscfg_thermal_driver = {
.driver = {
.name = "st_syscfg_thermal",
.pm = &st_thermal_pm_ops,
.of_match_table = st_syscfg_thermal_of_match,
},
.probe = st_syscfg_probe,
.remove = st_syscfg_remove,
};
module_platform_driver(st_syscfg_thermal_driver);
MODULE_AUTHOR("STMicroelectronics (R&D) Limited <ajitpal.singh@st.com>");
MODULE_DESCRIPTION("STMicroelectronics STi SoC Thermal Sensor Driver");
MODULE_LICENSE("GPL v2");
|
