/* * Copyright (C) 2016 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 "bootloader_message.h" #include #include #include #include #include #include #include #include #include #include using android::fs_mgr::Fstab; using android::fs_mgr::GetEntryForMountPoint; using android::fs_mgr::ReadDefaultFstab; constexpr off_t kBootloaderControlOffset = offsetof(bootloader_message_ab, slot_suffix); static std::string get_misc_blk_device(std::string* err) { Fstab fstab; if (!ReadDefaultFstab(&fstab)) { *err = "failed to read default fstab"; return ""; } auto record = GetEntryForMountPoint(&fstab, "/misc"); if (record == nullptr) { *err = "failed to find /misc partition"; return ""; } return record->blk_device; } // In recovery mode, recovery can get started and try to access the misc // device before the kernel has actually created it. static bool wait_for_device(const std::string& blk_device, std::string* err) { int tries = 0; int ret; err->clear(); do { ++tries; struct stat buf; ret = stat(blk_device.c_str(), &buf); if (ret == -1) { *err += android::base::StringPrintf("failed to stat %s try %d: %s\n", blk_device.c_str(), tries, strerror(errno)); sleep(1); } } while (ret && tries < 10); if (ret) { *err += android::base::StringPrintf("failed to stat %s\n", blk_device.c_str()); } return ret == 0; } static bool read_misc_partition(void* p, size_t size, const std::string& misc_blk_device, size_t offset, std::string* err) { if (!wait_for_device(misc_blk_device, err)) { return false; } android::base::unique_fd fd(open(misc_blk_device.c_str(), O_RDONLY)); if (fd == -1) { *err = android::base::StringPrintf("failed to open %s: %s", misc_blk_device.c_str(), strerror(errno)); return false; } if (lseek(fd, static_cast(offset), SEEK_SET) != static_cast(offset)) { *err = android::base::StringPrintf("failed to lseek %s: %s", misc_blk_device.c_str(), strerror(errno)); return false; } if (!android::base::ReadFully(fd, p, size)) { *err = android::base::StringPrintf("failed to read %s: %s", misc_blk_device.c_str(), strerror(errno)); return false; } return true; } static bool write_misc_partition(const void* p, size_t size, const std::string& misc_blk_device, size_t offset, std::string* err) { android::base::unique_fd fd(open(misc_blk_device.c_str(), O_WRONLY)); if (fd == -1) { *err = android::base::StringPrintf("failed to open %s: %s", misc_blk_device.c_str(), strerror(errno)); return false; } if (lseek(fd, static_cast(offset), SEEK_SET) != static_cast(offset)) { *err = android::base::StringPrintf("failed to lseek %s: %s", misc_blk_device.c_str(), strerror(errno)); return false; } if (!android::base::WriteFully(fd, p, size)) { *err = android::base::StringPrintf("failed to write %s: %s", misc_blk_device.c_str(), strerror(errno)); return false; } if (fsync(fd) == -1) { *err = android::base::StringPrintf("failed to fsync %s: %s", misc_blk_device.c_str(), strerror(errno)); return false; } return true; } std::string get_bootloader_message_blk_device(std::string* err) { std::string misc_blk_device = get_misc_blk_device(err); if (misc_blk_device.empty()) return ""; if (!wait_for_device(misc_blk_device, err)) return ""; return misc_blk_device; } bool read_bootloader_message_from(bootloader_message* boot, const std::string& misc_blk_device, std::string* err) { return read_misc_partition(boot, sizeof(*boot), misc_blk_device, BOOTLOADER_MESSAGE_OFFSET_IN_MISC, err); } bool read_bootloader_message(bootloader_message* boot, std::string* err) { std::string misc_blk_device = get_misc_blk_device(err); if (misc_blk_device.empty()) { return false; } return read_bootloader_message_from(boot, misc_blk_device, err); } bool read_bootloader_control_from(bootloader_control* boot_ctrl, const std::string& misc_blk_device, std::string* err) { return read_misc_partition(boot_ctrl, sizeof(bootloader_control), misc_blk_device, kBootloaderControlOffset, err); } bool write_bootloader_message_to(const bootloader_message& boot, const std::string& misc_blk_device, std::string* err) { return write_misc_partition(&boot, sizeof(boot), misc_blk_device, BOOTLOADER_MESSAGE_OFFSET_IN_MISC, err); } bool write_bootloader_message(const bootloader_message& boot, std::string* err) { std::string misc_blk_device = get_misc_blk_device(err); if (misc_blk_device.empty()) { return false; } return write_bootloader_message_to(boot, misc_blk_device, err); } bool write_bootloader_control_to(const bootloader_control* boot_ctrl, const std::string& misc_blk_device, std::string* err) { return write_misc_partition(boot_ctrl, sizeof(bootloader_control), misc_blk_device, kBootloaderControlOffset, err); } bool clear_bootloader_message(std::string* err) { bootloader_message boot = {}; return write_bootloader_message(boot, err); } bool write_bootloader_message(const std::vector& options, std::string* err) { bootloader_message boot = {}; update_bootloader_message_in_struct(&boot, options); return write_bootloader_message(boot, err); } bool update_bootloader_message(const std::vector& options, std::string* err) { bootloader_message boot; if (!read_bootloader_message(&boot, err)) { return false; } update_bootloader_message_in_struct(&boot, options); return write_bootloader_message(boot, err); } bool update_bootloader_message_in_struct(bootloader_message* boot, const std::vector& options) { if (!boot) return false; // Replace the command & recovery fields. memset(boot->command, 0, sizeof(boot->command)); memset(boot->recovery, 0, sizeof(boot->recovery)); strlcpy(boot->command, "boot-recovery", sizeof(boot->command)); strlcpy(boot->recovery, "recovery\n", sizeof(boot->recovery)); for (const auto& s : options) { strlcat(boot->recovery, s.c_str(), sizeof(boot->recovery)); if (s.back() != '\n') { strlcat(boot->recovery, "\n", sizeof(boot->recovery)); } } return true; } bool write_reboot_bootloader(std::string* err) { bootloader_message boot; if (!read_bootloader_message(&boot, err)) { return false; } if (boot.command[0] != '\0') { *err = "Bootloader command pending."; return false; } strlcpy(boot.command, "bootonce-bootloader", sizeof(boot.command)); return write_bootloader_message(boot, err); } bool read_wipe_package(std::string* package_data, size_t size, std::string* err) { std::string misc_blk_device = get_misc_blk_device(err); if (misc_blk_device.empty()) { return false; } package_data->resize(size); return read_misc_partition(&(*package_data)[0], size, misc_blk_device, WIPE_PACKAGE_OFFSET_IN_MISC, err); } bool write_wipe_package(const std::string& package_data, std::string* err) { std::string misc_blk_device = get_misc_blk_device(err); if (misc_blk_device.empty()) { return false; } return write_misc_partition(package_data.data(), package_data.size(), misc_blk_device, WIPE_PACKAGE_OFFSET_IN_MISC, err); } extern "C" bool write_reboot_bootloader(void) { std::string err; return write_reboot_bootloader(&err); } extern "C" bool write_bootloader_message(const char* options) { std::string err; return write_bootloader_message({options}, &err); }