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