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
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
|
/*
* 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>
*
* See file CREDITS for list of people who contributed to this
* project.
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License version 2
* as published by the Free Software Foundation.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*/
#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 <mach/imx6-anadig.h>
#include <io.h>
#include <aiodev.h>
#include <mfd/syscon.h>
#define FACTOR0 10000000
#define MEASURE_FREQ 327
#define OCOTP_ANA1_OFFSET (0xE * sizeof(uint32_t))
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_d *dev)
{
uint32_t ocotp_ana1;
struct device_node *node;
struct imx_thermal_data *imx_thermal;
struct cdev *ocotp;
int t1, n1, t2, n2;
int ret;
node = of_parse_phandle(dev->device_node, "fsl,tempmon-data", 0);
if (!node) {
dev_err(dev, "No calibration data source\n");
return -ENODEV;
}
ocotp = cdev_by_device_node(node);
if (!ocotp) {
dev_err(dev, "No OCOTP character device\n");
return -ENODEV;
}
ret = cdev_read(ocotp, &ocotp_ana1, sizeof(ocotp_ana1),
OCOTP_ANA1_OFFSET, 0);
if (ret != sizeof(ocotp_ana1)) {
dev_err(dev, "Failed to read calibration data\n");
return ret < 0 ? ret : -EIO;
}
imx_thermal = xzalloc(sizeof(*imx_thermal));
imx_thermal->base = syscon_base_lookup_by_phandle(dev->device_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.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 */ }
};
static struct driver_d 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);
|
