| /* |
| * (C) Copyright 2002 |
| * Detlev Zundel, DENX Software Engineering, dzu@denx.de. |
| * |
| * SPDX-License-Identifier: GPL-2.0+ |
| */ |
| |
| /* |
| * BMP handling routines |
| */ |
| |
| #include <common.h> |
| #include <lcd.h> |
| #include <bmp_layout.h> |
| #include <command.h> |
| #include <asm/byteorder.h> |
| #include <malloc.h> |
| #include <splash.h> |
| #include <video.h> |
| |
| extern int osd_enabled; |
| |
| static int bmp_info(ulong addr); |
| #ifdef OSD_SCALE_ENABLE |
| static int bmp_scale(void); |
| #else |
| static int bmp_scale(ulong src_addr, ulong dst_addr, unsigned int new_width, |
| unsigned new_height); |
| #endif |
| |
| /* |
| * Allocate and decompress a BMP image using gunzip(). |
| * |
| * Returns a pointer to the decompressed image data. This pointer is |
| * aligned to 32-bit-aligned-address + 2. |
| * See doc/README.displaying-bmps for explanation. |
| * |
| * The allocation address is passed to 'alloc_addr' and 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 **alloc_addr) |
| { |
| void *dst; |
| unsigned long len; |
| bmp_image_t *bmp; |
| |
| /* |
| * Decompress bmp image |
| */ |
| len = CONFIG_SYS_VIDEO_LOGO_MAX_SIZE; |
| /* allocate extra 3 bytes for 32-bit-aligned-address + 2 alignment */ |
| dst = malloc(CONFIG_SYS_VIDEO_LOGO_MAX_SIZE + 3); |
| if (dst == NULL) { |
| puts("Error: malloc in gunzip failed!\n"); |
| return NULL; |
| } |
| |
| bmp = dst; |
| |
| /* align to 32-bit-aligned-address + 2 */ |
| bmp = (bmp_image_t *)((((unsigned int)dst + 1) & ~3) + 2); |
| |
| if (gunzip(bmp, 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"); |
| |
| /* |
| * Check for bmp mark 'BM' |
| */ |
| if (!((bmp->header.signature[0] == 'B') && |
| (bmp->header.signature[1] == 'M'))) { |
| free(dst); |
| return NULL; |
| } |
| |
| debug("Gzipped BMP image detected!\n"); |
| |
| *alloc_addr = dst; |
| return bmp; |
| } |
| #else |
| bmp_image_t *gunzip_bmp(unsigned long addr, unsigned long *lenp, |
| void **alloc_addr) |
| { |
| return NULL; |
| } |
| #endif |
| |
| static int do_bmp_info(cmd_tbl_t *cmdtp, int flag, int argc, char *const argv[]) |
| { |
| ulong addr; |
| |
| switch (argc) { |
| case 1: /* use load_addr as default address */ |
| addr = load_addr; |
| break; |
| case 2: /* use argument */ |
| addr = simple_strtoul(argv[1], NULL, 16); |
| break; |
| default: |
| return CMD_RET_USAGE; |
| } |
| |
| return (bmp_info(addr)); |
| } |
| |
| static int do_bmp_display(cmd_tbl_t *cmdtp, int flag, int argc, |
| char *const argv[]) |
| { |
| ulong addr; |
| int x = 0, y = 0; |
| |
| if (!osd_enabled) { |
| printf("osd not enabled\n"); |
| return -1; |
| } |
| splash_get_pos(&x, &y); |
| |
| switch (argc) { |
| case 1: /* use load_addr as default address */ |
| addr = load_addr; |
| break; |
| case 2: /* use argument */ |
| addr = simple_strtoul(argv[1], NULL, 16); |
| x = -1; |
| y = -1; |
| break; |
| case 4: |
| addr = simple_strtoul(argv[1], NULL, 16); |
| x = simple_strtoul(argv[2], NULL, 10); |
| y = simple_strtoul(argv[3], NULL, 10); |
| break; |
| default: |
| return CMD_RET_USAGE; |
| } |
| |
| return (bmp_display(addr, x, y)); |
| } |
| |
| static int do_bmp_scale(cmd_tbl_t *cmdtp, int flag, int argc, |
| char *const argv[]) |
| { |
| if (!osd_enabled) { |
| printf("osd not enabled\n"); |
| return -1; |
| } |
| #ifndef OSD_SCALE_ENABLE |
| ulong src_addr, dst_addr; |
| unsigned width, height; |
| |
| switch (argc) { |
| case 3: |
| src_addr = simple_strtoul(argv[1], NULL, 16); |
| dst_addr = simple_strtoul(argv[2], NULL, 16); |
| width = simple_strtoul(getenv("display_width"), NULL, 0); |
| height = simple_strtoul(getenv("display_height"), NULL, 0); |
| printf("src_addr=0x%x,dst_addr=0x%x,w=%d,h=%d\n", (uint)src_addr, |
| (uint)dst_addr, width, height); |
| break; |
| default: |
| return cmd_usage(cmdtp); |
| break; |
| } |
| return (bmp_scale(src_addr, dst_addr, width, height)); |
| #else |
| return (bmp_scale()); |
| #endif |
| } |
| |
| static cmd_tbl_t cmd_bmp_sub[] = { |
| U_BOOT_CMD_MKENT(info, 3, 0, do_bmp_info, "", ""), |
| U_BOOT_CMD_MKENT(display, 5, 0, do_bmp_display, "", ""), |
| U_BOOT_CMD_MKENT(scale, 4, 0, do_bmp_scale, "", ""), |
| }; |
| |
| #ifdef CONFIG_NEEDS_MANUAL_RELOC |
| void bmp_reloc(void) |
| { |
| fixup_cmdtable(cmd_bmp_sub, ARRAY_SIZE(cmd_bmp_sub)); |
| } |
| #endif |
| |
| /* |
| * Subroutine: do_bmp |
| * |
| * Description: Handler for 'bmp' command.. |
| * |
| * Inputs: argv[1] contains the subcommand |
| * |
| * Return: None |
| * |
| */ |
| static int do_bmp(cmd_tbl_t *cmdtp, int flag, int argc, char *const argv[]) |
| { |
| cmd_tbl_t *c; |
| |
| /* Strip off leading 'bmp' command argument */ |
| argc--; |
| argv++; |
| |
| c = find_cmd_tbl(argv[0], &cmd_bmp_sub[0], ARRAY_SIZE(cmd_bmp_sub)); |
| |
| if (c) |
| return c->cmd(cmdtp, flag, argc, argv); |
| else |
| return CMD_RET_USAGE; |
| } |
| |
| U_BOOT_CMD( |
| bmp, 5, 1, do_bmp, |
| "manipulate BMP image data", |
| "info <imageAddr> - display image info\n" |
| "bmp display <imageAddr> [x y] - display image at x,y\n" |
| "bmp scale [imageAddr scaleAddr] - scale image\n" |
| ); |
| |
| /* |
| * Subroutine: bmp_info |
| * |
| * Description: Show information about bmp file in memory |
| * |
| * Inputs: addr address of the bmp file |
| * |
| * Return: None |
| * |
| */ |
| static int bmp_info(ulong addr) |
| { |
| bmp_image_t *bmp = (bmp_image_t *)addr; |
| void *bmp_alloc_addr = NULL; |
| unsigned long len; |
| |
| if (!((bmp->header.signature[0] == 'B') && |
| (bmp->header.signature[1] == 'M'))) |
| bmp = gunzip_bmp(addr, &len, &bmp_alloc_addr); |
| |
| if (bmp == NULL) { |
| printf("There is no valid bmp file at the given address\n"); |
| 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)); |
| |
| if (bmp_alloc_addr) |
| free(bmp_alloc_addr); |
| |
| return (0); |
| } |
| |
| /* |
| * Subroutine: bmp_display |
| * |
| * Description: Display bmp file located in memory |
| * |
| * Inputs: addr address of the bmp file |
| * |
| * Return: None |
| * |
| */ |
| int bmp_display(ulong addr, int x, int y) |
| { |
| int ret; |
| bmp_image_t *bmp = (bmp_image_t *)addr; |
| void *bmp_alloc_addr = NULL; |
| unsigned long len; |
| |
| if (!((bmp->header.signature[0] == 'B') && |
| (bmp->header.signature[1] == 'M'))) |
| bmp = gunzip_bmp(addr, &len, &bmp_alloc_addr); |
| |
| if (!bmp) { |
| printf("There is no valid bmp file at the given address\n"); |
| return 1; |
| } |
| |
| #if defined(CONFIG_LCD) |
| ret = lcd_display_bitmap((ulong)bmp, x, y); |
| #elif defined(CONFIG_VIDEO) || defined(CONFIG_AML_OSD) |
| ret = video_display_bitmap((unsigned long)bmp, x, y); |
| #else |
| # error bmp_display() requires CONFIG_LCD or CONFIG_VIDEO |
| #endif |
| |
| if (bmp_alloc_addr) |
| free(bmp_alloc_addr); |
| |
| return ret; |
| } |
| |
| #ifdef OSD_SCALE_ENABLE |
| static int bmp_scale(void) |
| { |
| int ret = 0; |
| |
| extern int video_scale_bitmap(void); |
| ret = video_scale_bitmap(); |
| |
| return ret; |
| } |
| #else |
| static int bmp_scale(ulong src_addr, ulong dst_addr, unsigned int new_width, |
| unsigned new_height) |
| { |
| bmp_image_t *bmp = (bmp_image_t *)src_addr; |
| bmp_image_t *bmp_dst = (bmp_image_t *)dst_addr; |
| unsigned long len; |
| void *bmp_alloc_addr = NULL; |
| char *pBuf = (char *)bmp + bmp->header.data_offset; |
| |
| printf("Begin bmp scale ...\n"); |
| if (!((bmp->header.signature[0] == 'B') && |
| (bmp->header.signature[1] == 'M'))) |
| bmp = gunzip_bmp(src_addr, &len, &bmp_alloc_addr); |
| |
| if (!bmp) { |
| printf("There is no valid bmp file at the given address\n"); |
| if (bmp_alloc_addr) |
| free(bmp_alloc_addr); |
| |
| return 1; |
| } |
| |
| memcpy(bmp_dst, bmp, sizeof(bmp_image_t)); |
| bmp_dst->header.width = new_width; |
| bmp_dst->header.height = new_height; |
| char *pBuf_dst = (char *)bmp_dst + bmp_dst->header.data_offset; |
| |
| #if 1//Fast scale |
| int nWidth, nNewWidth, nNewHeight, nNewWidthBit; |
| float m_xscale, m_yscale; |
| int i, j, x, y, oldoffset; |
| char *pNewTmp = NULL; |
| |
| m_xscale = (float)bmp_dst->header.width / (float)bmp->header.width; |
| m_yscale = (float)bmp_dst->header.height / (float)bmp->header.height; |
| nWidth = bmp->header.width; |
| //nHeight = bmp->header.height; |
| nNewHeight = bmp_dst->header.width; |
| nNewWidth = bmp_dst->header.width; |
| nNewWidthBit = (4 - nNewWidth * 3 % 4) % 4 + nNewWidth * 3; |
| |
| for (i = 0; i < nNewHeight; i++) { |
| pNewTmp = pBuf_dst + nNewWidthBit * i; |
| for (j = 0; j < nNewWidth * 3; j += 3) { |
| x = (int)(j / m_xscale); |
| y = (int)(i / m_yscale); |
| oldoffset = (y * nWidth * 3 + x) - (y * nWidth * 3 + x) % |
| 3; //correct positon in 3 byte mode |
| memcpy(pNewTmp + j, pBuf + oldoffset, 3); |
| } |
| } |
| #endif |
| printf("End bmp scale \n"); |
| |
| if (bmp_alloc_addr) |
| free(bmp_alloc_addr); |
| |
| return 0; |
| } |
| #endif |