| // SPDX-License-Identifier: BSD-2-Clause |
| /* |
| * Copyright (C) 2016 The Android Open Source Project |
| */ |
| |
| #include <env.h> |
| #include <fastboot.h> |
| #include <fastboot-internal.h> |
| #include <fb_mmc.h> |
| #include <fb_nand.h> |
| #include <fs.h> |
| #include <part.h> |
| #include <version.h> |
| #include <vsprintf.h> |
| #include <linux/printk.h> |
| |
| static void getvar_version(char *var_parameter, char *response); |
| static void getvar_version_bootloader(char *var_parameter, char *response); |
| static void getvar_downloadsize(char *var_parameter, char *response); |
| static void getvar_serialno(char *var_parameter, char *response); |
| static void getvar_version_baseband(char *var_parameter, char *response); |
| static void getvar_product(char *var_parameter, char *response); |
| static void getvar_platform(char *var_parameter, char *response); |
| static void getvar_current_slot(char *var_parameter, char *response); |
| static void getvar_has_slot(char *var_parameter, char *response); |
| static void getvar_partition_type(char *part_name, char *response); |
| static void getvar_partition_size(char *part_name, char *response); |
| static void getvar_is_userspace(char *var_parameter, char *response); |
| |
| static const struct { |
| const char *variable; |
| bool list; |
| void (*dispatch)(char *var_parameter, char *response); |
| } getvar_dispatch[] = { |
| { |
| .variable = "version", |
| .dispatch = getvar_version, |
| .list = true, |
| }, { |
| .variable = "version-bootloader", |
| .dispatch = getvar_version_bootloader, |
| .list = true |
| }, { |
| .variable = "downloadsize", |
| .dispatch = getvar_downloadsize, |
| .list = true |
| }, { |
| .variable = "max-download-size", |
| .dispatch = getvar_downloadsize, |
| .list = true |
| }, { |
| .variable = "serialno", |
| .dispatch = getvar_serialno, |
| .list = true |
| }, { |
| .variable = "version-baseband", |
| .dispatch = getvar_version_baseband, |
| .list = true |
| }, { |
| .variable = "product", |
| .dispatch = getvar_product, |
| .list = true |
| }, { |
| .variable = "platform", |
| .dispatch = getvar_platform, |
| .list = true |
| }, { |
| .variable = "current-slot", |
| .dispatch = getvar_current_slot, |
| .list = true |
| #if IS_ENABLED(CONFIG_FASTBOOT_FLASH) |
| }, { |
| .variable = "has-slot", |
| .dispatch = getvar_has_slot, |
| .list = false |
| #endif |
| #if IS_ENABLED(CONFIG_FASTBOOT_FLASH_MMC) |
| }, { |
| .variable = "partition-type", |
| .dispatch = getvar_partition_type, |
| .list = false |
| #endif |
| #if IS_ENABLED(CONFIG_FASTBOOT_FLASH) |
| }, { |
| .variable = "partition-size", |
| .dispatch = getvar_partition_size, |
| .list = false |
| #endif |
| }, { |
| .variable = "is-userspace", |
| .dispatch = getvar_is_userspace, |
| .list = true |
| } |
| }; |
| |
| /** |
| * Get partition number and size for any storage type. |
| * |
| * Can be used to check if partition with specified name exists. |
| * |
| * If error occurs, this function guarantees to fill @p response with fail |
| * string. @p response can be rewritten in caller, if needed. |
| * |
| * @param[in] part_name Info for which partition name to look for |
| * @param[in,out] response Pointer to fastboot response buffer |
| * @param[out] size If not NULL, will contain partition size |
| * Return: Partition number or negative value on error |
| */ |
| static int getvar_get_part_info(const char *part_name, char *response, |
| size_t *size) |
| { |
| int r; |
| struct blk_desc *dev_desc; |
| struct disk_partition disk_part; |
| struct part_info *part_info; |
| |
| if (IS_ENABLED(CONFIG_FASTBOOT_FLASH_MMC)) { |
| r = fastboot_mmc_get_part_info(part_name, &dev_desc, &disk_part, |
| response); |
| if (r >= 0 && size) |
| *size = disk_part.size * disk_part.blksz; |
| } else if (IS_ENABLED(CONFIG_FASTBOOT_FLASH_NAND)) { |
| r = fastboot_nand_get_part_info(part_name, &part_info, response); |
| if (r >= 0 && size) |
| *size = part_info->size; |
| } else { |
| fastboot_fail("this storage is not supported in bootloader", response); |
| r = -ENODEV; |
| } |
| |
| return r; |
| } |
| |
| static void getvar_version(char *var_parameter, char *response) |
| { |
| fastboot_okay(FASTBOOT_VERSION, response); |
| } |
| |
| static void getvar_version_bootloader(char *var_parameter, char *response) |
| { |
| fastboot_okay(U_BOOT_VERSION, response); |
| } |
| |
| static void getvar_downloadsize(char *var_parameter, char *response) |
| { |
| fastboot_response("OKAY", response, "0x%08x", fastboot_buf_size); |
| } |
| |
| static void getvar_serialno(char *var_parameter, char *response) |
| { |
| const char *tmp = env_get("serial#"); |
| |
| if (tmp) |
| fastboot_okay(tmp, response); |
| else |
| fastboot_fail("Value not set", response); |
| } |
| |
| static void getvar_version_baseband(char *var_parameter, char *response) |
| { |
| fastboot_okay("N/A", response); |
| } |
| |
| static void getvar_product(char *var_parameter, char *response) |
| { |
| const char *board = env_get("board"); |
| |
| if (board) |
| fastboot_okay(board, response); |
| else |
| fastboot_fail("Board not set", response); |
| } |
| |
| static void getvar_platform(char *var_parameter, char *response) |
| { |
| const char *p = env_get("platform"); |
| |
| if (p) |
| fastboot_okay(p, response); |
| else |
| fastboot_fail("platform not set", response); |
| } |
| |
| static void getvar_current_slot(char *var_parameter, char *response) |
| { |
| /* A/B not implemented, for now always return "a" */ |
| fastboot_okay("a", response); |
| } |
| |
| static void __maybe_unused getvar_has_slot(char *part_name, char *response) |
| { |
| char part_name_wslot[PART_NAME_LEN]; |
| size_t len; |
| int r; |
| |
| if (!part_name || part_name[0] == '\0') |
| goto fail; |
| |
| /* part_name_wslot = part_name + "_a" */ |
| len = strlcpy(part_name_wslot, part_name, PART_NAME_LEN - 3); |
| if (len >= PART_NAME_LEN - 3) |
| goto fail; |
| strcat(part_name_wslot, "_a"); |
| |
| r = getvar_get_part_info(part_name_wslot, response, NULL); |
| if (r >= 0) { |
| fastboot_okay("yes", response); /* part exists and slotted */ |
| return; |
| } |
| |
| r = getvar_get_part_info(part_name, response, NULL); |
| if (r >= 0) |
| fastboot_okay("no", response); /* part exists but not slotted */ |
| |
| /* At this point response is filled with okay or fail string */ |
| return; |
| |
| fail: |
| fastboot_fail("invalid partition name", response); |
| } |
| |
| static void __maybe_unused getvar_partition_type(char *part_name, char *response) |
| { |
| int r; |
| struct blk_desc *dev_desc; |
| struct disk_partition part_info; |
| |
| r = fastboot_mmc_get_part_info(part_name, &dev_desc, &part_info, |
| response); |
| if (r >= 0) { |
| r = fs_set_blk_dev_with_part(dev_desc, r); |
| if (r < 0) |
| fastboot_fail("failed to set partition", response); |
| else |
| fastboot_okay(fs_get_type_name(), response); |
| } |
| } |
| |
| static void __maybe_unused getvar_partition_size(char *part_name, char *response) |
| { |
| int r; |
| size_t size; |
| |
| r = getvar_get_part_info(part_name, response, &size); |
| if (r >= 0) |
| fastboot_response("OKAY", response, "0x%016zx", size); |
| } |
| |
| static void getvar_is_userspace(char *var_parameter, char *response) |
| { |
| fastboot_okay("no", response); |
| } |
| |
| static int current_all_dispatch; |
| void fastboot_getvar_all(char *response) |
| { |
| /* |
| * Find a dispatch getvar that can be listed and send |
| * it as INFO until we reach the end. |
| */ |
| while (current_all_dispatch < ARRAY_SIZE(getvar_dispatch)) { |
| if (!getvar_dispatch[current_all_dispatch].list) { |
| current_all_dispatch++; |
| continue; |
| } |
| |
| char envstr[FASTBOOT_RESPONSE_LEN] = { 0 }; |
| |
| getvar_dispatch[current_all_dispatch].dispatch(NULL, envstr); |
| |
| char *envstr_start = envstr; |
| |
| if (!strncmp("OKAY", envstr, 4) || !strncmp("FAIL", envstr, 4)) |
| envstr_start += 4; |
| |
| fastboot_response("INFO", response, "%s: %s", |
| getvar_dispatch[current_all_dispatch].variable, |
| envstr_start); |
| |
| current_all_dispatch++; |
| return; |
| } |
| |
| fastboot_response("OKAY", response, NULL); |
| current_all_dispatch = 0; |
| } |
| |
| /** |
| * fastboot_getvar() - Writes variable indicated by cmd_parameter to response. |
| * |
| * @cmd_parameter: Pointer to command parameter |
| * @response: Pointer to fastboot response buffer |
| * |
| * Look up cmd_parameter first as an environment variable of the form |
| * fastboot.<cmd_parameter>, if that exists return use its value to set |
| * response. |
| * |
| * Otherwise lookup the name of variable and execute the appropriate |
| * function to return the requested value. |
| */ |
| void fastboot_getvar(char *cmd_parameter, char *response) |
| { |
| if (!cmd_parameter) { |
| fastboot_fail("missing var", response); |
| } else if (!strncmp("all", cmd_parameter, 3) && strlen(cmd_parameter) == 3) { |
| current_all_dispatch = 0; |
| fastboot_response(FASTBOOT_MULTIRESPONSE_START, response, NULL); |
| } else { |
| #define FASTBOOT_ENV_PREFIX "fastboot." |
| int i; |
| char *var_parameter = cmd_parameter; |
| char envstr[FASTBOOT_RESPONSE_LEN]; |
| const char *s; |
| |
| snprintf(envstr, sizeof(envstr) - 1, |
| FASTBOOT_ENV_PREFIX "%s", cmd_parameter); |
| s = env_get(envstr); |
| if (s) { |
| fastboot_response("OKAY", response, "%s", s); |
| return; |
| } |
| |
| strsep(&var_parameter, ":"); |
| for (i = 0; i < ARRAY_SIZE(getvar_dispatch); ++i) { |
| if (!strcmp(getvar_dispatch[i].variable, |
| cmd_parameter)) { |
| getvar_dispatch[i].dispatch(var_parameter, |
| response); |
| return; |
| } |
| } |
| pr_warn("WARNING: unknown variable: %s\n", cmd_parameter); |
| fastboot_fail("Variable not implemented", response); |
| } |
| } |