1
2
3
4
5
6
7
8
9
10
11
12
13
14
15#include <linux/platform_device.h>
16#include "tsens.h"
17
18
19#define BASE1_MASK 0xff
20#define S0_P1_MASK 0x3f00
21#define S1_P1_MASK 0xfc000
22#define S2_P1_MASK 0x3f00000
23#define S3_P1_MASK 0xfc000000
24#define S4_P1_MASK 0x3f
25#define S5_P1_MASK 0xfc0
26#define S6_P1_MASK 0x3f000
27#define S7_P1_MASK 0xfc0000
28#define S8_P1_MASK 0x3f000000
29#define S8_P1_MASK_BKP 0x3f
30#define S9_P1_MASK 0x3f
31#define S9_P1_MASK_BKP 0xfc0
32#define S10_P1_MASK 0xfc0
33#define S10_P1_MASK_BKP 0x3f000
34#define CAL_SEL_0_1 0xc0000000
35#define CAL_SEL_2 0x40000000
36#define CAL_SEL_SHIFT 30
37#define CAL_SEL_SHIFT_2 28
38
39#define S0_P1_SHIFT 8
40#define S1_P1_SHIFT 14
41#define S2_P1_SHIFT 20
42#define S3_P1_SHIFT 26
43#define S5_P1_SHIFT 6
44#define S6_P1_SHIFT 12
45#define S7_P1_SHIFT 18
46#define S8_P1_SHIFT 24
47#define S9_P1_BKP_SHIFT 6
48#define S10_P1_SHIFT 6
49#define S10_P1_BKP_SHIFT 12
50
51#define BASE2_SHIFT 12
52#define BASE2_BKP_SHIFT 18
53#define S0_P2_SHIFT 20
54#define S0_P2_BKP_SHIFT 26
55#define S1_P2_SHIFT 26
56#define S2_P2_BKP_SHIFT 6
57#define S3_P2_SHIFT 6
58#define S3_P2_BKP_SHIFT 12
59#define S4_P2_SHIFT 12
60#define S4_P2_BKP_SHIFT 18
61#define S5_P2_SHIFT 18
62#define S5_P2_BKP_SHIFT 24
63#define S6_P2_SHIFT 24
64#define S7_P2_BKP_SHIFT 6
65#define S8_P2_SHIFT 6
66#define S8_P2_BKP_SHIFT 12
67#define S9_P2_SHIFT 12
68#define S9_P2_BKP_SHIFT 18
69#define S10_P2_SHIFT 18
70#define S10_P2_BKP_SHIFT 24
71
72#define BASE2_MASK 0xff000
73#define BASE2_BKP_MASK 0xfc0000
74#define S0_P2_MASK 0x3f00000
75#define S0_P2_BKP_MASK 0xfc000000
76#define S1_P2_MASK 0xfc000000
77#define S1_P2_BKP_MASK 0x3f
78#define S2_P2_MASK 0x3f
79#define S2_P2_BKP_MASK 0xfc0
80#define S3_P2_MASK 0xfc0
81#define S3_P2_BKP_MASK 0x3f000
82#define S4_P2_MASK 0x3f000
83#define S4_P2_BKP_MASK 0xfc0000
84#define S5_P2_MASK 0xfc0000
85#define S5_P2_BKP_MASK 0x3f000000
86#define S6_P2_MASK 0x3f000000
87#define S6_P2_BKP_MASK 0x3f
88#define S7_P2_MASK 0x3f
89#define S7_P2_BKP_MASK 0xfc0
90#define S8_P2_MASK 0xfc0
91#define S8_P2_BKP_MASK 0x3f000
92#define S9_P2_MASK 0x3f000
93#define S9_P2_BKP_MASK 0xfc0000
94#define S10_P2_MASK 0xfc0000
95#define S10_P2_BKP_MASK 0x3f000000
96
97#define BKP_SEL 0x3
98#define BKP_REDUN_SEL 0xe0000000
99#define BKP_REDUN_SHIFT 29
100
101#define BIT_APPEND 0x3
102
103static int calibrate_8974(struct tsens_device *tmdev)
104{
105 int base1 = 0, base2 = 0, i;
106 u32 p1[11], p2[11];
107 int mode = 0;
108 u32 *calib, *bkp;
109 u32 calib_redun_sel;
110
111 calib = (u32 *)qfprom_read(tmdev->dev, "calib");
112 if (IS_ERR(calib))
113 return PTR_ERR(calib);
114
115 bkp = (u32 *)qfprom_read(tmdev->dev, "calib_backup");
116 if (IS_ERR(bkp))
117 return PTR_ERR(bkp);
118
119 calib_redun_sel = bkp[1] & BKP_REDUN_SEL;
120 calib_redun_sel >>= BKP_REDUN_SHIFT;
121
122 if (calib_redun_sel == BKP_SEL) {
123 mode = (calib[4] & CAL_SEL_0_1) >> CAL_SEL_SHIFT;
124 mode |= (calib[5] & CAL_SEL_2) >> CAL_SEL_SHIFT_2;
125
126 switch (mode) {
127 case TWO_PT_CALIB:
128 base2 = (bkp[2] & BASE2_BKP_MASK) >> BASE2_BKP_SHIFT;
129 p2[0] = (bkp[2] & S0_P2_BKP_MASK) >> S0_P2_BKP_SHIFT;
130 p2[1] = (bkp[3] & S1_P2_BKP_MASK);
131 p2[2] = (bkp[3] & S2_P2_BKP_MASK) >> S2_P2_BKP_SHIFT;
132 p2[3] = (bkp[3] & S3_P2_BKP_MASK) >> S3_P2_BKP_SHIFT;
133 p2[4] = (bkp[3] & S4_P2_BKP_MASK) >> S4_P2_BKP_SHIFT;
134 p2[5] = (calib[4] & S5_P2_BKP_MASK) >> S5_P2_BKP_SHIFT;
135 p2[6] = (calib[5] & S6_P2_BKP_MASK);
136 p2[7] = (calib[5] & S7_P2_BKP_MASK) >> S7_P2_BKP_SHIFT;
137 p2[8] = (calib[5] & S8_P2_BKP_MASK) >> S8_P2_BKP_SHIFT;
138 p2[9] = (calib[5] & S9_P2_BKP_MASK) >> S9_P2_BKP_SHIFT;
139 p2[10] = (calib[5] & S10_P2_BKP_MASK) >> S10_P2_BKP_SHIFT;
140
141 case ONE_PT_CALIB:
142 case ONE_PT_CALIB2:
143 base1 = bkp[0] & BASE1_MASK;
144 p1[0] = (bkp[0] & S0_P1_MASK) >> S0_P1_SHIFT;
145 p1[1] = (bkp[0] & S1_P1_MASK) >> S1_P1_SHIFT;
146 p1[2] = (bkp[0] & S2_P1_MASK) >> S2_P1_SHIFT;
147 p1[3] = (bkp[0] & S3_P1_MASK) >> S3_P1_SHIFT;
148 p1[4] = (bkp[1] & S4_P1_MASK);
149 p1[5] = (bkp[1] & S5_P1_MASK) >> S5_P1_SHIFT;
150 p1[6] = (bkp[1] & S6_P1_MASK) >> S6_P1_SHIFT;
151 p1[7] = (bkp[1] & S7_P1_MASK) >> S7_P1_SHIFT;
152 p1[8] = (bkp[2] & S8_P1_MASK_BKP) >> S8_P1_SHIFT;
153 p1[9] = (bkp[2] & S9_P1_MASK_BKP) >> S9_P1_BKP_SHIFT;
154 p1[10] = (bkp[2] & S10_P1_MASK_BKP) >> S10_P1_BKP_SHIFT;
155 break;
156 }
157 } else {
158 mode = (calib[1] & CAL_SEL_0_1) >> CAL_SEL_SHIFT;
159 mode |= (calib[3] & CAL_SEL_2) >> CAL_SEL_SHIFT_2;
160
161 switch (mode) {
162 case TWO_PT_CALIB:
163 base2 = (calib[2] & BASE2_MASK) >> BASE2_SHIFT;
164 p2[0] = (calib[2] & S0_P2_MASK) >> S0_P2_SHIFT;
165 p2[1] = (calib[2] & S1_P2_MASK) >> S1_P2_SHIFT;
166 p2[2] = (calib[3] & S2_P2_MASK);
167 p2[3] = (calib[3] & S3_P2_MASK) >> S3_P2_SHIFT;
168 p2[4] = (calib[3] & S4_P2_MASK) >> S4_P2_SHIFT;
169 p2[5] = (calib[3] & S5_P2_MASK) >> S5_P2_SHIFT;
170 p2[6] = (calib[3] & S6_P2_MASK) >> S6_P2_SHIFT;
171 p2[7] = (calib[4] & S7_P2_MASK);
172 p2[8] = (calib[4] & S8_P2_MASK) >> S8_P2_SHIFT;
173 p2[9] = (calib[4] & S9_P2_MASK) >> S9_P2_SHIFT;
174 p2[10] = (calib[4] & S10_P2_MASK) >> S10_P2_SHIFT;
175
176 case ONE_PT_CALIB:
177 case ONE_PT_CALIB2:
178 base1 = calib[0] & BASE1_MASK;
179 p1[0] = (calib[0] & S0_P1_MASK) >> S0_P1_SHIFT;
180 p1[1] = (calib[0] & S1_P1_MASK) >> S1_P1_SHIFT;
181 p1[2] = (calib[0] & S2_P1_MASK) >> S2_P1_SHIFT;
182 p1[3] = (calib[0] & S3_P1_MASK) >> S3_P1_SHIFT;
183 p1[4] = (calib[1] & S4_P1_MASK);
184 p1[5] = (calib[1] & S5_P1_MASK) >> S5_P1_SHIFT;
185 p1[6] = (calib[1] & S6_P1_MASK) >> S6_P1_SHIFT;
186 p1[7] = (calib[1] & S7_P1_MASK) >> S7_P1_SHIFT;
187 p1[8] = (calib[1] & S8_P1_MASK) >> S8_P1_SHIFT;
188 p1[9] = (calib[2] & S9_P1_MASK);
189 p1[10] = (calib[2] & S10_P1_MASK) >> S10_P1_SHIFT;
190 break;
191 }
192 }
193
194 switch (mode) {
195 case ONE_PT_CALIB:
196 for (i = 0; i < tmdev->num_sensors; i++)
197 p1[i] += (base1 << 2) | BIT_APPEND;
198 break;
199 case TWO_PT_CALIB:
200 for (i = 0; i < tmdev->num_sensors; i++) {
201 p2[i] += base2;
202 p2[i] <<= 2;
203 p2[i] |= BIT_APPEND;
204 }
205
206 case ONE_PT_CALIB2:
207 for (i = 0; i < tmdev->num_sensors; i++) {
208 p1[i] += base1;
209 p1[i] <<= 2;
210 p1[i] |= BIT_APPEND;
211 }
212 break;
213 default:
214 for (i = 0; i < tmdev->num_sensors; i++)
215 p2[i] = 780;
216 p1[0] = 502;
217 p1[1] = 509;
218 p1[2] = 503;
219 p1[3] = 509;
220 p1[4] = 505;
221 p1[5] = 509;
222 p1[6] = 507;
223 p1[7] = 510;
224 p1[8] = 508;
225 p1[9] = 509;
226 p1[10] = 508;
227 break;
228 }
229
230 compute_intercept_slope(tmdev, p1, p2, mode);
231
232 return 0;
233}
234
235static const struct tsens_ops ops_8974 = {
236 .init = init_common,
237 .calibrate = calibrate_8974,
238 .get_temp = get_temp_common,
239};
240
241const struct tsens_data data_8974 = {
242 .num_sensors = 11,
243 .ops = &ops_8974,
244};
245
