projects / openwrt / staging / ynezz.git / blob
? search:


d07619645c3cc333ec3928fcfe92e650106ee6a9
[openwrt/staging/ynezz.git] /
1 From 840a5bd3ed3fdd62456d4d26c3128ec10496555b Mon Sep 17 00:00:00 2001
2 From: Rajendra Nayak <rnayak@codeaurora.org>
3 Date: Thu, 5 May 2016 14:21:40 +0530
4 Subject: thermal: qcom: tsens-8916: Add support for 8916 family of SoCs
5
6 Add support to calibrate sensors on 8916 family and also add common
7 functions to read temperature from sensors (This can be reused on
8 other SoCs having similar TSENS device)
9 The calibration data is read from eeprom using the generic nvmem
10 framework apis.
11
12 Based on the original code by Siddartha Mohanadoss and Stephen Boyd.
13
14 Signed-off-by: Rajendra Nayak <rnayak@codeaurora.org>
15 Signed-off-by: Eduardo Valentin <edubezval@gmail.com>
16 Signed-off-by: Zhang Rui <rui.zhang@intel.com>
17 ---
18 drivers/thermal/qcom/Makefile | 2 +-
19 drivers/thermal/qcom/tsens-8916.c | 113 ++++++++++++++++++++++++++++++++++++++
20 drivers/thermal/qcom/tsens.c | 1 +
21 drivers/thermal/qcom/tsens.h | 2 +
22 4 files changed, 117 insertions(+), 1 deletion(-)
23 create mode 100644 drivers/thermal/qcom/tsens-8916.c
24
25 --- a/drivers/thermal/qcom/Makefile
26 +++ b/drivers/thermal/qcom/Makefile
27 @@ -1,2 +1,2 @@
28 obj-$(CONFIG_QCOM_TSENS) += qcom_tsens.o
29 -qcom_tsens-y += tsens.o tsens-common.o
30 +qcom_tsens-y += tsens.o tsens-common.o tsens-8916.o
31 --- /dev/null
32 +++ b/drivers/thermal/qcom/tsens-8916.c
33 @@ -0,0 +1,113 @@
34 +/*
35 + * Copyright (c) 2015, The Linux Foundation. All rights reserved.
36 + *
37 + * This program is free software; you can redistribute it and/or modify
38 + * it under the terms of the GNU General Public License version 2 and
39 + * only version 2 as published by the Free Software Foundation.
40 + *
41 + * This program is distributed in the hope that it will be useful,
42 + * but WITHOUT ANY WARRANTY; without even the implied warranty of
43 + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
44 + * GNU General Public License for more details.
45 + *
46 + */
47 +
48 +#include <linux/platform_device.h>
49 +#include "tsens.h"
50 +
51 +/* eeprom layout data for 8916 */
52 +#define BASE0_MASK 0x0000007f
53 +#define BASE1_MASK 0xfe000000
54 +#define BASE0_SHIFT 0
55 +#define BASE1_SHIFT 25
56 +
57 +#define S0_P1_MASK 0x00000f80
58 +#define S1_P1_MASK 0x003e0000
59 +#define S2_P1_MASK 0xf8000000
60 +#define S3_P1_MASK 0x000003e0
61 +#define S4_P1_MASK 0x000f8000
62 +
63 +#define S0_P2_MASK 0x0001f000
64 +#define S1_P2_MASK 0x07c00000
65 +#define S2_P2_MASK 0x0000001f
66 +#define S3_P2_MASK 0x00007c00
67 +#define S4_P2_MASK 0x01f00000
68 +
69 +#define S0_P1_SHIFT 7
70 +#define S1_P1_SHIFT 17
71 +#define S2_P1_SHIFT 27
72 +#define S3_P1_SHIFT 5
73 +#define S4_P1_SHIFT 15
74 +
75 +#define S0_P2_SHIFT 12
76 +#define S1_P2_SHIFT 22
77 +#define S2_P2_SHIFT 0
78 +#define S3_P2_SHIFT 10
79 +#define S4_P2_SHIFT 20
80 +
81 +#define CAL_SEL_MASK 0xe0000000
82 +#define CAL_SEL_SHIFT 29
83 +
84 +static int calibrate_8916(struct tsens_device *tmdev)
85 +{
86 + int base0 = 0, base1 = 0, i;
87 + u32 p1[5], p2[5];
88 + int mode = 0;
89 + u32 *qfprom_cdata, *qfprom_csel;
90 +
91 + qfprom_cdata = (u32 *)qfprom_read(tmdev->dev, "calib");
92 + if (IS_ERR(qfprom_cdata))
93 + return PTR_ERR(qfprom_cdata);
94 +
95 + qfprom_csel = (u32 *)qfprom_read(tmdev->dev, "calib_sel");
96 + if (IS_ERR(qfprom_csel))
97 + return PTR_ERR(qfprom_csel);
98 +
99 + mode = (qfprom_csel[0] & CAL_SEL_MASK) >> CAL_SEL_SHIFT;
100 + dev_dbg(tmdev->dev, "calibration mode is %d\n", mode);
101 +
102 + switch (mode) {
103 + case TWO_PT_CALIB:
104 + base1 = (qfprom_cdata[1] & BASE1_MASK) >> BASE1_SHIFT;
105 + p2[0] = (qfprom_cdata[0] & S0_P2_MASK) >> S0_P2_SHIFT;
106 + p2[1] = (qfprom_cdata[0] & S1_P2_MASK) >> S1_P2_SHIFT;
107 + p2[2] = (qfprom_cdata[1] & S2_P2_MASK) >> S2_P2_SHIFT;
108 + p2[3] = (qfprom_cdata[1] & S3_P2_MASK) >> S3_P2_SHIFT;
109 + p2[4] = (qfprom_cdata[1] & S4_P2_MASK) >> S4_P2_SHIFT;
110 + for (i = 0; i < tmdev->num_sensors; i++)
111 + p2[i] = ((base1 + p2[i]) << 3);
112 + /* Fall through */
113 + case ONE_PT_CALIB2:
114 + base0 = (qfprom_cdata[0] & BASE0_MASK);
115 + p1[0] = (qfprom_cdata[0] & S0_P1_MASK) >> S0_P1_SHIFT;
116 + p1[1] = (qfprom_cdata[0] & S1_P1_MASK) >> S1_P1_SHIFT;
117 + p1[2] = (qfprom_cdata[0] & S2_P1_MASK) >> S2_P1_SHIFT;
118 + p1[3] = (qfprom_cdata[1] & S3_P1_MASK) >> S3_P1_SHIFT;
119 + p1[4] = (qfprom_cdata[1] & S4_P1_MASK) >> S4_P1_SHIFT;
120 + for (i = 0; i < tmdev->num_sensors; i++)
121 + p1[i] = (((base0) + p1[i]) << 3);
122 + break;
123 + default:
124 + for (i = 0; i < tmdev->num_sensors; i++) {
125 + p1[i] = 500;
126 + p2[i] = 780;
127 + }
128 + break;
129 + }
130 +
131 + compute_intercept_slope(tmdev, p1, p2, mode);
132 +
133 + return 0;
134 +}
135 +
136 +const struct tsens_ops ops_8916 = {
137 + .init = init_common,
138 + .calibrate = calibrate_8916,
139 + .get_temp = get_temp_common,
140 +};
141 +
142 +const struct tsens_data data_8916 = {
143 + .num_sensors = 5,
144 + .ops = &ops_8916,
145 + .hw_ids = (unsigned int []){0, 1, 2, 4, 5 },
146 +};
147 --- a/drivers/thermal/qcom/tsens.c
148 +++ b/drivers/thermal/qcom/tsens.c
149 @@ -65,6 +65,7 @@ static SIMPLE_DEV_PM_OPS(tsens_pm_ops, t
150 static const struct of_device_id tsens_table[] = {
151 {
152 .compatible = "qcom,msm8916-tsens",
153 + .data = &data_8916,
154 }, {
155 .compatible = "qcom,msm8974-tsens",
156 },
157 --- a/drivers/thermal/qcom/tsens.h
158 +++ b/drivers/thermal/qcom/tsens.h
159 @@ -87,4 +87,6 @@ void compute_intercept_slope(struct tsen
160 int init_common(struct tsens_device *);
161 int get_temp_common(struct tsens_device *, int, int *);
162
163 +extern const struct tsens_data data_8916;
164 +
165 #endif /* __QCOM_TSENS_H__ */
Staging tree of Petr Stetiar