2 * Copyright (c) 2015, The Linux Foundation. All rights reserved.
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License version 2 and
6 * only version 2 as published by the Free Software Foundation.
8 * This program is distributed in the hope that it will be useful,
9 * but WITHOUT ANY WARRANTY; without even the implied warranty of
10 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
11 * GNU General Public License for more details.
15 #include <linux/platform_device.h>
18 /* eeprom layout data for 8974 */
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
40 #define S1_P1_SHIFT 14
41 #define S2_P1_SHIFT 20
42 #define S3_P1_SHIFT 26
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
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
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
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
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
98 #define BKP_REDUN_SEL 0xe0000000
99 #define BKP_REDUN_SHIFT 29
101 #define BIT_APPEND 0x3
103 static int calibrate_8974(struct tsens_device *tmdev)
105 int base1 = 0, base2 = 0, i;
111 calib = (u32 *)qfprom_read(tmdev->dev, "calib");
113 return PTR_ERR(calib);
115 bkp = (u32 *)qfprom_read(tmdev->dev, "calib_backup");
119 calib_redun_sel = bkp[1] & BKP_REDUN_SEL;
120 calib_redun_sel >>= BKP_REDUN_SHIFT;
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;
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;
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;
158 mode = (calib[1] & CAL_SEL_0_1) >> CAL_SEL_SHIFT;
159 mode |= (calib[3] & CAL_SEL_2) >> CAL_SEL_SHIFT_2;
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;
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;
196 for (i = 0; i < tmdev->num_sensors; i++)
197 p1[i] += (base1 << 2) | BIT_APPEND;
200 for (i = 0; i < tmdev->num_sensors; i++) {
207 for (i = 0; i < tmdev->num_sensors; i++) {
214 for (i = 0; i < tmdev->num_sensors; i++)
230 compute_intercept_slope(tmdev, p1, p2, mode);
235 static const struct tsens_ops ops_8974 = {
237 .calibrate = calibrate_8974,
238 .get_temp = get_temp_common,
241 const struct tsens_data data_8974 = {