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
|
#include <MPLSupport.h>
#include <string.h>
#include <stdio.h>
#include "log.h"
#include "SensorBase.h"
#include <fcntl.h>
int inv_read_data(char *fname, long *data)
{
VFUNC_LOG;
char buf[sizeof(long) * 4];
int count, fd;
fd = open(fname, O_RDONLY);
if(fd < 0) {
LOGE("HAL:Error opening %s", fname);
return -1;
}
memset(buf, 0, sizeof(buf));
count = read_attribute_sensor(fd, buf, sizeof(buf));
if(count < 1) {
close(fd);
return -1;
} else {
count = sscanf(buf, "%ld", data);
if(count)
LOGV_IF(EXTRA_VERBOSE, "HAL:Data= %ld", *data);
}
close(fd);
return 0;
}
/* This one DOES NOT close FDs for you */
int read_attribute_sensor(int fd, char* data, unsigned int size)
{
VFUNC_LOG;
int count = 0;
if (fd > 0) {
count = pread(fd, data, size, 0);
if(count < 1) {
LOGE("HAL:read fails with error code=%d", count);
}
}
return count;
}
/**
* @brief Enable a sensor through the sysfs file descriptor
* provided.
* @note this function one closes FD after the write
* @param fd
* the file descriptor to write into
* @param en
* the value to write, typically 1 or 0
* @return the errno whenever applicable.
*/
int enable_sysfs_sensor(int fd, int en)
{
VFUNC_LOG;
int nb = -1;
int err = 0;
if (fd >= 0) {
char buf[2];
if (en) {
buf[0] = '1';
nb = write(fd, buf, 1);
} else {
buf[0] = '0';
nb = write(fd, buf, 1);
}
buf[1] = '\0';
if (nb <= 0) {
err = errno;
LOGE("HAL:enable_sysfs_sensor - write %c returned %d (%s / %d)",
buf[0], nb, strerror(err), err);
}
close(fd);
} else {
LOGV_IF(EXTRA_VERBOSE, "HAL:enable_sysfs_sensor - fd<0");
}
return err;
}
/* This one closes FDs for you */
int write_attribute_sensor(int fd, long data)
{
VFUNC_LOG;
int num_b = 0;
if (fd >= 0) {
char buf[80];
sprintf(buf, "%ld", data);
num_b = write(fd, buf, strlen(buf) + 1);
if (num_b <= 0) {
int err = errno;
LOGE("HAL:write fd %d returned '%s' (%d)", fd, strerror(err), err);
} else {
LOGV_IF(EXTRA_VERBOSE, "HAL:fd=%d write attribute to %ld", fd, data);
}
close(fd);
}
return num_b;
}
int read_sysfs_int(char *filename, int *var)
{
int res=0;
FILE *sysfsfp;
sysfsfp = fopen(filename, "r");
if (sysfsfp!=NULL) {
fscanf(sysfsfp, "%d\n", var);
fclose(sysfsfp);
} else {
LOGE("HAL:ERR open file to read");
res= -1;
}
return res;
}
int write_sysfs_int(char *filename, int var)
{
int res=0;
FILE *sysfsfp;
sysfsfp = fopen(filename, "w");
if (sysfsfp!=NULL) {
fprintf(sysfsfp, "%d\n", var);
fclose(sysfsfp);
} else {
LOGE("HAL:ERR open file to write");
res= -1;
}
return res;
}
|
