403 lines
		
	
	
		
			16 KiB
		
	
	
	
		
			C++
		
	
	
	
			
		
		
	
	
			403 lines
		
	
	
		
			16 KiB
		
	
	
	
		
			C++
		
	
	
	
/*
 | 
						|
 * 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.
 | 
						|
 */
 | 
						|
 | 
						|
#include "include/PowerStatsAidl.h"
 | 
						|
#include <aidl/android/hardware/power/stats/BnPowerStats.h>
 | 
						|
 | 
						|
#include <android-base/chrono_utils.h>
 | 
						|
#include <android-base/file.h>
 | 
						|
#include <android-base/logging.h>
 | 
						|
#include <android-base/stringprintf.h>
 | 
						|
#include <android-base/strings.h>
 | 
						|
 | 
						|
#include <inttypes.h>
 | 
						|
#include <chrono>
 | 
						|
#include <numeric>
 | 
						|
#include <string>
 | 
						|
 | 
						|
namespace aidl {
 | 
						|
namespace android {
 | 
						|
namespace hardware {
 | 
						|
namespace power {
 | 
						|
namespace stats {
 | 
						|
 | 
						|
void PowerStats::addStateResidencyDataProvider(std::unique_ptr<IStateResidencyDataProvider> p) {
 | 
						|
    if (!p) {
 | 
						|
        return;
 | 
						|
    }
 | 
						|
 | 
						|
    int32_t id = mPowerEntityInfos.size();
 | 
						|
    auto info = p->getInfo();
 | 
						|
 | 
						|
    size_t index = mStateResidencyDataProviders.size();
 | 
						|
    mStateResidencyDataProviders.emplace_back(std::move(p));
 | 
						|
 | 
						|
    for (const auto &[entityName, states] : info) {
 | 
						|
        PowerEntity i = {
 | 
						|
                .id = id++,
 | 
						|
                .name = entityName,
 | 
						|
                .states = states,
 | 
						|
        };
 | 
						|
        mPowerEntityInfos.emplace_back(i);
 | 
						|
        mStateResidencyDataProviderIndex.emplace_back(index);
 | 
						|
    }
 | 
						|
}
 | 
						|
 | 
						|
ndk::ScopedAStatus PowerStats::getPowerEntityInfo(std::vector<PowerEntity> *_aidl_return) {
 | 
						|
    *_aidl_return = mPowerEntityInfos;
 | 
						|
    return ndk::ScopedAStatus::ok();
 | 
						|
}
 | 
						|
 | 
						|
ndk::ScopedAStatus PowerStats::getStateResidency(const std::vector<int32_t> &in_powerEntityIds,
 | 
						|
                                                 std::vector<StateResidencyResult> *_aidl_return) {
 | 
						|
    if (mPowerEntityInfos.empty()) {
 | 
						|
        return ndk::ScopedAStatus::ok();
 | 
						|
    }
 | 
						|
 | 
						|
    // If in_powerEntityIds is empty then return data for all supported entities
 | 
						|
    if (in_powerEntityIds.empty()) {
 | 
						|
        std::vector<int32_t> v(mPowerEntityInfos.size());
 | 
						|
        std::iota(std::begin(v), std::end(v), 0);
 | 
						|
        return getStateResidency(v, _aidl_return);
 | 
						|
    }
 | 
						|
 | 
						|
    std::unordered_map<std::string, std::vector<StateResidency>> stateResidencies;
 | 
						|
 | 
						|
    for (const int32_t id : in_powerEntityIds) {
 | 
						|
        // check for invalid ids
 | 
						|
        if (id < 0 || id >= mPowerEntityInfos.size()) {
 | 
						|
            return ndk::ScopedAStatus(AStatus_fromExceptionCode(EX_ILLEGAL_ARGUMENT));
 | 
						|
        }
 | 
						|
 | 
						|
        // Check to see if we already have data for the given id
 | 
						|
        std::string powerEntityName = mPowerEntityInfos[id].name;
 | 
						|
        if (stateResidencies.find(powerEntityName) == stateResidencies.end()) {
 | 
						|
            mStateResidencyDataProviders.at(mStateResidencyDataProviderIndex.at(id))
 | 
						|
                    ->getStateResidencies(&stateResidencies);
 | 
						|
        }
 | 
						|
 | 
						|
        // Append results if we have them
 | 
						|
        auto stateResidency = stateResidencies.find(powerEntityName);
 | 
						|
        if (stateResidency != stateResidencies.end()) {
 | 
						|
            StateResidencyResult res = {
 | 
						|
                    .id = id,
 | 
						|
                    .stateResidencyData = stateResidency->second,
 | 
						|
            };
 | 
						|
            _aidl_return->emplace_back(res);
 | 
						|
        } else {
 | 
						|
            // Failed to get results for the given id.
 | 
						|
            LOG(ERROR) << "Failed to get results for " << powerEntityName;
 | 
						|
        }
 | 
						|
    }
 | 
						|
 | 
						|
    return ndk::ScopedAStatus::ok();
 | 
						|
}
 | 
						|
 | 
						|
void PowerStats::addEnergyConsumer(std::unique_ptr<IEnergyConsumer> p) {
 | 
						|
    if (!p) {
 | 
						|
        return;
 | 
						|
    }
 | 
						|
 | 
						|
    std::pair<EnergyConsumerType, std::string> info = p->getInfo();
 | 
						|
 | 
						|
    int32_t count = count_if(mEnergyConsumerInfos.begin(), mEnergyConsumerInfos.end(),
 | 
						|
                             [&info](const EnergyConsumer &c) { return info.first == c.type; });
 | 
						|
    int32_t id = mEnergyConsumers.size();
 | 
						|
    mEnergyConsumerInfos.emplace_back(
 | 
						|
            EnergyConsumer{.id = id, .ordinal = count, .type = info.first, .name = info.second});
 | 
						|
    mEnergyConsumers.emplace_back(std::move(p));
 | 
						|
}
 | 
						|
 | 
						|
ndk::ScopedAStatus PowerStats::getEnergyConsumerInfo(std::vector<EnergyConsumer> *_aidl_return) {
 | 
						|
    *_aidl_return = mEnergyConsumerInfos;
 | 
						|
    return ndk::ScopedAStatus::ok();
 | 
						|
}
 | 
						|
 | 
						|
ndk::ScopedAStatus PowerStats::getEnergyConsumed(const std::vector<int32_t> &in_energyConsumerIds,
 | 
						|
                                                 std::vector<EnergyConsumerResult> *_aidl_return) {
 | 
						|
    if (mEnergyConsumers.empty()) {
 | 
						|
        return ndk::ScopedAStatus::ok();
 | 
						|
    }
 | 
						|
 | 
						|
    // If in_powerEntityIds is empty then return data for all supported energy consumers
 | 
						|
    if (in_energyConsumerIds.empty()) {
 | 
						|
        std::vector<int32_t> v(mEnergyConsumerInfos.size());
 | 
						|
        std::iota(std::begin(v), std::end(v), 0);
 | 
						|
        return getEnergyConsumed(v, _aidl_return);
 | 
						|
    }
 | 
						|
 | 
						|
    for (const auto id : in_energyConsumerIds) {
 | 
						|
        // check for invalid ids
 | 
						|
        if (id < 0 || id >= mEnergyConsumers.size()) {
 | 
						|
            return ndk::ScopedAStatus(AStatus_fromExceptionCode(EX_ILLEGAL_ARGUMENT));
 | 
						|
        }
 | 
						|
 | 
						|
        auto resopt = mEnergyConsumers[id]->getEnergyConsumed();
 | 
						|
        if (resopt) {
 | 
						|
            EnergyConsumerResult res = resopt.value();
 | 
						|
            res.id = id;
 | 
						|
            _aidl_return->emplace_back(res);
 | 
						|
        } else {
 | 
						|
            // Failed to get results for the given id.
 | 
						|
            LOG(ERROR) << "Failed to get results for " << mEnergyConsumerInfos[id].name;
 | 
						|
        }
 | 
						|
    }
 | 
						|
 | 
						|
    return ndk::ScopedAStatus::ok();
 | 
						|
}
 | 
						|
 | 
						|
void PowerStats::setEnergyMeterDataProvider(std::unique_ptr<IEnergyMeterDataProvider> p) {
 | 
						|
    mEnergyMeterDataProvider = std::move(p);
 | 
						|
}
 | 
						|
 | 
						|
ndk::ScopedAStatus PowerStats::getEnergyMeterInfo(std::vector<Channel> *_aidl_return) {
 | 
						|
    if (!mEnergyMeterDataProvider) {
 | 
						|
        return ndk::ScopedAStatus::ok();
 | 
						|
    }
 | 
						|
    return mEnergyMeterDataProvider->getEnergyMeterInfo(_aidl_return);
 | 
						|
}
 | 
						|
 | 
						|
ndk::ScopedAStatus PowerStats::readEnergyMeter(const std::vector<int32_t> &in_channelIds,
 | 
						|
                                               std::vector<EnergyMeasurement> *_aidl_return) {
 | 
						|
    if (!mEnergyMeterDataProvider) {
 | 
						|
        return ndk::ScopedAStatus::ok();
 | 
						|
    }
 | 
						|
    return mEnergyMeterDataProvider->readEnergyMeter(in_channelIds, _aidl_return);
 | 
						|
}
 | 
						|
 | 
						|
void PowerStats::getEntityStateNames(
 | 
						|
        std::unordered_map<int32_t, std::string> *entityNames,
 | 
						|
        std::unordered_map<int32_t, std::unordered_map<int32_t, std::string>> *stateNames) {
 | 
						|
    std::vector<PowerEntity> infos;
 | 
						|
    getPowerEntityInfo(&infos);
 | 
						|
 | 
						|
    for (const auto &info : infos) {
 | 
						|
        entityNames->emplace(info.id, info.name);
 | 
						|
        stateNames->emplace(info.id, std::unordered_map<int32_t, std::string>());
 | 
						|
        auto &entityStateNames = stateNames->at(info.id);
 | 
						|
        for (const auto &state : info.states) {
 | 
						|
            entityStateNames.emplace(state.id, state.name);
 | 
						|
        }
 | 
						|
    }
 | 
						|
}
 | 
						|
 | 
						|
void PowerStats::getChannelNames(std::unordered_map<int32_t, std::string> *channelNames) {
 | 
						|
    std::vector<Channel> infos;
 | 
						|
    getEnergyMeterInfo(&infos);
 | 
						|
 | 
						|
    for (const auto &info : infos) {
 | 
						|
        channelNames->emplace(info.id, "[" + info.name + "]:" + info.subsystem);
 | 
						|
    }
 | 
						|
}
 | 
						|
 | 
						|
void PowerStats::dumpEnergyMeter(std::ostringstream &oss, bool delta) {
 | 
						|
    const char *headerFormat = "  %32s   %18s\n";
 | 
						|
    const char *dataFormat = "  %32s   %14.2f mWs\n";
 | 
						|
    const char *headerFormatDelta = "  %32s   %18s (%14s)\n";
 | 
						|
    const char *dataFormatDelta = "  %32s   %14.2f mWs (%14.2f)\n";
 | 
						|
 | 
						|
    std::unordered_map<int32_t, std::string> channelNames;
 | 
						|
    getChannelNames(&channelNames);
 | 
						|
 | 
						|
    oss << "\n============= PowerStats HAL 2.0 energy meter ==============\n";
 | 
						|
 | 
						|
    std::vector<EnergyMeasurement> energyData;
 | 
						|
    readEnergyMeter({}, &energyData);
 | 
						|
 | 
						|
    if (delta) {
 | 
						|
        static std::vector<EnergyMeasurement> prevEnergyData;
 | 
						|
        ::android::base::boot_clock::time_point curTime = ::android::base::boot_clock::now();
 | 
						|
        static ::android::base::boot_clock::time_point prevTime = curTime;
 | 
						|
 | 
						|
        oss << "Elapsed time: "
 | 
						|
            << std::chrono::duration_cast<std::chrono::milliseconds>(curTime - prevTime).count()
 | 
						|
            << " ms\n";
 | 
						|
 | 
						|
        oss << ::android::base::StringPrintf(headerFormatDelta, "Channel", "Cumulative Energy",
 | 
						|
                                             "Delta   ");
 | 
						|
 | 
						|
        std::unordered_map<int32_t, int64_t> prevEnergyDataMap;
 | 
						|
        for (const auto &data : prevEnergyData) {
 | 
						|
            prevEnergyDataMap.emplace(data.id, data.energyUWs);
 | 
						|
        }
 | 
						|
 | 
						|
        for (const auto &data : energyData) {
 | 
						|
            auto prevEnergyDataIt = prevEnergyDataMap.find(data.id);
 | 
						|
            int64_t deltaEnergy = 0;
 | 
						|
            if (prevEnergyDataIt != prevEnergyDataMap.end()) {
 | 
						|
                deltaEnergy = data.energyUWs - prevEnergyDataIt->second;
 | 
						|
            }
 | 
						|
 | 
						|
            oss << ::android::base::StringPrintf(dataFormatDelta, channelNames.at(data.id).c_str(),
 | 
						|
                                                 static_cast<float>(data.energyUWs) / 1000.0,
 | 
						|
                                                 static_cast<float>(deltaEnergy) / 1000.0);
 | 
						|
        }
 | 
						|
 | 
						|
        prevEnergyData = energyData;
 | 
						|
        prevTime = curTime;
 | 
						|
    } else {
 | 
						|
        oss << ::android::base::StringPrintf(headerFormat, "Channel", "Cumulative Energy");
 | 
						|
 | 
						|
        for (const auto &data : energyData) {
 | 
						|
            oss << ::android::base::StringPrintf(dataFormat, channelNames.at(data.id).c_str(),
 | 
						|
                                                 static_cast<float>(data.energyUWs) / 1000.0);
 | 
						|
        }
 | 
						|
    }
 | 
						|
 | 
						|
    oss << "========== End of PowerStats HAL 2.0 energy meter ==========\n";
 | 
						|
}
 | 
						|
 | 
						|
void PowerStats::dumpStateResidency(std::ostringstream &oss, bool delta) {
 | 
						|
    const char *headerFormat = "  %16s   %18s   %16s   %15s   %17s\n";
 | 
						|
    const char *dataFormat =
 | 
						|
            "  %16s   %18s   %13" PRIu64 " ms   %15" PRIu64 "   %14" PRIu64 " ms\n";
 | 
						|
    const char *headerFormatDelta = "  %16s   %18s   %16s (%14s)   %15s (%16s)   %17s (%14s)\n";
 | 
						|
    const char *dataFormatDelta = "  %16s   %18s   %13" PRIu64 " ms (%14" PRId64 ")   %15" PRIu64
 | 
						|
                                  " (%16" PRId64 ")   %14" PRIu64 " ms (%14" PRId64 ")\n";
 | 
						|
 | 
						|
    // Construct maps to entity and state names
 | 
						|
    std::unordered_map<int32_t, std::string> entityNames;
 | 
						|
    std::unordered_map<int32_t, std::unordered_map<int32_t, std::string>> stateNames;
 | 
						|
    getEntityStateNames(&entityNames, &stateNames);
 | 
						|
 | 
						|
    oss << "\n============= PowerStats HAL 2.0 state residencies ==============\n";
 | 
						|
 | 
						|
    std::vector<StateResidencyResult> results;
 | 
						|
    getStateResidency({}, &results);
 | 
						|
 | 
						|
    if (delta) {
 | 
						|
        static std::vector<StateResidencyResult> prevResults;
 | 
						|
        ::android::base::boot_clock::time_point curTime = ::android::base::boot_clock::now();
 | 
						|
        static ::android::base::boot_clock::time_point prevTime = curTime;
 | 
						|
 | 
						|
        oss << "Elapsed time: "
 | 
						|
            << std::chrono::duration_cast<std::chrono::milliseconds>(curTime - prevTime).count()
 | 
						|
            << " ms\n";
 | 
						|
 | 
						|
        oss << ::android::base::StringPrintf(headerFormatDelta, "Entity", "State", "Total time",
 | 
						|
                                             "Delta   ", "Total entries", "Delta   ",
 | 
						|
                                             "Last entry tstamp", "Delta ");
 | 
						|
 | 
						|
        // Process prevResults into a 2-tier lookup table for easy reference
 | 
						|
        std::unordered_map<int32_t, std::unordered_map<int32_t, StateResidency>> prevResultsMap;
 | 
						|
        for (const auto &prevResult : prevResults) {
 | 
						|
            prevResultsMap.emplace(prevResult.id, std::unordered_map<int32_t, StateResidency>());
 | 
						|
            for (auto stateResidency : prevResult.stateResidencyData) {
 | 
						|
                prevResultsMap.at(prevResult.id).emplace(stateResidency.id, stateResidency);
 | 
						|
            }
 | 
						|
        }
 | 
						|
 | 
						|
        // Iterate over the new result data (one "result" per entity)
 | 
						|
        for (const auto &result : results) {
 | 
						|
            const char *entityName = entityNames.at(result.id).c_str();
 | 
						|
 | 
						|
            // Look up previous result data for the same entity
 | 
						|
            auto prevEntityResultIt = prevResultsMap.find(result.id);
 | 
						|
 | 
						|
            // Iterate over individual states within the current entity's new result
 | 
						|
            for (const auto &stateResidency : result.stateResidencyData) {
 | 
						|
                const char *stateName = stateNames.at(result.id).at(stateResidency.id).c_str();
 | 
						|
 | 
						|
                // If a previous result was found for the same entity, see if that
 | 
						|
                // result also contains data for the current state
 | 
						|
                int64_t deltaTotalTime = 0;
 | 
						|
                int64_t deltaTotalCount = 0;
 | 
						|
                int64_t deltaTimestamp = 0;
 | 
						|
                if (prevEntityResultIt != prevResultsMap.end()) {
 | 
						|
                    auto prevStateResidencyIt = prevEntityResultIt->second.find(stateResidency.id);
 | 
						|
                    // If a previous result was found for the current entity and state, calculate
 | 
						|
                    // the deltas and display them along with new result
 | 
						|
                    if (prevStateResidencyIt != prevEntityResultIt->second.end()) {
 | 
						|
                        deltaTotalTime = stateResidency.totalTimeInStateMs -
 | 
						|
                                         prevStateResidencyIt->second.totalTimeInStateMs;
 | 
						|
                        deltaTotalCount = stateResidency.totalStateEntryCount -
 | 
						|
                                          prevStateResidencyIt->second.totalStateEntryCount;
 | 
						|
                        deltaTimestamp = stateResidency.lastEntryTimestampMs -
 | 
						|
                                         prevStateResidencyIt->second.lastEntryTimestampMs;
 | 
						|
                    }
 | 
						|
                }
 | 
						|
 | 
						|
                oss << ::android::base::StringPrintf(
 | 
						|
                        dataFormatDelta, entityName, stateName, stateResidency.totalTimeInStateMs,
 | 
						|
                        deltaTotalTime, stateResidency.totalStateEntryCount, deltaTotalCount,
 | 
						|
                        stateResidency.lastEntryTimestampMs, deltaTimestamp);
 | 
						|
            }
 | 
						|
        }
 | 
						|
 | 
						|
        prevResults = results;
 | 
						|
        prevTime = curTime;
 | 
						|
    } else {
 | 
						|
        oss << ::android::base::StringPrintf(headerFormat, "Entity", "State", "Total time",
 | 
						|
                                             "Total entries", "Last entry tstamp");
 | 
						|
        for (const auto &result : results) {
 | 
						|
            for (const auto &stateResidency : result.stateResidencyData) {
 | 
						|
                oss << ::android::base::StringPrintf(
 | 
						|
                        dataFormat, entityNames.at(result.id).c_str(),
 | 
						|
                        stateNames.at(result.id).at(stateResidency.id).c_str(),
 | 
						|
                        stateResidency.totalTimeInStateMs, stateResidency.totalStateEntryCount,
 | 
						|
                        stateResidency.lastEntryTimestampMs);
 | 
						|
            }
 | 
						|
        }
 | 
						|
    }
 | 
						|
 | 
						|
    oss << "========== End of PowerStats HAL 2.0 state residencies ==========\n";
 | 
						|
}
 | 
						|
 | 
						|
void PowerStats::dumpEnergyConsumer(std::ostringstream &oss, bool delta) {
 | 
						|
    (void)delta;
 | 
						|
 | 
						|
    std::vector<EnergyConsumerResult> results;
 | 
						|
    getEnergyConsumed({}, &results);
 | 
						|
 | 
						|
    oss << "\n============= PowerStats HAL 2.0 energy consumers ==============\n";
 | 
						|
 | 
						|
    for (const auto &result : results) {
 | 
						|
        oss << ::android::base::StringPrintf("%-12s : %14.2f mWs\n",
 | 
						|
                                             mEnergyConsumers[result.id]->getConsumerName().c_str(),
 | 
						|
                                             static_cast<float>(result.energyUWs) / 1000.0);
 | 
						|
        for (auto &attr : result.attribution) {
 | 
						|
            oss << ::android::base::StringPrintf("  %10d - %14.2f mWs\n", attr.uid,
 | 
						|
                                                 static_cast<float>(attr.energyUWs) / 1000.0);
 | 
						|
        }
 | 
						|
    }
 | 
						|
 | 
						|
    oss << "========== End of PowerStats HAL 2.0 energy consumers ==========\n";
 | 
						|
}
 | 
						|
 | 
						|
binder_status_t PowerStats::dump(int fd, const char **args, uint32_t numArgs) {
 | 
						|
    std::ostringstream oss;
 | 
						|
    bool delta = (numArgs == 1) && (std::string(args[0]) == "delta");
 | 
						|
 | 
						|
    // Generate debug output for state residency
 | 
						|
    dumpStateResidency(oss, delta);
 | 
						|
 | 
						|
    // Generate debug output for energy consumer
 | 
						|
    dumpEnergyConsumer(oss, delta);
 | 
						|
 | 
						|
    // Generate debug output energy meter
 | 
						|
    dumpEnergyMeter(oss, delta);
 | 
						|
 | 
						|
    ::android::base::WriteStringToFd(oss.str(), fd);
 | 
						|
    fsync(fd);
 | 
						|
    return STATUS_OK;
 | 
						|
}
 | 
						|
 | 
						|
}  // namespace stats
 | 
						|
}  // namespace power
 | 
						|
}  // namespace hardware
 | 
						|
}  // namespace android
 | 
						|
}  // namespace aidl
 |