394 lines
8.9 KiB
C
394 lines
8.9 KiB
C
/*
|
|
* (C) Copyright 2002
|
|
* Detlev Zundel, DENX Software Engineering, [email protected].
|
|
*
|
|
* 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 CONFIG_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 *)((((uintptr_t)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 CONFIG_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)
|
|
return 1;
|
|
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 = 0;
|
|
bmp_image_t *bmp = (bmp_image_t *)addr;
|
|
void *bmp_alloc_addr = NULL;
|
|
unsigned long len;
|
|
|
|
if (!bmp)
|
|
return 1;
|
|
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;
|
|
}
|
|
|
|
/*Logo only supports compression of header files as BI_BITFIELDS && RGB565 BMP format*/
|
|
u32 bit_count = le32_to_cpu(bmp->header.bit_count);
|
|
if (bit_count == 16) {
|
|
u32 compression = le32_to_cpu(bmp->header.compression);
|
|
if (compression != BI_BITFIELDS) {
|
|
printf("Error: logo only supports BI_BITFIELDS\n");
|
|
return 1;
|
|
} else {
|
|
u32* colortable = (u32*)(&bmp->color_table);
|
|
if (colortable[0] != 0xf800 &&colortable[1] != 0x7e0 && colortable[2] != 0x1f) {
|
|
printf("Error: logo only supports RGB565 forma\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 CONFIG_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;
|
|
|
|
if (!bmp)
|
|
return 1;
|
|
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
|