260 lines
8.9 KiB
C++
260 lines
8.9 KiB
C++
/*
|
|
* Copyright (C) 2018 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 "fastboot/Fastboot.h"
|
|
|
|
#include <android-base/file.h>
|
|
#include <android-base/logging.h>
|
|
#include <android-base/strings.h>
|
|
#include <android-base/unique_fd.h>
|
|
#include <dlfcn.h>
|
|
|
|
#include <map>
|
|
#include <string>
|
|
#include <unordered_map>
|
|
#include <vector>
|
|
|
|
// FS headers
|
|
#include <ext4_utils/wipe.h>
|
|
#include <fs_mgr.h>
|
|
#include <fs_mgr/roots.h>
|
|
|
|
// Nugget headers
|
|
#include <app_nugget.h>
|
|
#include <nos/NuggetClient.h>
|
|
#include <nos/debug.h>
|
|
|
|
namespace android {
|
|
namespace hardware {
|
|
namespace fastboot {
|
|
namespace V1_1 {
|
|
namespace implementation {
|
|
|
|
constexpr const char* BRIGHTNESS_FILE = "/sys/class/backlight/panel0-backlight/brightness";
|
|
constexpr int DISPLAY_BRIGHTNESS_DIM_THRESHOLD = 20;
|
|
|
|
using OEMCommandHandler = std::function<Result(const std::vector<std::string>&)>;
|
|
|
|
Return<void> Fastboot::getPartitionType(const ::android::hardware::hidl_string& /* partitionName */,
|
|
getPartitionType_cb _hidl_cb) {
|
|
// For bluecross devices, all partitions need to return raw.
|
|
_hidl_cb(FileSystemType::RAW, { Status::SUCCESS, "" });
|
|
return Void();
|
|
}
|
|
|
|
Return<void> Fastboot::getVariant(getVariant_cb _hidl_cb) {
|
|
_hidl_cb("MSM USF", {Status::SUCCESS, "" });
|
|
return Void();
|
|
}
|
|
|
|
Return<void> Fastboot::getOffModeChargeState(getOffModeChargeState_cb _hidl_cb) {
|
|
constexpr const char* kDevinfoPath = "/dev/block/by-name/devinfo";
|
|
constexpr int kDevInfoOffModeChargeOffset = 15;
|
|
|
|
uint8_t off_mode_charge_status = 0;
|
|
android::base::unique_fd fd(TEMP_FAILURE_RETRY(open(kDevinfoPath,
|
|
O_RDONLY | O_BINARY)));
|
|
if (!android::base::ReadFullyAtOffset(fd, &off_mode_charge_status, 1 /* byte count */,
|
|
kDevInfoOffModeChargeOffset)) {
|
|
_hidl_cb(false,
|
|
{ Status::FAILURE_UNKNOWN, "Unable to read off-mode-charge state" });
|
|
} else {
|
|
_hidl_cb(off_mode_charge_status != 0, { Status::SUCCESS, "" });
|
|
}
|
|
|
|
return Void();
|
|
}
|
|
|
|
Return<void> Fastboot::getBatteryVoltageFlashingThreshold(
|
|
getBatteryVoltageFlashingThreshold_cb _hidl_cb) {
|
|
constexpr int kMinVoltageForFlashing = 3500;
|
|
_hidl_cb(kMinVoltageForFlashing, { Status::SUCCESS, "" });
|
|
return Void();
|
|
}
|
|
|
|
Result SetBrightnessLevel(const std::vector<std::string>& args) {
|
|
if (!args.size()) {
|
|
return { Status::INVALID_ARGUMENT, "Brightness level unspecified" };
|
|
}
|
|
|
|
auto level = std::stoi(args[0]);
|
|
|
|
if (level < 0 || level > 100) {
|
|
return { Status::INVALID_ARGUMENT, "Brighness level must be between 0 and 100" };
|
|
}
|
|
|
|
// Avoid screen being dimmed too much.
|
|
if (level < DISPLAY_BRIGHTNESS_DIM_THRESHOLD) {
|
|
level = DISPLAY_BRIGHTNESS_DIM_THRESHOLD;
|
|
}
|
|
|
|
if (android::base::WriteStringToFile(std::to_string(level), BRIGHTNESS_FILE)) {
|
|
return { Status::SUCCESS, "" };
|
|
}
|
|
|
|
return { Status::FAILURE_UNKNOWN, "Unable to set display brightness" };
|
|
}
|
|
|
|
Return<void> Fastboot::doOemCommand(const ::android::hardware::hidl_string& oemCmdArgs,
|
|
doOemCommand_cb _hidl_cb) {
|
|
const std::unordered_map<std::string, OEMCommandHandler> kOEMCmdMap = {
|
|
{FB_OEM_SET_BRIGHTNESS, SetBrightnessLevel},
|
|
};
|
|
|
|
auto args = android::base::Split(oemCmdArgs, " ");
|
|
if (args.size() < 2) {
|
|
_hidl_cb({ Status::INVALID_ARGUMENT, "Invalid OEM command" });
|
|
return Void();
|
|
}
|
|
|
|
// args[0] will be "oem", args[1] will be the command name
|
|
auto cmd_handler = kOEMCmdMap.find(args[1]);
|
|
if (cmd_handler != kOEMCmdMap.end()) {
|
|
_hidl_cb(cmd_handler->second(std::vector<std::string>(args.begin() + 2, args.end())));
|
|
} else {
|
|
_hidl_cb({ Status::FAILURE_UNKNOWN, "Unknown OEM command" });
|
|
}
|
|
|
|
return Void();
|
|
}
|
|
|
|
static android::fs_mgr::Fstab fstab;
|
|
enum WipeVolumeStatus {
|
|
WIPE_OK = 0,
|
|
VOL_FSTAB,
|
|
VOL_UNKNOWN,
|
|
VOL_MOUNTED,
|
|
VOL_BLK_DEV_OPEN,
|
|
WIPE_ERROR_MAX = 0xffffffff,
|
|
};
|
|
std::map<enum WipeVolumeStatus, std::string> wipe_vol_ret_msg{
|
|
{WIPE_OK, ""},
|
|
{VOL_FSTAB, "Unknown FS table"},
|
|
{VOL_UNKNOWN, "Unknown volume"},
|
|
{VOL_MOUNTED, "Fail to unmount volume"},
|
|
{VOL_BLK_DEV_OPEN, "Fail to open block device"},
|
|
{WIPE_ERROR_MAX, "Unknown wipe error"}};
|
|
|
|
enum WipeVolumeStatus wipe_volume(const std::string &volume) {
|
|
if (!android::fs_mgr::ReadDefaultFstab(&fstab)) {
|
|
return VOL_FSTAB;
|
|
}
|
|
const fs_mgr::FstabEntry *v = android::fs_mgr::GetEntryForPath(&fstab, volume);
|
|
if (v == nullptr) {
|
|
return VOL_UNKNOWN;
|
|
}
|
|
if (android::fs_mgr::EnsurePathUnmounted(&fstab, volume) != true) {
|
|
return VOL_MOUNTED;
|
|
}
|
|
|
|
int fd = open(v->blk_device.c_str(), O_WRONLY | O_CREAT, 0644);
|
|
if (fd == -1) {
|
|
return VOL_BLK_DEV_OPEN;
|
|
}
|
|
wipe_block_device(fd, get_block_device_size(fd));
|
|
close(fd);
|
|
|
|
return WIPE_OK;
|
|
}
|
|
|
|
// Attempt to reuse a WipeKeys function that might be found in the recovery
|
|
// library in order to clear any digital car keys on the secure element.
|
|
bool WipeDigitalCarKeys(void) {
|
|
static constexpr const char *kDefaultLibRecoveryUIExt = "librecovery_ui_ext.so";
|
|
void *librecovery_ui_ext = dlopen(kDefaultLibRecoveryUIExt, RTLD_NOW);
|
|
if (librecovery_ui_ext == nullptr) {
|
|
// Dynamic library not found. Returning true since this likely
|
|
// means target does not support DCK.
|
|
return true;
|
|
}
|
|
|
|
bool *(*WipeKeysFunc)(void *const);
|
|
reinterpret_cast<void *&>(WipeKeysFunc) = dlsym(librecovery_ui_ext, "WipeKeys");
|
|
if (WipeKeysFunc == nullptr) {
|
|
// No WipeKeys implementation found. Returning true since this likely
|
|
// means target does not support DCK.
|
|
return true;
|
|
}
|
|
|
|
return (*WipeKeysFunc)(nullptr);
|
|
}
|
|
|
|
Return<void> Fastboot::doOemSpecificErase(V1_1::IFastboot::doOemSpecificErase_cb _hidl_cb) {
|
|
// Erase metadata partition along with userdata partition.
|
|
// Keep erasing Titan M even if failing on this case.
|
|
auto wipe_status = wipe_volume("/metadata");
|
|
|
|
bool dck_wipe_success = WipeDigitalCarKeys();
|
|
|
|
// Connect to Titan M
|
|
::nos::NuggetClient client;
|
|
client.Open();
|
|
if (!client.IsOpen()) {
|
|
_hidl_cb({ Status::FAILURE_UNKNOWN, "open Titan M fail" });
|
|
return Void();
|
|
}
|
|
|
|
// Tell Titan M to wipe user data
|
|
const uint32_t magicValue = htole32(ERASE_CONFIRMATION);
|
|
std::vector<uint8_t> magic(sizeof(magicValue));
|
|
memcpy(magic.data(), &magicValue, sizeof(magicValue));
|
|
const uint8_t retry_count = 5;
|
|
uint32_t nugget_status;
|
|
for (uint8_t i = 0; i < retry_count; i++) {
|
|
nugget_status = client.CallApp(APP_ID_NUGGET, NUGGET_PARAM_NUKE_FROM_ORBIT, magic, nullptr);
|
|
if (nugget_status == APP_SUCCESS && wipe_status == WIPE_OK && dck_wipe_success) {
|
|
_hidl_cb({Status::SUCCESS, wipe_vol_ret_msg[wipe_status]});
|
|
return Void();
|
|
}
|
|
}
|
|
|
|
// Return exactly what happened
|
|
if (nugget_status != APP_SUCCESS && wipe_status != WIPE_OK && !dck_wipe_success) {
|
|
_hidl_cb({Status::FAILURE_UNKNOWN, "Fail on wiping metadata, Titan M user data, and DCK"});
|
|
} else if (nugget_status != APP_SUCCESS && wipe_status != WIPE_OK) {
|
|
_hidl_cb({Status::FAILURE_UNKNOWN, "Fail on wiping metadata and Titan M user data"});
|
|
} else if (nugget_status != APP_SUCCESS && !dck_wipe_success) {
|
|
_hidl_cb({Status::FAILURE_UNKNOWN, "Titan M user data and DCK wipe failed"});
|
|
} else if (nugget_status != APP_SUCCESS) {
|
|
_hidl_cb({Status::FAILURE_UNKNOWN, "Titan M user data wipe failed"});
|
|
} else if (wipe_status != WIPE_OK && !dck_wipe_success) {
|
|
_hidl_cb({Status::FAILURE_UNKNOWN, "Fail on wiping metadata and DCK"});
|
|
} else if (!dck_wipe_success) {
|
|
_hidl_cb({Status::FAILURE_UNKNOWN, "DCK wipe failed"});
|
|
} else {
|
|
if (wipe_vol_ret_msg.find(wipe_status) != wipe_vol_ret_msg.end())
|
|
_hidl_cb({Status::FAILURE_UNKNOWN, wipe_vol_ret_msg[wipe_status]});
|
|
else // Should not reach here, but handle it anyway
|
|
_hidl_cb({Status::FAILURE_UNKNOWN, "Unknown failure"});
|
|
}
|
|
|
|
return Void();
|
|
}
|
|
|
|
Fastboot::Fastboot() {}
|
|
|
|
// Methods from ::android::hidl::base::V1_0::IBase follow.
|
|
|
|
extern "C" IFastboot* HIDL_FETCH_IFastboot(const char* /* name */) {
|
|
return new Fastboot();
|
|
}
|
|
|
|
} // namespace implementation
|
|
} // namespace V1_1
|
|
} // namespace fastboot
|
|
} // namespace hardware
|
|
} // namespace android
|