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
179
180
181
182
183
184
185
186
187
|
// SPDX-License-Identifier: GPL-2.0-only
/*
* imx_thermal
*
* Copyright (c) 2015 Zodiac Inflight Innovation
* Author: Andrey Smirnov <andrew.smirnov@gmail.com>
*
* based on the code of analogous driver from U-Boot:
* (C) Copyright 2014-2015 Freescale Semiconductor, Inc.
* Author: Nitin Garg <nitin.garg@freescale.com>
* Ye Li <Ye.Li@freescale.com>
*/
#include <common.h>
#include <init.h>
#include <malloc.h>
#include <clock.h>
#include <driver.h>
#include <xfuncs.h>
#include <errno.h>
#include <fcntl.h>
#include <linux/math64.h>
#include <linux/log2.h>
#include <linux/clk.h>
#include <linux/nvmem-consumer.h>
#include <mach/imx/imx6-anadig.h>
#include <io.h>
#include <aiodev.h>
#include <mfd/syscon.h>
#define FACTOR0 10000000
#define MEASURE_FREQ 327
struct imx_thermal_data {
int c1, c2;
void __iomem *base;
struct clk *clk;
struct aiodevice aiodev;
struct aiochannel aiochan;
};
static inline struct imx_thermal_data *
to_imx_thermal_data(struct aiochannel *chan)
{
return container_of(chan, struct imx_thermal_data, aiochan);
}
static int imx_thermal_read(struct aiochannel *chan, int *val)
{
uint64_t start;
uint32_t tempsense0, tempsense1;
uint16_t n_meas;
struct imx_thermal_data *imx_thermal = to_imx_thermal_data(chan);
/*
* now we only use single measure, every time we read
* the temperature, we will power on/down anadig thermal
* module
*/
writel(BM_ANADIG_TEMPSENSE0_POWER_DOWN,
imx_thermal->base + HW_ANADIG_TEMPSENSE0_CLR);
writel(BM_ANADIG_ANA_MISC0_REFTOP_SELBIASOFF,
imx_thermal->base + HW_ANADIG_ANA_MISC0_SET);
/* setup measure freq */
tempsense1 = readl(imx_thermal->base + HW_ANADIG_TEMPSENSE1);
tempsense1 &= ~BM_ANADIG_TEMPSENSE1_MEASURE_FREQ;
tempsense1 |= MEASURE_FREQ;
writel(tempsense1, imx_thermal->base + HW_ANADIG_TEMPSENSE1);
/* start the measurement process */
writel(BM_ANADIG_TEMPSENSE0_MEASURE_TEMP,
imx_thermal->base + HW_ANADIG_TEMPSENSE0_CLR);
writel(BM_ANADIG_TEMPSENSE0_FINISHED,
imx_thermal->base + HW_ANADIG_TEMPSENSE0_CLR);
writel(BM_ANADIG_TEMPSENSE0_MEASURE_TEMP,
imx_thermal->base + HW_ANADIG_TEMPSENSE0_SET);
/* make sure that the latest temp is valid */
start = get_time_ns();
do {
tempsense0 = readl(imx_thermal->base + HW_ANADIG_TEMPSENSE0);
if (is_timeout(start, 1 * SECOND)) {
dev_err(imx_thermal->aiodev.hwdev,
"Timeout waiting for measurement\n");
return -EIO;
}
} while (!(tempsense0 & BM_ANADIG_TEMPSENSE0_FINISHED));
n_meas = (tempsense0 & BM_ANADIG_TEMPSENSE0_TEMP_VALUE)
>> BP_ANADIG_TEMPSENSE0_TEMP_VALUE;
writel(BM_ANADIG_TEMPSENSE0_FINISHED,
imx_thermal->base + HW_ANADIG_TEMPSENSE0_CLR);
*val = (int)n_meas * imx_thermal->c1 + imx_thermal->c2;
/* power down anatop thermal sensor */
writel(BM_ANADIG_TEMPSENSE0_POWER_DOWN,
imx_thermal->base + HW_ANADIG_TEMPSENSE0_SET);
writel(BM_ANADIG_ANA_MISC0_REFTOP_SELBIASOFF,
imx_thermal->base + HW_ANADIG_ANA_MISC0_CLR);
return 0;
}
static int imx_thermal_probe(struct device *dev)
{
uint32_t ocotp_ana1;
struct imx_thermal_data *imx_thermal;
int t1, n1, t2, n2;
int ret;
ret = nvmem_cell_read_variable_le_u32(dev, "calib", &ocotp_ana1);
if (ret)
return ret;
imx_thermal = xzalloc(sizeof(*imx_thermal));
imx_thermal->base = syscon_base_lookup_by_phandle(dev->of_node,
"fsl,tempmon");
if (IS_ERR(imx_thermal->base)) {
dev_err(dev, "Could not get ANATOP address\n");
ret = PTR_ERR(imx_thermal->base);
goto free_imx_thermal;
}
n1 = ocotp_ana1 >> 20;
t1 = 25;
n2 = (ocotp_ana1 & 0x000FFF00) >> 8;
t2 = ocotp_ana1 & 0xFF;
imx_thermal->c1 = (-1000 * (t2 - t1)) / (n1 - n2);
imx_thermal->c2 = 1000 * t2 + (1000 * n2 * (t2 - t1)) / (n1 - n2);
imx_thermal->clk = clk_get(dev, NULL);
if (IS_ERR(imx_thermal->clk)) {
ret = PTR_ERR(imx_thermal->clk);
goto free_imx_thermal;
}
ret = clk_enable(imx_thermal->clk);
if (ret) {
dev_err(dev, "Failed to enable clock: %s\n",
strerror(ret));
goto put_clock;
}
imx_thermal->aiodev.num_channels = 1;
imx_thermal->aiodev.hwdev = dev;
imx_thermal->aiodev.name = "thermal-sensor";
imx_thermal->aiodev.channels =
xmalloc(imx_thermal->aiodev.num_channels *
sizeof(imx_thermal->aiodev.channels[0]));
imx_thermal->aiodev.channels[0] = &imx_thermal->aiochan;
imx_thermal->aiochan.unit = "mC";
imx_thermal->aiodev.read = imx_thermal_read;
ret = aiodevice_register(&imx_thermal->aiodev);
if (!ret)
goto done;
clk_disable(imx_thermal->clk);
put_clock:
clk_put(imx_thermal->clk);
free_imx_thermal:
kfree(imx_thermal);
done:
return ret;
}
static const struct of_device_id of_imx_thermal_match[] = {
{ .compatible = "fsl,imx6q-tempmon", },
{ .compatible = "fsl,imx6sx-tempmon", },
{ /* end */ }
};
MODULE_DEVICE_TABLE(of, of_imx_thermal_match);
static struct driver imx_thermal_driver = {
.name = "imx_thermal",
.probe = imx_thermal_probe,
.of_compatible = DRV_OF_COMPAT(of_imx_thermal_match),
};
device_platform_driver(imx_thermal_driver);
|
