[Feature]add MT2731_MP2_MR2_SVN388 baseline version
Change-Id: Ief04314834b31e27effab435d3ca8ba33b499059
diff --git a/src/bsp/lk/lib/bio/debug.c b/src/bsp/lk/lib/bio/debug.c
new file mode 100644
index 0000000..f5c5697
--- /dev/null
+++ b/src/bsp/lk/lib/bio/debug.c
@@ -0,0 +1,457 @@
+/*
+ * Copyright (c) 2009-2014 Travis Geiselbrecht
+ *
+ * Permission is hereby granted, free of charge, to any person obtaining
+ * a copy of this software and associated documentation files
+ * (the "Software"), to deal in the Software without restriction,
+ * including without limitation the rights to use, copy, modify, merge,
+ * publish, distribute, sublicense, and/or sell copies of the Software,
+ * and to permit persons to whom the Software is furnished to do so,
+ * subject to the following conditions:
+ *
+ * The above copyright notice and this permission notice shall be
+ * included in all copies or substantial portions of the Software.
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
+ * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.
+ * IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY
+ * CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT,
+ * TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE
+ * SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
+ */
+#include <assert.h>
+#include <debug.h>
+#include <stdio.h>
+#include <stdlib.h>
+#include <string.h>
+#include <err.h>
+#include <lib/console.h>
+#include <lib/bio.h>
+#include <lib/partition.h>
+#include <platform.h>
+#include <kernel/thread.h>
+
+#if WITH_LIB_CKSUM
+#include <lib/cksum.h>
+#endif
+
+#define DMA_ALIGNMENT (CACHE_LINE)
+#define THREE_BYTE_ADDR_BOUNDARY (16777216)
+#define SUB_ERASE_TEST_SAMPLES (32)
+
+#if defined(WITH_LIB_CONSOLE)
+
+#if LK_DEBUGLEVEL > 0
+static int cmd_bio(int argc, const cmd_args *argv);
+static int bio_test_device(bdev_t* device);
+
+STATIC_COMMAND_START
+STATIC_COMMAND("bio", "block io debug commands", &cmd_bio)
+STATIC_COMMAND_END(bio);
+
+static int cmd_bio(int argc, const cmd_args *argv)
+{
+ int rc = 0;
+
+ if (argc < 2) {
+notenoughargs:
+ printf("not enough arguments:\n");
+usage:
+ printf("%s list\n", argv[0].str);
+ printf("%s read <device> <address> <offset> <len>\n", argv[0].str);
+ printf("%s write <device> <address> <offset> <len>\n", argv[0].str);
+ printf("%s dump <device> <offset> <len>\n", argv[0].str);
+ printf("%s erase <device> <offset> <len>\n", argv[0].str);
+ printf("%s ioctl <device> <request> <arg>\n", argv[0].str);
+ printf("%s remove <device>\n", argv[0].str);
+ printf("%s test <device>\n", argv[0].str);
+#if WITH_LIB_PARTITION
+ printf("%s partscan <device> [offset]\n", argv[0].str);
+#endif
+#if WITH_LIB_CKSUM
+ printf("%s crc32 <device> <offset> <len> [repeat]\n", argv[0].str);
+#endif
+ return -1;
+ }
+
+ if (!strcmp(argv[1].str, "list")) {
+ bio_dump_devices();
+ } else if (!strcmp(argv[1].str, "read")) {
+ if (argc < 6) goto notenoughargs;
+
+ addr_t address = argv[3].u;
+ off_t offset = argv[4].u; // XXX use long
+ size_t len = argv[5].u;
+
+ bdev_t *dev = bio_open(argv[2].str);
+ if (!dev) {
+ printf("error opening block device\n");
+ return -1;
+ }
+
+ lk_time_t t = current_time();
+ ssize_t err = bio_read(dev, (void *)address, offset, len);
+ t = current_time() - t;
+ dprintf(INFO, "bio_read returns %d, took %u msecs (%d bytes/sec)\n", (int)err, (uint)t, (uint32_t)((uint64_t)err * 1000 / t));
+
+ bio_close(dev);
+
+ rc = err;
+ } else if (!strcmp(argv[1].str, "write")) {
+ if (argc < 6) goto notenoughargs;
+
+ addr_t address = argv[3].u;
+ off_t offset = argv[4].u; // XXX use long
+ size_t len = argv[5].u;
+
+ bdev_t *dev = bio_open(argv[2].str);
+ if (!dev) {
+ printf("error opening block device\n");
+ return -1;
+ }
+
+ lk_time_t t = current_time();
+ ssize_t err = bio_write(dev, (void *)address, offset, len);
+ t = current_time() - t;
+ dprintf(INFO, "bio_write returns %d, took %u msecs (%d bytes/sec)\n", (int)err, (uint)t, (uint32_t)((uint64_t)err * 1000 / t));
+
+ bio_close(dev);
+
+ rc = err;
+ } else if (!strcmp(argv[1].str, "dump")) {
+ if (argc < 5) {
+ printf("not enough arguments:\n");
+ goto usage;
+ }
+
+ off_t offset = argv[3].u; // XXX use long
+ size_t len = argv[4].u;
+
+ bdev_t *dev = bio_open(argv[2].str);
+ if (!dev) {
+ printf("error opening block device\n");
+ return -1;
+ }
+
+ uint8_t* buf = memalign(CACHE_LINE, 256);
+ ssize_t err = 0;
+ while (len > 0) {
+ size_t amt = MIN(256, len);
+ ssize_t err = bio_read(dev, buf, offset, amt);
+
+ if (err < 0) {
+ dprintf(ALWAYS, "read error %s %zu@%zu (err %d)\n",
+ argv[2].str, amt, (size_t)offset, (int)err);
+ break;
+ }
+
+ DEBUG_ASSERT((size_t)err <= amt);
+ hexdump8_ex(buf, err, offset);
+
+ if ((size_t)err != amt) {
+ dprintf(ALWAYS, "short read from %s @%zu (wanted %zu, got %zu)\n",
+ argv[2].str, (size_t)offset, amt, (size_t)err);
+ break;
+ }
+
+ offset += amt;
+ len -= amt;
+ }
+
+ bio_close(dev);
+ rc = err;
+ } else if (!strcmp(argv[1].str, "erase")) {
+ if (argc < 5) goto notenoughargs;
+
+ off_t offset = argv[3].u; // XXX use long
+ size_t len = argv[4].u;
+
+ bdev_t *dev = bio_open(argv[2].str);
+ if (!dev) {
+ printf("error opening block device\n");
+ return -1;
+ }
+
+ lk_time_t t = current_time();
+ ssize_t err = bio_erase(dev, offset, len);
+ t = current_time() - t;
+ dprintf(INFO, "bio_erase returns %d, took %u msecs (%d bytes/sec)\n", (int)err, (uint)t, (uint32_t)((uint64_t)err * 1000 / t));
+
+ bio_close(dev);
+
+ rc = err;
+ } else if (!strcmp(argv[1].str, "ioctl")) {
+ if (argc < 4) goto notenoughargs;
+
+ int request = argv[3].u;
+ int arg = (argc == 5) ? argv[4].u : 0;
+
+ bdev_t *dev = bio_open(argv[2].str);
+ if (!dev) {
+ printf("error opening block device\n");
+ return -1;
+ }
+
+ int err = bio_ioctl(dev, request, (void *)(uintptr_t)arg);
+ dprintf(INFO, "bio_ioctl returns %d\n", err);
+
+ bio_close(dev);
+
+ rc = err;
+ } else if (!strcmp(argv[1].str, "remove")) {
+ if (argc < 3) goto notenoughargs;
+
+ bdev_t *dev = bio_open(argv[2].str);
+ if (!dev) {
+ printf("error opening block device\n");
+ return -1;
+ }
+
+ bio_unregister_device(dev);
+ bio_close(dev);
+ } else if (!strcmp(argv[1].str, "test")) {
+ if (argc < 3) goto notenoughargs;
+
+ bdev_t *dev = bio_open(argv[2].str);
+ if (!dev) {
+ printf("error opening block device\n");
+ return -1;
+ }
+
+ int err = bio_test_device(dev);
+ bio_close(dev);
+
+ rc = err;
+#if WITH_LIB_PARTITION
+ } else if (!strcmp(argv[1].str, "partscan")) {
+ if (argc < 3) goto notenoughargs;
+
+ off_t offset = 0;
+ if (argc > 3)
+ offset = argv[3].u;
+
+ rc = partition_publish(argv[2].str, offset);
+ dprintf(INFO, "partition_publish returns %d\n", rc);
+#endif
+#if WITH_LIB_CKSUM
+ } else if (!strcmp(argv[1].str, "crc32")) {
+ if (argc < 5) goto notenoughargs;
+
+ off_t offset = argv[3].u; // XXX use long
+ size_t len = argv[4].u;
+
+ bdev_t *dev = bio_open(argv[2].str);
+ if (!dev) {
+ printf("error opening block device\n");
+ return -1;
+ }
+
+ void *buf = malloc(dev->block_size);
+
+ bool repeat = false;
+ if (argc >= 6 && !strcmp(argv[5].str, "repeat")) {
+ repeat = true;
+ }
+
+ do {
+ ulong crc = 0;
+ off_t pos = offset;
+ while (pos < offset + (off_t)len) {
+ ssize_t err = bio_read(dev, buf, pos, MIN(len - (pos - offset), dev->block_size));
+
+ if (err <= 0) {
+ printf("error reading at offset 0x%llx\n", offset + pos);
+ break;
+ }
+
+ crc = crc32(crc, buf, err);
+
+ pos += err;
+ }
+
+ printf("crc 0x%08lx\n", crc);
+ } while (repeat);
+
+ bio_close(dev);
+ free(buf);
+
+#endif
+ } else {
+ printf("unrecognized subcommand\n");
+ goto usage;
+ }
+
+ return rc;
+}
+
+#endif
+
+#endif
+
+// Returns the number of blocks that do not match the reference pattern.
+static bool is_valid_block(bdev_t *device, bnum_t block_num, uint8_t* pattern,
+ size_t pattern_length)
+{
+ uint8_t *block_contents = memalign(DMA_ALIGNMENT, device->block_size);
+ if (!block_contents) {
+ return false;
+ }
+
+ ssize_t n_bytes = device->read_block(device, block_contents, block_num, 1);
+ if (n_bytes < 0 || n_bytes != (ssize_t)device->block_size) {
+ free(block_contents);
+ return false;
+ }
+
+ for (size_t i = 0; i < device->block_size; i++) {
+ if (block_contents[i] != pattern[i % pattern_length]) {
+ free(block_contents);
+ block_contents = NULL;
+ return false;
+ }
+ }
+
+ free(block_contents);
+ block_contents = NULL;
+
+ return true;
+}
+
+static ssize_t erase_test(bdev_t *device)
+{
+ printf("erasing device...\n");
+
+ ssize_t err = bio_erase(device, 0, device->total_size);
+ if (err < 0) {
+ return err;
+ } else if (err != device->total_size) {
+ return ERR_IO;
+ }
+
+ printf("validating erase...\n");
+ size_t num_invalid_blocks = 0;
+ for (bnum_t bnum = 0; bnum < device->block_count; bnum++) {
+ if (!is_valid_block(device, bnum, &device->erase_byte, sizeof(device->erase_byte))) {
+ num_invalid_blocks++;
+ }
+ }
+ return num_invalid_blocks;
+}
+
+static bool test_erase_block(bdev_t* device, uint32_t block_addr)
+{
+ bool success = false;
+ uint8_t valid_byte[1];
+
+ uint8_t *block_contents = memalign(DMA_ALIGNMENT, device->block_size);
+ if (!block_contents)
+ return success;
+ memset(block_contents, ~(device->erase_byte), device->block_size);
+
+ ssize_t err = bio_write_block(device, block_contents, block_addr, 1);
+ if (err != (ssize_t)device->block_size) {
+ goto finish;
+ }
+
+ valid_byte[0] = ~(device->erase_byte);
+ if (!is_valid_block(device, block_addr, valid_byte, 1)) {
+ goto finish;
+ }
+
+ err = bio_erase(device, block_addr * device->block_size, 1);
+ if (err <= 0) {
+ goto finish;
+ }
+
+ valid_byte[0] = device->erase_byte;
+ if (is_valid_block(device, block_addr, valid_byte, 1)) {
+ success = true;
+ }
+
+finish:
+ free(block_contents);
+ return success;
+}
+
+// Ensure that (sub)sector erase work.
+static bool sub_erase_test(bdev_t* device, uint32_t n_samples)
+{
+ printf("Sampling the device %d times.\n", n_samples);
+ for (uint32_t i = 0; i < n_samples; i++) {
+ bnum_t block_addr = rand() % device->block_count;
+ if (!test_erase_block(device, block_addr)) {
+ return false;
+ }
+ }
+ return true;
+}
+
+static uint8_t get_signature(uint32_t word)
+{
+ uint8_t* sigptr = (uint8_t*)(&word);
+ return sigptr[0] ^ sigptr[1] ^ sigptr[2] ^ sigptr[3];
+}
+
+// returns the number of blocks where the write was not successful.
+static ssize_t write_test(bdev_t *device)
+{
+ uint8_t *test_buffer = memalign(DMA_ALIGNMENT, device->block_size);
+
+ if (!test_buffer)
+ return -1;
+
+ for (bnum_t bnum = 0; bnum < device->block_count; bnum++) {
+ memset(test_buffer, get_signature(bnum), device->block_size);
+ ssize_t err = bio_write_block(device, test_buffer, bnum, 1);
+ if (err < 0) {
+ free(test_buffer);
+ return err;
+ }
+ }
+
+ size_t num_errors = 0;
+ uint8_t expected_pattern[1];
+ for (bnum_t bnum = 0; bnum < device->block_count; bnum++) {
+ expected_pattern[0] = get_signature(bnum);
+ if (!is_valid_block(device, bnum, expected_pattern, sizeof(expected_pattern))) {
+ num_errors++;
+ }
+ }
+
+ free(test_buffer);
+
+ return num_errors;
+}
+
+static int bio_test_device(bdev_t* device)
+{
+ ssize_t num_errors = erase_test(device);
+ if (num_errors < 0) {
+ printf("error %ld performing erase test\n", num_errors);
+ return -1;
+ }
+ printf("discovered %ld error(s) while testing erase.\n", num_errors);
+ if (num_errors) {
+ // No point in continuing the tests if we couldn't erase the device.
+ printf("not continuing to test writes.\n");
+ return -1;
+ }
+
+ num_errors = write_test(device);
+ printf("Discovered %ld error(s) while testing write.\n", num_errors);
+ if (num_errors) {
+ return -1;
+ }
+
+ printf ("Testing sub-erase...\n");
+ bool success = sub_erase_test(device, SUB_ERASE_TEST_SAMPLES);
+ if (!success) {
+ printf("Discovered errors while testing sub-erase.\n");
+ return -1;
+ } else {
+ printf("No errors while testing sub-erase.\n");
+ }
+
+ return 0;
+}