common/spl/spl_blk_fs.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * Copyright (C) 2023
   4  * Ventana Micro Systems Inc.
   5  *
   6  */
   7
   8 #include <common.h>
   9 #include <spl.h>
  10 #include <spl_load.h>
  11 #include <image.h>
  12 #include <fs.h>
  13 #include <asm/cache.h>
  14 #include <asm/io.h>
  15
  16 struct blk_dev {
  17         const char *ifname;
  18         const char *filename;
  19         char dev_part_str[8];
  20 };
  21
  22 static ulong spl_fit_read(struct spl_load_info *load, ulong file_offset,
  23                           ulong size, void *buf)
  24 {
  25         loff_t actlen;
  26         int ret;
  27         struct blk_dev *dev = (struct blk_dev *)load->priv;
  28
  29         ret = fs_set_blk_dev(dev->ifname, dev->dev_part_str, FS_TYPE_ANY);
  30         if (ret) {
  31                 printf("spl: unable to set blk_dev %s %s. Err - %d\n",
  32                        dev->ifname, dev->dev_part_str, ret);
  33                 return ret;
  34         }
  35
  36         ret = fs_read(dev->filename, virt_to_phys(buf), file_offset, size,
  37                       &actlen);
  38         if (ret < 0) {
  39                 printf("spl: error reading image %s. Err - %d\n",
  40                        dev->filename, ret);
  41                 return ret;
  42         }
  43
  44         return actlen;
  45 }
  46
  47 int spl_blk_load_image(struct spl_image_info *spl_image,
  48                        struct spl_boot_device *bootdev,
  49                        enum uclass_id uclass_id, int devnum, int partnum)
  50 {
  51         const char *filename = CONFIG_SPL_FS_LOAD_PAYLOAD_NAME;
  52         struct blk_desc *blk_desc;
  53         loff_t filesize;
  54         struct blk_dev dev;
  55         struct spl_load_info load;
  56         int ret;
  57
  58         blk_desc = blk_get_devnum_by_uclass_id(uclass_id, devnum);
  59         if (!blk_desc) {
  60                 printf("blk desc for %d %d not found\n", uclass_id, devnum);
  61                 return -ENODEV;
  62         }
  63
  64         blk_show_device(uclass_id, devnum);
  65
  66         dev.filename = filename;
  67         dev.ifname = blk_get_uclass_name(uclass_id);
  68         snprintf(dev.dev_part_str, sizeof(dev.dev_part_str) - 1, "%x:%x",
  69                  devnum, partnum);
  70         ret = fs_set_blk_dev(dev.ifname, dev.dev_part_str, FS_TYPE_ANY);
  71         if (ret) {
  72                 printf("spl: unable to set blk_dev %s %s. Err - %d\n",
  73                        dev.ifname, dev.dev_part_str, ret);
  74                 return ret;
  75         }
  76
  77         ret = fs_size(filename, &filesize);
  78         if (ret) {
  79                 printf("spl: unable to get file size: %s. Err - %d\n",
  80                        filename, ret);
  81                 return ret;
  82         }
  83
  84         load.read = spl_fit_read;
  85         if (IS_ENABLED(CONFIG_SPL_FS_FAT_DMA_ALIGN))
  86                 spl_set_bl_len(&load, ARCH_DMA_MINALIGN);
  87         else
  88                 spl_set_bl_len(&load, 1);
  89         load.priv = &dev;
  90         return spl_load(spl_image, bootdev, &load, filesize, 0);
  91 }