修改4g拨号为QMI,需要在系统里后台执行quectel-CM

hc

2024-10-22 8ac6c7a54ed1b98d142dce24b11c6de6a1e239a5

 kernel/drivers/iio/pressure/cros_ec_baro.c
..
..
@@ -1,19 +1,10 @@
1
+// SPDX-License-Identifier: GPL-2.0
1
2
 /*
2
3
  * cros_ec_baro - Driver for barometer sensor behind CrosEC.
3
4
  *
4
5
  * Copyright (C) 2017 Google, Inc
5
- *
6
- * This software is licensed under the terms of the GNU General Public
7
- * License version 2, as published by the Free Software Foundation, and
8
- * may be copied, distributed, and modified under those terms.
9
- *
10
- * This program is distributed in the hope that it will be useful,
11
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
12
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
13
- * GNU General Public License for more details.
14
6
  */
15
7
 
16
-#include <linux/delay.h>
17
8
 #include <linux/device.h>
18
9
 #include <linux/iio/buffer.h>
19
10
 #include <linux/iio/common/cros_ec_sensors_core.h>
..
..
@@ -23,10 +14,10 @@
23
14
 #include <linux/iio/triggered_buffer.h>
24
15
 #include <linux/iio/trigger_consumer.h>
25
16
 #include <linux/kernel.h>
26
-#include <linux/mfd/cros_ec.h>
27
-#include <linux/mfd/cros_ec_commands.h>
28
17
 #include <linux/module.h>
29
18
 #include <linux/slab.h>
19
+#include <linux/platform_data/cros_ec_commands.h>
20
+#include <linux/platform_data/cros_ec_proto.h>
30
21
 #include <linux/platform_device.h>
31
22
 
32
23
 /*
..
..
@@ -48,26 +39,29 @@
48
39
 {
49
40
 	struct cros_ec_baro_state *st = iio_priv(indio_dev);
50
41
 	u16 data = 0;
51
-	int ret = IIO_VAL_INT;
42
+	int ret;
52
43
 	int idx = chan->scan_index;
53
44
 
54
45
 	mutex_lock(&st->core.cmd_lock);
55
46
 
56
47
 	switch (mask) {
57
48
 	case IIO_CHAN_INFO_RAW:
58
-		if (cros_ec_sensors_read_cmd(indio_dev, 1 << idx,
59
-					     (s16 *)&data) < 0)
60
-			ret = -EIO;
49
+		ret = cros_ec_sensors_read_cmd(indio_dev, 1 << idx,
50
+					     (s16 *)&data);
51
+		if (ret)
52
+			break;
53
+
61
54
 		*val = data;
55
+		ret = IIO_VAL_INT;
62
56
 		break;
63
57
 	case IIO_CHAN_INFO_SCALE:
64
58
 		st->core.param.cmd = MOTIONSENSE_CMD_SENSOR_RANGE;
65
59
 		st->core.param.sensor_range.data = EC_MOTION_SENSE_NO_VALUE;
66
60
 
67
-		if (cros_ec_motion_send_host_cmd(&st->core, 0)) {
68
-			ret = -EIO;
61
+		ret = cros_ec_motion_send_host_cmd(&st->core, 0);
62
+		if (ret)
69
63
 			break;
70
-		}
64
+
71
65
 		*val = st->core.resp->sensor_range.ret;
72
66
 
73
67
 		/* scale * in_pressure_raw --> kPa */
..
..
@@ -102,8 +96,11 @@
102
96
 		/* Always roundup, so caller gets at least what it asks for. */
103
97
 		st->core.param.sensor_range.roundup = 1;
104
98
 
105
-		if (cros_ec_motion_send_host_cmd(&st->core, 0))
106
-			ret = -EIO;
99
+		ret = cros_ec_motion_send_host_cmd(&st->core, 0);
100
+		if (ret == 0) {
101
+			st->core.range_updated = true;
102
+			st->core.curr_range = val;
103
+		}
107
104
 		break;
108
105
 	default:
109
106
 		ret = cros_ec_sensors_core_write(&st->core, chan, val, val2,
..
..
@@ -119,6 +116,7 @@
119
116
 static const struct iio_info cros_ec_baro_info = {
120
117
 	.read_raw = &cros_ec_baro_read,
121
118
 	.write_raw = &cros_ec_baro_write,
119
+	.read_avail = &cros_ec_sensors_core_read_avail,
122
120
 };
123
121
 
124
122
 static int cros_ec_baro_probe(struct platform_device *pdev)
..
..
@@ -139,7 +137,10 @@
139
137
 	if (!indio_dev)
140
138
 		return -ENOMEM;
141
139
 
142
-	ret = cros_ec_sensors_core_init(pdev, indio_dev, true);
140
+	ret = cros_ec_sensors_core_init(pdev, indio_dev, true,
141
+					cros_ec_sensors_capture,
142
+					cros_ec_sensors_push_data,
143
+					true);
143
144
 	if (ret)
144
145
 		return ret;
145
146
 
..
..
@@ -152,16 +153,15 @@
152
153
 	channel->info_mask_separate = BIT(IIO_CHAN_INFO_RAW);
153
154
 	channel->info_mask_shared_by_all =
154
155
 		BIT(IIO_CHAN_INFO_SCALE) |
155
-		BIT(IIO_CHAN_INFO_SAMP_FREQ) |
156
-		BIT(IIO_CHAN_INFO_FREQUENCY);
156
+		BIT(IIO_CHAN_INFO_SAMP_FREQ);
157
+	channel->info_mask_shared_by_all_available =
158
+		BIT(IIO_CHAN_INFO_SAMP_FREQ);
157
159
 	channel->scan_type.realbits = CROS_EC_SENSOR_BITS;
158
160
 	channel->scan_type.storagebits = CROS_EC_SENSOR_BITS;
159
161
 	channel->scan_type.shift = 0;
160
162
 	channel->scan_index = 0;
161
163
 	channel->ext_info = cros_ec_sensors_ext_info;
162
164
 	channel->scan_type.sign = 'u';
163
-
164
-	state->core.calib[0] = 0;
165
165
 
166
166
 	/* Sensor specific */
167
167
 	switch (state->core.type) {
..
..
@@ -187,11 +187,6 @@
187
187
 
188
188
 	state->core.read_ec_sensors_data = cros_ec_sensors_read_cmd;
189
189
 
190
-	ret = devm_iio_triggered_buffer_setup(dev, indio_dev, NULL,
191
-					      cros_ec_sensors_capture, NULL);
192
-	if (ret)
193
-		return ret;
194
-
195
190
 	return devm_iio_device_register(dev, indio_dev);
196
191
 }
197
192
 
..
..
@@ -206,6 +201,7 @@
206
201
 static struct platform_driver cros_ec_baro_platform_driver = {
207
202
 	.driver = {
208
203
 		.name	= "cros-ec-baro",
204
+		.pm	= &cros_ec_sensors_pm_ops,
209
205
 	},
210
206
 	.probe		= cros_ec_baro_probe,
211
207
 	.id_table	= cros_ec_baro_ids,