Merge branch 'master' of git://git.denx.de/u-boot

[oweals/u-boot.git] / common / spl / spl_ymodem.c

diff --git a/common/spl/spl_ymodem.c b/common/spl/spl_ymodem.c
index 0f1e9970798b830f0d5a51c58c7c1860755732fb..8500ee8ba5d917ee95e93bb6a08e0a47e7869bfe 100644 (file)
--- a/common/spl/spl_ymodem.c
+++ b/common/spl/spl_ymodem.c
@@ -1,3 +1,4 @@
+// SPDX-License-Identifier: GPL-2.0+
 /*
  * (C) Copyright 2000-2004
  * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
@@ -6,54 +7,173 @@
  * Texas Instruments, <www.ti.com>
  *
  * Matt Porter <mporter@ti.com>
- *
- * SPDX-License-Identifier:    GPL-2.0+
  */
 #include <common.h>
+#include <gzip.h>
 #include <spl.h>
 #include <xyzModem.h>
 #include <asm/u-boot.h>
-#include <asm/utils.h>
+#include <linux/libfdt.h>
 
 #define BUF_SIZE 1024
 
+/*
+ * Information required to load image using ymodem.
+ *
+ * @image_read: Now of bytes read from the image.
+ * @buf: pointer to the previous read block.
+ */
+struct ymodem_fit_info {
+       int image_read;
+       char *buf;
+};
+
 static int getcymodem(void) {
        if (tstc())
                return (getc());
        return -1;
 }
 
-void spl_ymodem_load_image(void)
+static ulong ymodem_read_fit(struct spl_load_info *load, ulong offset,
+                            ulong size, void *addr)
+{
+       int res, err, buf_offset;
+       struct ymodem_fit_info *info = load->priv;
+       char *buf = info->buf;
+
+       while (info->image_read < offset) {
+               res = xyzModem_stream_read(buf, BUF_SIZE, &err);
+               if (res <= 0)
+                       break;
+
+               info->image_read += res;
+       }
+
+       if (info->image_read > offset) {
+               res = info->image_read - offset;
+               if (info->image_read % BUF_SIZE)
+                       buf_offset = (info->image_read % BUF_SIZE);
+               else
+                       buf_offset = BUF_SIZE;
+               memcpy(addr, &buf[buf_offset - res], res);
+               addr = addr + res;
+       }
+
+       while (info->image_read < offset + size) {
+               res = xyzModem_stream_read(buf, BUF_SIZE, &err);
+               if (res <= 0)
+                       break;
+
+               memcpy(addr, buf, res);
+               info->image_read += res;
+               addr += res;
+       }
+
+       return size;
+}
+
+int spl_ymodem_load_image(struct spl_image_info *spl_image,
+                         struct spl_boot_device *bootdev)
 {
-       int size = 0;
+       ulong size = 0;
        int err;
        int res;
        int ret;
        connection_info_t info;
        char buf[BUF_SIZE];
-       ulong store_addr = ~0;
+       struct image_header *ih = NULL;
        ulong addr = 0;
 
        info.mode = xyzModem_ymodem;
        ret = xyzModem_stream_open(&info, &err);
+       if (ret) {
+               printf("spl: ymodem err - %s\n", xyzModem_error(err));
+               return ret;
+       }
+
+       res = xyzModem_stream_read(buf, BUF_SIZE, &err);
+       if (res <= 0)
+               goto end_stream;
+
+       if (IS_ENABLED(CONFIG_SPL_LOAD_FIT_FULL) &&
+           image_get_magic((struct image_header *)buf) == FDT_MAGIC) {
+               addr = CONFIG_SYS_LOAD_ADDR;
+               ih = (struct image_header *)addr;
 
-       if (!ret) {
-               while ((res =
-                       xyzModem_stream_read(buf, BUF_SIZE, &err)) > 0) {
-                       if (addr == 0)
-                               spl_parse_image_header((struct image_header *)buf);
-                       store_addr = addr + spl_image.load_addr;
+               memcpy((void *)addr, buf, res);
+               size += res;
+               addr += res;
+
+               while ((res = xyzModem_stream_read(buf, BUF_SIZE, &err)) > 0) {
+                       memcpy((void *)addr, buf, res);
                        size += res;
                        addr += res;
-                       memcpy((char *)(store_addr), buf, res);
                }
+
+               ret = spl_parse_image_header(spl_image, ih);
+               if (ret)
+                       return ret;
+       } else if (IS_ENABLED(CONFIG_SPL_LOAD_FIT) &&
+           image_get_magic((struct image_header *)buf) == FDT_MAGIC) {
+               struct spl_load_info load;
+               struct ymodem_fit_info info;
+
+               debug("Found FIT\n");
+               load.dev = NULL;
+               load.priv = (void *)&info;
+               load.filename = NULL;
+               load.bl_len = 1;
+               info.buf = buf;
+               info.image_read = BUF_SIZE;
+               load.read = ymodem_read_fit;
+               ret = spl_load_simple_fit(spl_image, &load, 0, (void *)buf);
+               size = info.image_read;
+
+               while ((res = xyzModem_stream_read(buf, BUF_SIZE, &err)) > 0)
+                       size += res;
        } else {
-               printf("spl: ymodem err - %s\n", xyzModem_error(err));
-               hang();
+               ih = (struct image_header *)buf;
+               ret = spl_parse_image_header(spl_image, ih);
+               if (ret)
+                       goto end_stream;
+#ifdef CONFIG_SPL_GZIP
+               if (ih->ih_comp == IH_COMP_GZIP)
+                       addr = CONFIG_SYS_LOAD_ADDR;
+               else
+#endif
+                       addr = spl_image->load_addr;
+               memcpy((void *)addr, buf, res);
+               ih = (struct image_header *)addr;
+               size += res;
+               addr += res;
+
+               while ((res = xyzModem_stream_read(buf, BUF_SIZE, &err)) > 0) {
+                       memcpy((void *)addr, buf, res);
+                       size += res;
+                       addr += res;
+               }
        }
 
+end_stream:
        xyzModem_stream_close(&err);
        xyzModem_stream_terminate(false, &getcymodem);
 
-       printf("Loaded %d bytes\n", size);
+       printf("Loaded %lu bytes\n", size);
+
+#ifdef CONFIG_SPL_GZIP
+       if (!(IS_ENABLED(CONFIG_SPL_LOAD_FIT) &&
+             image_get_magic((struct image_header *)buf) == FDT_MAGIC) &&
+           (ih->ih_comp == IH_COMP_GZIP)) {
+               if (gunzip((void *)(spl_image->load_addr + sizeof(*ih)),
+                          CONFIG_SYS_BOOTM_LEN,
+                          (void *)(CONFIG_SYS_LOAD_ADDR + sizeof(*ih)),
+                          &size)) {
+                       puts("Uncompressing error\n");
+                       return -EIO;
+               }
+       }
+#endif
+
+       return ret;
 }
+SPL_LOAD_IMAGE_METHOD("UART", 0, BOOT_DEVICE_UART, spl_ymodem_load_image);