imported Freescale specific U-Boot additions for i.MX28,... release L2.6.31_10.08.01

[karo-tx-uboot.git] / common / cmd_bmp.c

diff --git a/common/cmd_bmp.c b/common/cmd_bmp.c
index ad412c81eb8d39ee893ffa166af533156922eeda..faa10a4145b9658b047f64c4157888ded67e1b36 100755 (executable)
--- a/common/cmd_bmp.c
+++ b/common/cmd_bmp.c
@@ -26,18 +26,73 @@
  */
 
 #include <common.h>
+#include <lcd.h>
 #include <bmp_layout.h>
 #include <command.h>
 #include <asm/byteorder.h>
 #include <malloc.h>
 
-#if (CONFIG_COMMANDS & CFG_CMD_BMP)
-
 static int bmp_info (ulong addr);
 static int bmp_display (ulong addr, int x, int y);
 
 int gunzip(void *, int, unsigned char *, unsigned long *);
 
+/*
+ * Allocate and decompress a BMP image using gunzip().
+ *
+ * Returns a pointer to the decompressed image data. Must be freed by
+ * the caller after use.
+ *
+ * Returns NULL if decompression failed, or if the decompressed data
+ * didn't contain a valid BMP signature.
+ */
+#ifdef CONFIG_VIDEO_BMP_GZIP
+bmp_image_t *gunzip_bmp(unsigned long addr, unsigned long *lenp)
+{
+       void *dst;
+       unsigned long len;
+       bmp_image_t *bmp;
+
+       /*
+        * Decompress bmp image
+        */
+       len = CONFIG_SYS_VIDEO_LOGO_MAX_SIZE;
+       dst = malloc(CONFIG_SYS_VIDEO_LOGO_MAX_SIZE);
+       if (dst == NULL) {
+               puts("Error: malloc in gunzip failed!\n");
+               return NULL;
+       }
+       if (gunzip(dst, CONFIG_SYS_VIDEO_LOGO_MAX_SIZE, (uchar *)addr, &len) != 0) {
+               free(dst);
+               return NULL;
+       }
+       if (len == CONFIG_SYS_VIDEO_LOGO_MAX_SIZE)
+               puts("Image could be truncated"
+                               " (increase CONFIG_SYS_VIDEO_LOGO_MAX_SIZE)!\n");
+
+       bmp = dst;
+
+       /*
+        * Check for bmp mark 'BM'
+        */
+       if (!((bmp->header.signature[0] == 'B') &&
+             (bmp->header.signature[1] == 'M'))) {
+               free(dst);
+               return NULL;
+       }
+
+       puts("Gzipped BMP image detected!\n");
+
+       return bmp;
+}
+#else
+bmp_image_t *gunzip_bmp(unsigned long addr, unsigned long *lenp)
+{
+       return NULL;
+}
+#endif
+
+
 /*
  * Subroutine:  do_bmp
  *
@@ -66,7 +121,7 @@ int do_bmp(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
                y = simple_strtoul(argv[4], NULL, 10);
                break;
        default:
-               printf ("Usage:\n%s\n", cmdtp->usage);
+               cmd_usage(cmdtp);
                return 1;
        }
 
@@ -78,16 +133,16 @@ int do_bmp(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
        } else if (strncmp(argv[1],"display",1) == 0) {
            return (bmp_display(addr, x, y));
        } else {
-               printf ("Usage:\n%s\n", cmdtp->usage);
+               cmd_usage(cmdtp);
                return 1;
        }
 }
 
 U_BOOT_CMD(
        bmp,    5,      1,      do_bmp,
-       "bmp     - manipulate BMP image data\n",
+       "manipulate BMP image data",
        "info <imageAddr>          - display image info\n"
-       "bmp display <imageAddr> [x y] - display image at x,y\n"
+       "bmp display <imageAddr> [x y] - display image at x,y"
 );
 
 /*
@@ -103,63 +158,24 @@ U_BOOT_CMD(
 static int bmp_info(ulong addr)
 {
        bmp_image_t *bmp=(bmp_image_t *)addr;
-#ifdef CONFIG_VIDEO_BMP_GZIP
-       unsigned char *dst = NULL;
-       ulong len;
-#endif /* CONFIG_VIDEO_BMP_GZIP */
+       unsigned long len;
 
        if (!((bmp->header.signature[0]=='B') &&
-             (bmp->header.signature[1]=='M'))) {
+             (bmp->header.signature[1]=='M')))
+               bmp = gunzip_bmp(addr, &len);
 
-#ifdef CONFIG_VIDEO_BMP_GZIP
-               /*
-                * Decompress bmp image
-                */
-               len = CFG_VIDEO_LOGO_MAX_SIZE;
-               dst = malloc(CFG_VIDEO_LOGO_MAX_SIZE);
-               if (dst == NULL) {
-                       printf("Error: malloc in gunzip failed!\n");
-                       return(1);
-               }
-               if (gunzip(dst, CFG_VIDEO_LOGO_MAX_SIZE, (uchar *)addr, &len) != 0) {
-                       printf("There is no valid bmp file at the given address\n");
-                       return(1);
-               }
-               if (len == CFG_VIDEO_LOGO_MAX_SIZE) {
-                       printf("Image could be truncated (increase CFG_VIDEO_LOGO_MAX_SIZE)!\n");
-               }
-
-               /*
-                * Set addr to decompressed image
-                */
-               bmp = (bmp_image_t *)dst;
-
-               /*
-                * Check for bmp mark 'BM'
-                */
-               if (!((bmp->header.signature[0] == 'B') &&
-                     (bmp->header.signature[1] == 'M'))) {
-                       printf("There is no valid bmp file at the given address\n");
-                       free(dst);
-                       return(1);
-               }
-
-               printf("Gzipped BMP image detected!\n");
-#else /* CONFIG_VIDEO_BMP_GZIP */
+       if (bmp == NULL) {
                printf("There is no valid bmp file at the given address\n");
-               return(1);
-#endif /* CONFIG_VIDEO_BMP_GZIP */
+               return 1;
        }
+
        printf("Image size    : %d x %d\n", le32_to_cpu(bmp->header.width),
               le32_to_cpu(bmp->header.height));
        printf("Bits per pixel: %d\n", le16_to_cpu(bmp->header.bit_count));
        printf("Compression   : %d\n", le32_to_cpu(bmp->header.compression));
 
-#ifdef CONFIG_VIDEO_BMP_GZIP
-       if (dst) {
-               free(dst);
-       }
-#endif /* CONFIG_VIDEO_BMP_GZIP */
+       if ((unsigned long)bmp != addr)
+               free(bmp);
 
        return(0);
 }
@@ -176,16 +192,33 @@ static int bmp_info(ulong addr)
  */
 static int bmp_display(ulong addr, int x, int y)
 {
+       int ret;
+       bmp_image_t *bmp = (bmp_image_t *)addr;
+       unsigned long len;
+
+       if (!((bmp->header.signature[0]=='B') &&
+             (bmp->header.signature[1]=='M')))
+               bmp = gunzip_bmp(addr, &len);
+
+       if (!bmp) {
+               printf("There is no valid bmp file at the given address\n");
+               return 1;
+       }
+
 #if defined(CONFIG_LCD)
        extern int lcd_display_bitmap (ulong, int, int);
 
-       return (lcd_display_bitmap (addr, x, y));
+       ret = lcd_display_bitmap ((unsigned long)bmp, x, y);
 #elif defined(CONFIG_VIDEO)
        extern int video_display_bitmap (ulong, int, int);
-       return (video_display_bitmap (addr, x, y));
+
+       ret = video_display_bitmap ((unsigned long)bmp, x, y);
 #else
 # error bmp_display() requires CONFIG_LCD or CONFIG_VIDEO
 #endif
-}
 
-#endif /* (CONFIG_COMMANDS & CFG_CMD_BMP) */
+       if ((unsigned long)bmp != addr)
+               free(bmp);
+
+       return ret;
+}