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
|
/*
* Copyright (C) 2020 The Android Open Source Project
*
* 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.
*/
#define LOG_TAG "android.hardware.powerstats-service.pixel"
#include <dataproviders/IioRailEnergyDataProvider.h>
#include <android-base/file.h>
#include <android-base/logging.h>
#include <android-base/stringprintf.h>
#include <android-base/strings.h>
namespace aidl {
namespace android {
namespace hardware {
namespace powerstats {
void IioRailEnergyDataProvider::findIioPowerMonitorNodes() {
struct dirent *ent;
DIR *iioDir = opendir(kIioRootDir.c_str());
if (!iioDir) {
PLOG(ERROR) << "Error opening directory" << kIioRootDir;
return;
}
// Find any iio:devices that match the given deviceName
while (ent = readdir(iioDir), ent) {
std::string devTypeDir = ent->d_name;
if (devTypeDir.find(kDeviceType) != std::string::npos) {
std::string devicePath = kIioRootDir + devTypeDir;
std::string deviceName;
if (!::android::base::ReadFileToString(devicePath + kNameNode, &deviceName)) {
LOG(WARNING) << "Failed to read device name from " << devicePath;
} else if (deviceName.find(kDeviceName) != std::string::npos) {
mDevicePaths.push_back(devicePath);
}
}
}
closedir(iioDir);
return;
}
void IioRailEnergyDataProvider::parsePowerRails() {
std::string data;
int32_t index = 0;
for (const auto &path : mDevicePaths) {
// Get sampling rate
unsigned long samplingRate;
if (!::android::base::ReadFileToString(path + kSamplingRateNode, &data) ||
(samplingRate = std::stoul(data)) == 0) {
LOG(ERROR) << "Error reading sampling rate from " << path;
continue;
}
// Get list of enabled rails
if (!::android::base::ReadFileToString(path + kEnabledRailsNode, &data)) {
LOG(ERROR) << "Error reading enabled rails from " << path;
continue;
}
// Build RailInfos from list of enabled rails
std::istringstream railNames(data);
std::string line;
while (std::getline(railNames, line)) {
std::vector<std::string> words = ::android::base::Split(line, ":");
if (words.size() == 2) {
mRailInfos.push_back({.railIndex = index,
.railName = words[0],
.subsysName = words[1],
.samplingRateHz = static_cast<int32_t>(samplingRate)});
mRailIndices.emplace(words[0], index);
index++;
} else {
LOG(WARNING) << "Unexpected enabled rail format in " << path;
}
}
}
}
IioRailEnergyDataProvider::IioRailEnergyDataProvider(const std::string &deviceName)
: kDeviceName(std::move(deviceName)) {
findIioPowerMonitorNodes();
parsePowerRails();
mReading.resize(mRailInfos.size());
}
int IioRailEnergyDataProvider::parseIioEnergyNode(std::string path) {
int ret = 0;
std::string data;
if (!::android::base::ReadFileToString(path + kEnergyValueNode, &data)) {
LOG(ERROR) << "Error reading energy value in " << path;
return -1;
}
std::istringstream energyData(data);
std::string line;
uint64_t timestamp = 0;
bool timestampRead = false;
while (std::getline(energyData, line)) {
std::vector<std::string> words = ::android::base::Split(line, ",");
if (timestampRead == false) {
if (words.size() == 1) {
timestamp = std::stoull(words[0]);
if (timestamp == 0 || timestamp == ULLONG_MAX) {
LOG(WARNING) << "Potentially wrong timestamp: " << timestamp;
}
timestampRead = true;
}
} else if (words.size() == 2) {
std::string railName = words[0];
if (mRailIndices.count(railName) != 0) {
size_t index = mRailIndices[railName];
mReading[index].railIndex = index;
mReading[index].timestampMs = timestamp;
mReading[index].energyUWs = std::stoull(words[1]);
if (mReading[index].energyUWs == ULLONG_MAX) {
LOG(WARNING) << "Potentially wrong energy value: " << mReading[index].energyUWs;
}
}
} else {
LOG(WARNING) << "Unexpected energy value format in " << path;
ret = -1;
break;
}
}
return ret;
}
ndk::ScopedAStatus IioRailEnergyDataProvider::getEnergyData(
const std::vector<int32_t> &in_railIndices, std::vector<EnergyData> *_aidl_return) {
std::scoped_lock lock(mLock);
binder_status_t ret = STATUS_OK;
for (const auto &devicePath : mDevicePaths) {
if (parseIioEnergyNode(devicePath) < 0) {
LOG(ERROR) << "Error in parsing " << devicePath;
return ndk::ScopedAStatus::fromStatus(STATUS_FAILED_TRANSACTION);
}
}
if (in_railIndices.empty()) {
*_aidl_return = mReading;
} else {
_aidl_return->reserve(in_railIndices.size());
for (const auto &railIndex : in_railIndices) {
if (railIndex < mRailInfos.size()) {
_aidl_return->emplace_back(mReading[railIndex]);
} else {
ret = STATUS_BAD_VALUE;
}
}
}
return ndk::ScopedAStatus::fromStatus(ret);
}
ndk::ScopedAStatus IioRailEnergyDataProvider::getRailInfo(std::vector<RailInfo> *_aidl_return) {
std::scoped_lock lk(mLock);
*_aidl_return = mRailInfos;
return ndk::ScopedAStatus::ok();
}
} // namespace powerstats
} // namespace hardware
} // namespace android
} // namespace aidl
|
