| // SPDX-License-Identifier: GPL-2.0-or-later |
| /* |
| * Copyright (c) 2022, Linaro Limited |
| * Copyright (c) 2022, Heinrich Schuchardt <xypron.glpk@gmx.de> |
| */ |
| |
| #include <blk.h> |
| #include <common.h> |
| #include <dm.h> |
| #include <fwu.h> |
| #include <fwu_mdata.h> |
| #include <log.h> |
| #include <malloc.h> |
| #include <memalign.h> |
| #include <part.h> |
| |
| #include <dm/test.h> |
| #include <test/ut.h> |
| |
| #include "fwu_mdata_disk_image.h" |
| |
| /* Block size of compressed disk image */ |
| #define COMPRESSED_DISK_IMAGE_BLOCK_SIZE 8 |
| |
| static struct udevice *mmc_dev; |
| static struct blk_desc *dev_desc; |
| |
| /* One 8 byte block of the compressed disk image */ |
| struct line { |
| size_t addr; |
| char *line; |
| }; |
| |
| /* Compressed disk image */ |
| struct compressed_disk_image { |
| size_t length; |
| struct line lines[]; |
| }; |
| |
| static const struct compressed_disk_image img = FWU_MDATA_DISK_IMG; |
| |
| /* Decompressed disk image */ |
| static u8 *image; |
| |
| static int setup_blk_device(struct unit_test_state *uts) |
| { |
| ut_assertok(uclass_get_device(UCLASS_MMC, 0, &mmc_dev)); |
| ut_assertok(blk_get_device_by_str("mmc", "0", &dev_desc)); |
| |
| return 0; |
| } |
| |
| static int populate_mmc_disk_image(struct unit_test_state *uts) |
| { |
| u8 *buf; |
| size_t i; |
| size_t addr; |
| size_t len; |
| |
| buf = malloc(img.length); |
| if (!buf) |
| return -ENOMEM; |
| |
| memset(buf, 0, img.length); |
| |
| for (i = 0; ; i++) { |
| if (!img.lines[i].line) |
| break; |
| addr = img.lines[i].addr; |
| len = COMPRESSED_DISK_IMAGE_BLOCK_SIZE; |
| if (addr + len > img.length) |
| len = img.length - addr; |
| memcpy(buf + addr, img.lines[i].line, len); |
| } |
| image = buf; |
| |
| return 0; |
| } |
| |
| static int write_mmc_blk_device(struct unit_test_state *uts) |
| { |
| lbaint_t blkcnt; |
| |
| blkcnt = BLOCK_CNT(img.length, dev_desc); |
| |
| ut_asserteq(blkcnt, blk_dwrite(dev_desc, 0, blkcnt, image)); |
| |
| return 0; |
| } |
| |
| static int dm_test_fwu_mdata_read(struct unit_test_state *uts) |
| { |
| struct udevice *dev; |
| struct fwu_mdata mdata = { 0 }; |
| |
| ut_assertok(uclass_first_device_err(UCLASS_FWU_MDATA, &dev)); |
| ut_assertok(setup_blk_device(uts)); |
| ut_assertok(populate_mmc_disk_image(uts)); |
| ut_assertok(write_mmc_blk_device(uts)); |
| |
| ut_assertok(fwu_get_mdata(dev, &mdata)); |
| |
| ut_asserteq(mdata.version, 0x1); |
| |
| return 0; |
| } |
| DM_TEST(dm_test_fwu_mdata_read, UT_TESTF_SCAN_FDT); |
| |
| static int dm_test_fwu_mdata_write(struct unit_test_state *uts) |
| { |
| u32 active_idx; |
| struct udevice *dev; |
| struct fwu_mdata mdata = { 0 }; |
| |
| ut_assertok(setup_blk_device(uts)); |
| ut_assertok(populate_mmc_disk_image(uts)); |
| ut_assertok(write_mmc_blk_device(uts)); |
| |
| ut_assertok(uclass_first_device_err(UCLASS_FWU_MDATA, &dev)); |
| |
| ut_assertok(fwu_get_mdata(dev, &mdata)); |
| |
| active_idx = (mdata.active_index + 1) % CONFIG_FWU_NUM_BANKS; |
| ut_assertok(fwu_set_active_index(active_idx)); |
| |
| ut_assertok(fwu_get_mdata(dev, &mdata)); |
| ut_asserteq(mdata.active_index, active_idx); |
| |
| return 0; |
| } |
| DM_TEST(dm_test_fwu_mdata_write, UT_TESTF_SCAN_FDT); |
| |
| static int dm_test_fwu_mdata_check(struct unit_test_state *uts) |
| { |
| struct udevice *dev; |
| |
| ut_assertok(setup_blk_device(uts)); |
| ut_assertok(populate_mmc_disk_image(uts)); |
| ut_assertok(write_mmc_blk_device(uts)); |
| |
| ut_assertok(uclass_first_device_err(UCLASS_FWU_MDATA, &dev)); |
| |
| ut_assertok(fwu_check_mdata_validity()); |
| |
| return 0; |
| } |
| DM_TEST(dm_test_fwu_mdata_check, UT_TESTF_SCAN_FDT); |