Merge branch '2022-08-04-Kconfig-migrations'
[platform/kernel/u-boot.git] / drivers / fastboot / fb_mmc.c
index d7cf9f4..033c510 100644 (file)
@@ -11,6 +11,8 @@
 #include <fastboot-internal.h>
 #include <fb_mmc.h>
 #include <image-sparse.h>
+#include <image.h>
+#include <log.h>
 #include <part.h>
 #include <mmc.h>
 #include <div64.h>
@@ -25,28 +27,96 @@ struct fb_mmc_sparse {
        struct blk_desc *dev_desc;
 };
 
-static int part_get_info_by_name_or_alias(struct blk_desc *dev_desc,
-               const char *name, disk_partition_t *info)
+static int raw_part_get_info_by_name(struct blk_desc *dev_desc,
+                                    const char *name,
+                                    struct disk_partition *info)
+{
+       /* strlen("fastboot_raw_partition_") + PART_NAME_LEN + 1 */
+       char env_desc_name[23 + PART_NAME_LEN + 1];
+       char *raw_part_desc;
+       const char *argv[2];
+       const char **parg = argv;
+
+       /* check for raw partition descriptor */
+       strcpy(env_desc_name, "fastboot_raw_partition_");
+       strlcat(env_desc_name, name, sizeof(env_desc_name));
+       raw_part_desc = strdup(env_get(env_desc_name));
+       if (raw_part_desc == NULL)
+               return -ENODEV;
+
+       /*
+        * parse partition descriptor
+        *
+        * <lba_start> <lba_size> [mmcpart <num>]
+        */
+       for (; parg < argv + sizeof(argv) / sizeof(*argv); ++parg) {
+               *parg = strsep(&raw_part_desc, " ");
+               if (*parg == NULL) {
+                       pr_err("Invalid number of arguments.\n");
+                       return -ENODEV;
+               }
+       }
+
+       info->start = simple_strtoul(argv[0], NULL, 0);
+       info->size = simple_strtoul(argv[1], NULL, 0);
+       info->blksz = dev_desc->blksz;
+       strlcpy((char *)info->name, name, PART_NAME_LEN);
+
+       if (raw_part_desc) {
+               if (strcmp(strsep(&raw_part_desc, " "), "mmcpart") == 0) {
+                       ulong mmcpart = simple_strtoul(raw_part_desc, NULL, 0);
+                       int ret = blk_dselect_hwpart(dev_desc, mmcpart);
+
+                       if (ret)
+                               return ret;
+               }
+       }
+
+       return 0;
+}
+
+static int do_get_part_info(struct blk_desc **dev_desc, const char *name,
+                           struct disk_partition *info)
 {
        int ret;
 
-       ret = part_get_info_by_name(dev_desc, name, info);
-       if (ret < 0) {
-               /* strlen("fastboot_partition_alias_") + PART_NAME_LEN + 1 */
-               char env_alias_name[25 + PART_NAME_LEN + 1];
-               char *aliased_part_name;
-
-               /* check for alias */
-               strcpy(env_alias_name, "fastboot_partition_alias_");
-               strncat(env_alias_name, name, PART_NAME_LEN);
-               aliased_part_name = env_get(env_alias_name);
-               if (aliased_part_name != NULL)
-                       ret = part_get_info_by_name(dev_desc,
-                                       aliased_part_name, info);
+       /* First try partition names on the default device */
+       *dev_desc = blk_get_dev("mmc", CONFIG_FASTBOOT_FLASH_MMC_DEV);
+       if (*dev_desc) {
+               ret = part_get_info_by_name(*dev_desc, name, info);
+               if (ret >= 0)
+                       return ret;
+
+               /* Then try raw partitions */
+               ret = raw_part_get_info_by_name(*dev_desc, name, info);
+               if (ret >= 0)
+                       return ret;
        }
+
+       /* Then try dev.hwpart:part */
+       ret = part_get_info_by_dev_and_name_or_num("mmc", name, dev_desc,
+                                                  info, true);
        return ret;
 }
 
+static int part_get_info_by_name_or_alias(struct blk_desc **dev_desc,
+                                         const char *name,
+                                         struct disk_partition *info)
+{
+       /* strlen("fastboot_partition_alias_") + PART_NAME_LEN + 1 */
+       char env_alias_name[25 + PART_NAME_LEN + 1];
+       char *aliased_part_name;
+
+       /* check for alias */
+       strlcpy(env_alias_name, "fastboot_partition_alias_", sizeof(env_alias_name));
+       strlcat(env_alias_name, name, sizeof(env_alias_name));
+       aliased_part_name = env_get(env_alias_name);
+       if (aliased_part_name)
+               name = aliased_part_name;
+
+       return do_get_part_info(dev_desc, name, info);
+}
+
 /**
  * fb_mmc_blk_write() - Write/erase MMC in chunks of FASTBOOT_MAX_BLK_WRITE
  *
@@ -97,9 +167,9 @@ static lbaint_t fb_mmc_sparse_reserve(struct sparse_storage *info,
        return blkcnt;
 }
 
-static void write_raw_image(struct blk_desc *dev_desc, disk_partition_t *info,
-               const char *part_name, void *buffer,
-               u32 download_bytes, char *response)
+static void write_raw_image(struct blk_desc *dev_desc,
+                           struct disk_partition *info, const char *part_name,
+                           void *buffer, u32 download_bytes, char *response)
 {
        lbaint_t blkcnt;
        lbaint_t blks;
@@ -129,7 +199,8 @@ static void write_raw_image(struct blk_desc *dev_desc, disk_partition_t *info,
        fastboot_okay(NULL, response);
 }
 
-#ifdef CONFIG_FASTBOOT_MMC_BOOT1_SUPPORT
+#if defined(CONFIG_FASTBOOT_MMC_BOOT_SUPPORT) || \
+       defined(CONFIG_FASTBOOT_MMC_USER_SUPPORT)
 static int fb_mmc_erase_mmc_hwpart(struct blk_desc *dev_desc)
 {
        lbaint_t blks;
@@ -148,16 +219,18 @@ static int fb_mmc_erase_mmc_hwpart(struct blk_desc *dev_desc)
 
        return 0;
 }
+#endif
 
-static void fb_mmc_boot1_ops(struct blk_desc *dev_desc, void *buffer,
-                            u32 buff_sz, char *response)
+#ifdef CONFIG_FASTBOOT_MMC_BOOT_SUPPORT
+static void fb_mmc_boot_ops(struct blk_desc *dev_desc, void *buffer,
+                           int hwpart, u32 buff_sz, char *response)
 {
        lbaint_t blkcnt;
        lbaint_t blks;
        unsigned long blksz;
 
-       // To operate on EMMC_BOOT1 (mmc0boot0), we first change the hwpart
-       if (blk_dselect_hwpart(dev_desc, 1)) {
+       // To operate on EMMC_BOOT1/2 (mmc0boot0/1) we first change the hwpart
+       if (blk_dselect_hwpart(dev_desc, hwpart)) {
                pr_err("Failed to select hwpart\n");
                fastboot_fail("Failed to select hwpart", response);
                return;
@@ -176,21 +249,24 @@ static void fb_mmc_boot1_ops(struct blk_desc *dev_desc, void *buffer,
                        return;
                }
 
-               debug("Start Flashing Image to EMMC_BOOT1...\n");
+               debug("Start Flashing Image to EMMC_BOOT%d...\n", hwpart);
 
                blks = fb_mmc_blk_write(dev_desc, 0, blkcnt, buffer);
 
                if (blks != blkcnt) {
-                       pr_err("Failed to write EMMC_BOOT1\n");
-                       fastboot_fail("Failed to write EMMC_BOOT1", response);
+                       pr_err("Failed to write EMMC_BOOT%d\n", hwpart);
+                       fastboot_fail("Failed to write EMMC_BOOT part",
+                                     response);
                        return;
                }
 
-               printf("........ wrote %lu bytes to EMMC_BOOT1\n",
-                      blkcnt * blksz);
+               printf("........ wrote %lu bytes to EMMC_BOOT%d\n",
+                      blkcnt * blksz, hwpart);
        } else { /* erase */
                if (fb_mmc_erase_mmc_hwpart(dev_desc)) {
-                       fastboot_fail("Failed to erase EMMC_BOOT1", response);
+                       pr_err("Failed to erase EMMC_BOOT%d\n", hwpart);
+                       fastboot_fail("Failed to erase EMMC_BOOT part",
+                                     response);
                        return;
                }
        }
@@ -207,10 +283,10 @@ static void fb_mmc_boot1_ops(struct blk_desc *dev_desc, void *buffer,
  * @param[in] info Boot partition info
  * @param[out] hdr Where to store read boot image header
  *
- * @return Boot image header sectors count or 0 on error
+ * Return: Boot image header sectors count or 0 on error
  */
 static lbaint_t fb_mmc_get_boot_header(struct blk_desc *dev_desc,
-                                      disk_partition_t *info,
+                                      struct disk_partition *info,
                                       struct andr_img_hdr *hdr,
                                       char *response)
 {
@@ -254,7 +330,7 @@ static lbaint_t fb_mmc_get_boot_header(struct blk_desc *dev_desc,
  * @param download_buffer Address to fastboot buffer with zImage in it
  * @param download_bytes Size of fastboot buffer, in bytes
  *
- * @return 0 on success or -1 on error
+ * Return: 0 on success or -1 on error
  */
 static int fb_mmc_update_zimage(struct blk_desc *dev_desc,
                                void *download_buffer,
@@ -270,7 +346,7 @@ static int fb_mmc_update_zimage(struct blk_desc *dev_desc,
        u32 kernel_sector_start;
        u32 kernel_sectors;
        u32 sectors_per_page;
-       disk_partition_t info;
+       struct disk_partition info;
        int res;
 
        puts("Flashing zImage\n");
@@ -366,32 +442,56 @@ static int fb_mmc_update_zimage(struct blk_desc *dev_desc,
  *
  * @part_name: Named partition to lookup
  * @dev_desc: Pointer to returned blk_desc pointer
- * @part_info: Pointer to returned disk_partition_t
+ * @part_info: Pointer to returned struct disk_partition
  * @response: Pointer to fastboot response buffer
  */
 int fastboot_mmc_get_part_info(const char *part_name,
                               struct blk_desc **dev_desc,
-                              disk_partition_t *part_info, char *response)
+                              struct disk_partition *part_info, char *response)
 {
-       int r;
+       int ret;
 
-       *dev_desc = blk_get_dev("mmc", CONFIG_FASTBOOT_FLASH_MMC_DEV);
-       if (!*dev_desc) {
-               fastboot_fail("block device not found", response);
-               return -ENOENT;
-       }
        if (!part_name || !strcmp(part_name, "")) {
                fastboot_fail("partition not given", response);
                return -ENOENT;
        }
 
-       r = part_get_info_by_name_or_alias(*dev_desc, part_name, part_info);
-       if (r < 0) {
-               fastboot_fail("partition not found", response);
-               return r;
+       ret = part_get_info_by_name_or_alias(dev_desc, part_name, part_info);
+       if (ret < 0) {
+               switch (ret) {
+               case -ENOSYS:
+               case -EINVAL:
+                       fastboot_fail("invalid partition or device", response);
+                       break;
+               case -ENODEV:
+                       fastboot_fail("no such device", response);
+                       break;
+               case -ENOENT:
+                       fastboot_fail("no such partition", response);
+                       break;
+               case -EPROTONOSUPPORT:
+                       fastboot_fail("unknown partition table type", response);
+                       break;
+               default:
+                       fastboot_fail("unanticipated error", response);
+                       break;
+               }
        }
 
-       return r;
+       return ret;
+}
+
+static struct blk_desc *fastboot_mmc_get_dev(char *response)
+{
+       struct blk_desc *ret = blk_get_dev("mmc",
+                                          CONFIG_FASTBOOT_FLASH_MMC_DEV);
+
+       if (!ret || ret->type == DEV_TYPE_UNKNOWN) {
+               pr_err("invalid mmc device\n");
+               fastboot_fail("invalid mmc device", response);
+               return NULL;
+       }
+       return ret;
 }
 
 /**
@@ -406,30 +506,31 @@ void fastboot_mmc_flash_write(const char *cmd, void *download_buffer,
                              u32 download_bytes, char *response)
 {
        struct blk_desc *dev_desc;
-       disk_partition_t info;
+       struct disk_partition info = {0};
 
-       dev_desc = blk_get_dev("mmc", CONFIG_FASTBOOT_FLASH_MMC_DEV);
-       if (!dev_desc || dev_desc->type == DEV_TYPE_UNKNOWN) {
-               pr_err("invalid mmc device\n");
-               fastboot_fail("invalid mmc device", response);
+#ifdef CONFIG_FASTBOOT_MMC_BOOT_SUPPORT
+       if (strcmp(cmd, CONFIG_FASTBOOT_MMC_BOOT1_NAME) == 0) {
+               dev_desc = fastboot_mmc_get_dev(response);
+               if (dev_desc)
+                       fb_mmc_boot_ops(dev_desc, download_buffer, 1,
+                                       download_bytes, response);
                return;
        }
-
-#ifdef CONFIG_FASTBOOT_MMC_BOOT1_SUPPORT
-       if (strcmp(cmd, CONFIG_FASTBOOT_MMC_BOOT1_NAME) == 0) {
-               fb_mmc_boot1_ops(dev_desc, download_buffer,
-                                download_bytes, response);
+       if (strcmp(cmd, CONFIG_FASTBOOT_MMC_BOOT2_NAME) == 0) {
+               dev_desc = fastboot_mmc_get_dev(response);
+               if (dev_desc)
+                       fb_mmc_boot_ops(dev_desc, download_buffer, 2,
+                                       download_bytes, response);
                return;
        }
 #endif
 
 #if CONFIG_IS_ENABLED(EFI_PARTITION)
-#ifndef CONFIG_FASTBOOT_MMC_USER_NAME
        if (strcmp(cmd, CONFIG_FASTBOOT_GPT_NAME) == 0) {
-#else
-       if (strcmp(cmd, CONFIG_FASTBOOT_GPT_NAME) == 0 ||
-           strcmp(cmd, CONFIG_FASTBOOT_MMC_USER_NAME) == 0) {
-#endif
+               dev_desc = fastboot_mmc_get_dev(response);
+               if (!dev_desc)
+                       return;
+
                printf("%s: updating MBR, Primary and Backup GPT(s)\n",
                       __func__);
                if (is_valid_gpt_buf(dev_desc, download_buffer)) {
@@ -444,6 +545,7 @@ void fastboot_mmc_flash_write(const char *cmd, void *download_buffer,
                                      response);
                        return;
                }
+               part_init(dev_desc);
                printf("........ success\n");
                fastboot_okay(NULL, response);
                return;
@@ -452,6 +554,10 @@ void fastboot_mmc_flash_write(const char *cmd, void *download_buffer,
 
 #if CONFIG_IS_ENABLED(DOS_PARTITION)
        if (strcmp(cmd, CONFIG_FASTBOOT_MBR_NAME) == 0) {
+               dev_desc = fastboot_mmc_get_dev(response);
+               if (!dev_desc)
+                       return;
+
                printf("%s: updating MBR\n", __func__);
                if (is_valid_dos_buf(download_buffer)) {
                        printf("%s: invalid MBR - refusing to write to flash\n",
@@ -459,12 +565,13 @@ void fastboot_mmc_flash_write(const char *cmd, void *download_buffer,
                        fastboot_fail("invalid MBR partition", response);
                        return;
                }
-               if (write_mbr_partition(dev_desc, download_buffer)) {
+               if (write_mbr_sector(dev_desc, download_buffer)) {
                        printf("%s: writing MBR partition failed\n", __func__);
                        fastboot_fail("writing MBR partition failed",
                                      response);
                        return;
                }
+               part_init(dev_desc);
                printf("........ success\n");
                fastboot_okay(NULL, response);
                return;
@@ -473,17 +580,29 @@ void fastboot_mmc_flash_write(const char *cmd, void *download_buffer,
 
 #ifdef CONFIG_ANDROID_BOOT_IMAGE
        if (strncasecmp(cmd, "zimage", 6) == 0) {
-               fb_mmc_update_zimage(dev_desc, download_buffer,
-                                    download_bytes, response);
+               dev_desc = fastboot_mmc_get_dev(response);
+               if (dev_desc)
+                       fb_mmc_update_zimage(dev_desc, download_buffer,
+                                            download_bytes, response);
                return;
        }
 #endif
 
-       if (part_get_info_by_name_or_alias(dev_desc, cmd, &info) < 0) {
-               pr_err("cannot find partition: '%s'\n", cmd);
-               fastboot_fail("cannot find partition", response);
-               return;
+#if CONFIG_IS_ENABLED(FASTBOOT_MMC_USER_SUPPORT)
+       if (strcmp(cmd, CONFIG_FASTBOOT_MMC_USER_NAME) == 0) {
+               dev_desc = fastboot_mmc_get_dev(response);
+               if (!dev_desc)
+                       return;
+
+               strlcpy((char *)&info.name, cmd, sizeof(info.name));
+               info.size       = dev_desc->lba;
+               info.blksz      = dev_desc->blksz;
        }
+#endif
+
+       if (!info.name[0] &&
+           fastboot_mmc_get_part_info(cmd, &dev_desc, &info, response) < 0)
+               return;
 
        if (is_sparse_image(download_buffer)) {
                struct fb_mmc_sparse sparse_priv;
@@ -521,36 +640,35 @@ void fastboot_mmc_flash_write(const char *cmd, void *download_buffer,
  */
 void fastboot_mmc_erase(const char *cmd, char *response)
 {
-       int ret;
        struct blk_desc *dev_desc;
-       disk_partition_t info;
+       struct disk_partition info;
        lbaint_t blks, blks_start, blks_size, grp_size;
        struct mmc *mmc = find_mmc_device(CONFIG_FASTBOOT_FLASH_MMC_DEV);
 
-       if (mmc == NULL) {
-               pr_err("invalid mmc device\n");
-               fastboot_fail("invalid mmc device", response);
-               return;
-       }
-
-       dev_desc = blk_get_dev("mmc", CONFIG_FASTBOOT_FLASH_MMC_DEV);
-       if (!dev_desc || dev_desc->type == DEV_TYPE_UNKNOWN) {
-               pr_err("invalid mmc device\n");
-               fastboot_fail("invalid mmc device", response);
-               return;
-       }
-
-#ifdef CONFIG_FASTBOOT_MMC_BOOT1_SUPPORT
+#ifdef CONFIG_FASTBOOT_MMC_BOOT_SUPPORT
        if (strcmp(cmd, CONFIG_FASTBOOT_MMC_BOOT1_NAME) == 0) {
                /* erase EMMC boot1 */
-               fb_mmc_boot1_ops(dev_desc, NULL, 0, response);
+               dev_desc = fastboot_mmc_get_dev(response);
+               if (dev_desc)
+                       fb_mmc_boot_ops(dev_desc, NULL, 1, 0, response);
+               return;
+       }
+       if (strcmp(cmd, CONFIG_FASTBOOT_MMC_BOOT2_NAME) == 0) {
+               /* erase EMMC boot2 */
+               dev_desc = fastboot_mmc_get_dev(response);
+               if (dev_desc)
+                       fb_mmc_boot_ops(dev_desc, NULL, 2, 0, response);
                return;
        }
 #endif
 
-#ifdef CONFIG_FASTBOOT_MMC_USER_NAME
+#ifdef CONFIG_FASTBOOT_MMC_USER_SUPPORT
        if (strcmp(cmd, CONFIG_FASTBOOT_MMC_USER_NAME) == 0) {
                /* erase EMMC userdata */
+               dev_desc = fastboot_mmc_get_dev(response);
+               if (!dev_desc)
+                       return;
+
                if (fb_mmc_erase_mmc_hwpart(dev_desc))
                        fastboot_fail("Failed to erase EMMC_USER", response);
                else
@@ -559,12 +677,8 @@ void fastboot_mmc_erase(const char *cmd, char *response)
        }
 #endif
 
-       ret = part_get_info_by_name_or_alias(dev_desc, cmd, &info);
-       if (ret < 0) {
-               pr_err("cannot find partition: '%s'\n", cmd);
-               fastboot_fail("cannot find partition", response);
+       if (fastboot_mmc_get_part_info(cmd, &dev_desc, &info, response) < 0)
                return;
-       }
 
        /* Align blocks to erase group size to avoid erasing other partitions */
        grp_size = mmc->erase_grp_size;