| /* | |
| * Copyright (C) 2008 The Android Open Source Project | |
| * All rights reserved. | |
| * | |
| * Redistribution and use in source and binary forms, with or without | |
| * modification, are permitted provided that the following conditions | |
| * are met: | |
| * * Redistributions of source code must retain the above copyright | |
| * notice, this list of conditions and the following disclaimer. | |
| * * Redistributions in binary form must reproduce the above copyright | |
| * notice, this list of conditions and the following disclaimer in | |
| * the documentation and/or other materials provided with the | |
| * distribution. | |
| * | |
| * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS | |
| * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT | |
| * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS | |
| * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE | |
| * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, | |
| * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, | |
| * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS | |
| * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED | |
| * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, | |
| * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT | |
| * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF | |
| * SUCH DAMAGE. | |
| */ | |
| #include "fastboot.h" | |
| #include <errno.h> | |
| #include <stdarg.h> | |
| #include <stdio.h> | |
| #include <stdlib.h> | |
| #include <string.h> | |
| #include <sys/stat.h> | |
| #include <sys/types.h> | |
| #include <unistd.h> | |
| #include <memory> | |
| #include <vector> | |
| #include <android-base/stringprintf.h> | |
| enum Op { | |
| OP_DOWNLOAD, | |
| OP_COMMAND, | |
| OP_QUERY, | |
| OP_NOTICE, | |
| OP_DOWNLOAD_SPARSE, | |
| OP_WAIT_FOR_DISCONNECT, | |
| OP_DOWNLOAD_FD, | |
| OP_UPLOAD, | |
| }; | |
| struct Action { | |
| Action(Op op, const std::string& cmd) : op(op), cmd(cmd) {} | |
| Op op; | |
| std::string cmd; | |
| std::string msg; | |
| std::string product; | |
| void* data = nullptr; | |
| // The protocol only supports 32-bit sizes, so you'll have to break | |
| // anything larger into multiple chunks. | |
| uint32_t size = 0; | |
| int fd = -1; | |
| int (*func)(Action& a, int status, const char* resp) = nullptr; | |
| double start = -1; | |
| }; | |
| static std::vector<std::unique_ptr<Action>> action_list; | |
| bool fb_getvar(Transport* transport, const std::string& key, std::string* value) { | |
| std::string cmd = "getvar:" + key; | |
| char buf[FB_RESPONSE_SZ + 1]; | |
| memset(buf, 0, sizeof(buf)); | |
| if (fb_command_response(transport, cmd, buf)) { | |
| return false; | |
| } | |
| *value = buf; | |
| return true; | |
| } | |
| static int cb_default(Action& a, int status, const char* resp) { | |
| if (status) { | |
| fprintf(stderr,"FAILED (%s)\n", resp); | |
| } else { | |
| double split = now(); | |
| fprintf(stderr, "OKAY [%7.3fs]\n", (split - a.start)); | |
| a.start = split; | |
| } | |
| return status; | |
| } | |
| static Action& queue_action(Op op, const std::string& cmd) { | |
| std::unique_ptr<Action> a{new Action(op, cmd)}; | |
| a->func = cb_default; | |
| action_list.push_back(std::move(a)); | |
| return *action_list.back(); | |
| } | |
| void fb_set_active(const std::string& slot) { | |
| Action& a = queue_action(OP_COMMAND, "set_active:" + slot); | |
| a.msg = "Setting current slot to '" + slot + "'..."; | |
| } | |
| void fb_queue_erase(const std::string& partition) { | |
| Action& a = queue_action(OP_COMMAND, "erase:" + partition); | |
| a.msg = "Erasing '" + partition + "'..."; | |
| } | |
| void fb_queue_flash_fd(const std::string& partition, int fd, uint32_t sz) { | |
| Action& a = queue_action(OP_DOWNLOAD_FD, ""); | |
| a.fd = fd; | |
| a.size = sz; | |
| a.msg = android::base::StringPrintf("Sending '%s' (%d KB)...", partition.c_str(), sz / 1024); | |
| Action& b = queue_action(OP_COMMAND, "flash:" + partition); | |
| b.msg = "Writing '" + partition + "'..."; | |
| } | |
| void fb_queue_flash(const std::string& partition, void* data, uint32_t sz) { | |
| Action& a = queue_action(OP_DOWNLOAD, ""); | |
| a.data = data; | |
| a.size = sz; | |
| a.msg = android::base::StringPrintf("Sending '%s' (%d KB)...", partition.c_str(), sz / 1024); | |
| Action& b = queue_action(OP_COMMAND, "flash:" + partition); | |
| b.msg = "Writing '" + partition + "'..."; | |
| } | |
| void fb_queue_flash_sparse(const std::string& partition, struct sparse_file* s, uint32_t sz, | |
| size_t current, size_t total) { | |
| Action& a = queue_action(OP_DOWNLOAD_SPARSE, ""); | |
| a.data = s; | |
| a.size = 0; | |
| a.msg = android::base::StringPrintf("Sending sparse '%s' %zu/%zu (%d KB)...", partition.c_str(), | |
| current, total, sz / 1024); | |
| Action& b = queue_action(OP_COMMAND, "flash:" + partition); | |
| b.msg = | |
| android::base::StringPrintf("Writing '%s' %zu/%zu...", partition.c_str(), current, total); | |
| } | |
| static int match(const char* str, const char** value, unsigned count) { | |
| unsigned n; | |
| for (n = 0; n < count; n++) { | |
| const char *val = value[n]; | |
| int len = strlen(val); | |
| int match; | |
| if ((len > 1) && (val[len-1] == '*')) { | |
| len--; | |
| match = !strncmp(val, str, len); | |
| } else { | |
| match = !strcmp(val, str); | |
| } | |
| if (match) return 1; | |
| } | |
| return 0; | |
| } | |
| static int cb_check(Action& a, int status, const char* resp, int invert) { | |
| const char** value = reinterpret_cast<const char**>(a.data); | |
| unsigned count = a.size; | |
| unsigned n; | |
| if (status) { | |
| fprintf(stderr,"FAILED (%s)\n", resp); | |
| return status; | |
| } | |
| if (!a.product.empty()) { | |
| if (a.product != cur_product) { | |
| double split = now(); | |
| fprintf(stderr, "IGNORE, product is %s required only for %s [%7.3fs]\n", cur_product, | |
| a.product.c_str(), (split - a.start)); | |
| a.start = split; | |
| return 0; | |
| } | |
| } | |
| int yes = match(resp, value, count); | |
| if (invert) yes = !yes; | |
| if (yes) { | |
| double split = now(); | |
| fprintf(stderr, "OKAY [%7.3fs]\n", (split - a.start)); | |
| a.start = split; | |
| return 0; | |
| } | |
| fprintf(stderr, "FAILED\n\n"); | |
| fprintf(stderr, "Device %s is '%s'.\n", a.cmd.c_str() + 7, resp); | |
| fprintf(stderr, "Update %s '%s'", invert ? "rejects" : "requires", value[0]); | |
| for (n = 1; n < count; n++) { | |
| fprintf(stderr, " or '%s'", value[n]); | |
| } | |
| fprintf(stderr, ".\n\n"); | |
| return -1; | |
| } | |
| static int cb_require(Action& a, int status, const char* resp) { | |
| return cb_check(a, status, resp, 0); | |
| } | |
| static int cb_reject(Action& a, int status, const char* resp) { | |
| return cb_check(a, status, resp, 1); | |
| } | |
| void fb_queue_require(const std::string& product, const std::string& var, bool invert, | |
| size_t nvalues, const char** values) { | |
| Action& a = queue_action(OP_QUERY, "getvar:" + var); | |
| a.product = product; | |
| a.data = values; | |
| a.size = nvalues; | |
| a.msg = "Checking " + var; | |
| a.func = invert ? cb_reject : cb_require; | |
| if (a.data == nullptr) die("out of memory"); | |
| } | |
| static int cb_display(Action& a, int status, const char* resp) { | |
| if (status) { | |
| fprintf(stderr, "%s FAILED (%s)\n", a.cmd.c_str(), resp); | |
| return status; | |
| } | |
| fprintf(stderr, "%s: %s\n", static_cast<const char*>(a.data), resp); | |
| free(static_cast<char*>(a.data)); | |
| return 0; | |
| } | |
| void fb_queue_display(const std::string& label, const std::string& var) { | |
| Action& a = queue_action(OP_QUERY, "getvar:" + var); | |
| a.data = xstrdup(label.c_str()); | |
| a.func = cb_display; | |
| } | |
| static int cb_save(Action& a, int status, const char* resp) { | |
| if (status) { | |
| fprintf(stderr, "%s FAILED (%s)\n", a.cmd.c_str(), resp); | |
| return status; | |
| } | |
| strncpy(reinterpret_cast<char*>(a.data), resp, a.size); | |
| return 0; | |
| } | |
| void fb_queue_query_save(const std::string& var, char* dest, uint32_t dest_size) { | |
| Action& a = queue_action(OP_QUERY, "getvar:" + var); | |
| a.data = dest; | |
| a.size = dest_size; | |
| a.func = cb_save; | |
| } | |
| static int cb_do_nothing(Action&, int, const char*) { | |
| fprintf(stderr, "\n"); | |
| return 0; | |
| } | |
| void fb_queue_reboot() { | |
| Action& a = queue_action(OP_COMMAND, "reboot"); | |
| a.func = cb_do_nothing; | |
| a.msg = "Rebooting..."; | |
| } | |
| void fb_queue_command(const std::string& cmd, const std::string& msg) { | |
| Action& a = queue_action(OP_COMMAND, cmd); | |
| a.msg = msg; | |
| } | |
| void fb_queue_download(const std::string& name, void* data, uint32_t size) { | |
| Action& a = queue_action(OP_DOWNLOAD, ""); | |
| a.data = data; | |
| a.size = size; | |
| a.msg = "Downloading '" + name + "'"; | |
| } | |
| void fb_queue_download_fd(const std::string& name, int fd, uint32_t sz) { | |
| Action& a = queue_action(OP_DOWNLOAD_FD, ""); | |
| a.fd = fd; | |
| a.size = sz; | |
| a.msg = android::base::StringPrintf("Sending '%s' (%d KB)", name.c_str(), sz / 1024); | |
| } | |
| void fb_queue_upload(const std::string& outfile) { | |
| Action& a = queue_action(OP_UPLOAD, ""); | |
| a.data = xstrdup(outfile.c_str()); | |
| a.msg = "Uploading '" + outfile + "'"; | |
| } | |
| void fb_queue_notice(const std::string& notice) { | |
| Action& a = queue_action(OP_NOTICE, ""); | |
| a.msg = notice; | |
| } | |
| void fb_queue_wait_for_disconnect() { | |
| queue_action(OP_WAIT_FOR_DISCONNECT, ""); | |
| } | |
| int64_t fb_execute_queue(Transport* transport) { | |
| int64_t status = 0; | |
| for (auto& a : action_list) { | |
| a->start = now(); | |
| if (!a->msg.empty()) { | |
| fprintf(stderr, "%s\n", a->msg.c_str()); | |
| } | |
| if (a->op == OP_DOWNLOAD) { | |
| status = fb_download_data(transport, a->data, a->size); | |
| status = a->func(*a, status, status ? fb_get_error().c_str() : ""); | |
| if (status) break; | |
| } else if (a->op == OP_DOWNLOAD_FD) { | |
| status = fb_download_data_fd(transport, a->fd, a->size); | |
| status = a->func(*a, status, status ? fb_get_error().c_str() : ""); | |
| if (status) break; | |
| } else if (a->op == OP_COMMAND) { | |
| status = fb_command(transport, a->cmd); | |
| status = a->func(*a, status, status ? fb_get_error().c_str() : ""); | |
| if (status) break; | |
| } else if (a->op == OP_QUERY) { | |
| char resp[FB_RESPONSE_SZ + 1] = {}; | |
| status = fb_command_response(transport, a->cmd, resp); | |
| status = a->func(*a, status, status ? fb_get_error().c_str() : resp); | |
| if (status) break; | |
| } else if (a->op == OP_NOTICE) { | |
| // We already showed the notice because it's in `Action::msg`. | |
| } else if (a->op == OP_DOWNLOAD_SPARSE) { | |
| status = fb_download_data_sparse(transport, reinterpret_cast<sparse_file*>(a->data)); | |
| status = a->func(*a, status, status ? fb_get_error().c_str() : ""); | |
| if (status) break; | |
| } else if (a->op == OP_WAIT_FOR_DISCONNECT) { | |
| transport->WaitForDisconnect(); | |
| } else if (a->op == OP_UPLOAD) { | |
| status = fb_upload_data(transport, reinterpret_cast<char*>(a->data)); | |
| status = a->func(*a, status, status ? fb_get_error().c_str() : ""); | |
| } else { | |
| die("unknown action: %d", a->op); | |
| } | |
| } | |
| action_list.clear(); | |
| return status; | |
| } |