forked from intel/android-iio-sensors-hal
-
Notifications
You must be signed in to change notification settings - Fork 3
/
utils.c
239 lines (176 loc) · 4.63 KB
/
utils.c
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
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
/*
// Copyright (c) 2015 Intel Corporation
//
// Licensed under the Apache License, Version 2.0 (the "License");
// you may not use this file except in compliance with the License.
// You may obtain a copy of the License at
//
// http://www.apache.org/licenses/LICENSE-2.0
//
// Unless required by applicable law or agreed to in writing, software
// distributed under the License is distributed on an "AS IS" BASIS,
// WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
// See the License for the specific language governing permissions and
// limitations under the License.
*/
#include <stdlib.h>
#include <fcntl.h>
#include <sys/ioctl.h>
#include <utils/Log.h>
#include <hardware/sensors.h>
#include <utils/Atomic.h>
#include <linux/android_alarm.h>
#include "common.h"
#include "utils.h"
#include <errno.h>
/* Note:
*
* Some of these calls are going to fail, because not all sensors expose all
* possible sysfs attributes. As an optimization we may want to cache which
* ones are valid and immediately return in error for inexistent entries.
*/
int sysfs_read(const char path[PATH_MAX], void *buf, int buf_len)
{
int fd, len;
if (!path[0] || !buf || buf_len < 1)
return -1;
fd = open(path, O_RDONLY);
if (fd == -1) {
ALOGV("Cannot open %s (%s)\n", path, strerror(errno));
return -1;
}
len = read(fd, buf, buf_len);
close(fd);
if (len == -1)
ALOGW("Cannot read from %s (%s)\n", path, strerror(errno));
else
ALOGV("Read %d bytes from %s\n", len, path);
return len;
}
int sysfs_write(const char path[PATH_MAX], const void *buf, const int buf_len)
{
int fd, len;
if (!path[0] || !buf || buf_len < 1)
return -1;
fd = open(path, O_WRONLY);
if (fd == -1) {
ALOGV("Cannot open %s (%s)\n", path, strerror(errno));
return -1;
}
len = write(fd, buf, buf_len);
close(fd);
if (len == -1)
ALOGW("Cannot write to %s (%s)\n", path, strerror(errno));
else if (len != buf_len)
ALOGW("Cannot write %d bytes to %s (%d)\n", buf_len, path, len);
else
ALOGV("Wrote %d bytes to %s\n", buf_len, path);
return len;
}
static void str2int(const char* buf, void *v)
{
*(int*)v = atoi(buf);
}
static void str2float(const char* buf, void *v)
{
*(float*)v = strtof(buf, NULL);
}
static void str2uint64(const char* buf, void *v)
{
*(uint64_t*)v = atoll(buf);
}
int sysfs_read_num(const char path[PATH_MAX], void *v,
void (*str2num)(const char* buf, void *v))
{
char buf[20];
int len = sysfs_read_str(path, buf, sizeof(buf));
if (len <= 0) {
ALOGW("Cannot read number from %s (%s)\n", path,
strerror(errno));
return -1;
}
str2num(buf, v);
return 0;
}
int sysfs_read_int(const char path[PATH_MAX], int *value)
{
return sysfs_read_num(path, value, str2int);
}
int sysfs_read_float(const char path[PATH_MAX], float *value)
{
return sysfs_read_num(path, value, str2float);
}
int sysfs_read_uint64(const char path[PATH_MAX], uint64_t *value)
{
return sysfs_read_num(path, value, str2uint64);
}
int sysfs_write_int(const char path[PATH_MAX], int value)
{
char buf[20];
int len = snprintf(buf, sizeof(buf), "%d", value);
if (len <= 0) {
ALOGE("Unexpected condition in sysfs_write_int\n");
return -1;
}
return sysfs_write(path, buf, len);
}
int sysfs_write_float(const char path[PATH_MAX], float value)
{
char buf[20];
int len = snprintf(buf, sizeof(buf), "%g", value);
if (len <= 0) {
ALOGE("Unexpected condition in sysfs_write_float\n");
return -1;
}
return sysfs_write(path, buf, len);
}
int sysfs_write_str(const char path[PATH_MAX], const char *str)
{
if (!str || !str[0])
return -1;
return sysfs_write(path, str, strlen(str));
}
int sysfs_read_str(const char path[PATH_MAX], char *buf, int buf_len)
{
int len;
if (!buf || buf_len < 1)
return -1;
len = sysfs_read(path, buf, buf_len);
if (len == -1) {
ALOGW("Cannot read string from %s (%s)\n", path,
strerror(errno));
return -1;
}
buf[len == 0 ? 0 : len - 1] = '\0';
ALOGV("Read %s from %s\n", buf, path);
return len;
}
int64_t get_timestamp (clockid_t clock_id)
{
struct timespec ts = {0};
if (!clock_gettime(clock_id, &ts))
return 1000000000LL * ts.tv_sec + ts.tv_nsec;
else /* in this case errno is set appropriately */
return -1;
}
int64_t get_timestamp_realtime (void)
{
return get_timestamp(CLOCK_REALTIME);
}
int64_t get_timestamp_boot (void)
{
return get_timestamp(CLOCK_BOOTTIME);
}
int64_t get_timestamp_thread (void)
{
return get_timestamp(CLOCK_THREAD_CPUTIME_ID);
}
int64_t get_timestamp_monotonic (void)
{
return get_timestamp(CLOCK_MONOTONIC);
}
void set_timestamp (struct timespec *out, int64_t target_ns)
{
out->tv_sec = target_ns / 1000000000LL;
out->tv_nsec = target_ns % 1000000000LL;
}