|
@@ -4,83 +4,113 @@
|
|
#include "io.h"
|
|
#include "io.h"
|
|
#include "console.h"
|
|
#include "console.h"
|
|
|
|
|
|
-void die(void)
|
|
|
|
|
|
+#define SDRAM_ADDR 0x40000000
|
|
|
|
+#define SDRAM_ADDR_BITS 25
|
|
|
|
+#define SDRAM_SIZE (1U << SDRAM_ADDR_BITS)
|
|
|
|
+#define SDRAM_MASK (SDRAM_SIZE - 1)
|
|
|
|
+#define SDRAM_END (SDRAM_ADDR + SDRAM_SIZE)
|
|
|
|
+
|
|
|
|
+static unsigned int errors = 0;
|
|
|
|
+static unsigned int rate_limit;
|
|
|
|
+static char err_char;
|
|
|
|
+
|
|
|
|
+static void data_check(volatile uint32_t *p, uint32_t expect)
|
|
{
|
|
{
|
|
- while (1)
|
|
|
|
- ;
|
|
|
|
|
|
+ uint32_t readback = *p;
|
|
|
|
+
|
|
|
|
+ if (readback != expect) {
|
|
|
|
+ if (rate_limit) {
|
|
|
|
+ con_printf("\r%p : read %08x expected %08x\r\n",
|
|
|
|
+ p, readback, expect);
|
|
|
|
+ rate_limit--;
|
|
|
|
+ }
|
|
|
|
+ err_char = 'X';
|
|
|
|
+ errors++;
|
|
|
|
+ }
|
|
}
|
|
}
|
|
|
|
|
|
-#define SDRAM_ADDR 0x40000000
|
|
|
|
-#define SDRAM_SIZE (32 << 20)
|
|
|
|
-
|
|
|
|
-static void write_check(volatile uint32_t *p, uint32_t v)
|
|
|
|
|
|
+static inline void write_check(volatile uint32_t *p, uint32_t v)
|
|
{
|
|
{
|
|
- uint32_t rb;
|
|
|
|
-
|
|
|
|
*p = v;
|
|
*p = v;
|
|
- rb = *p;
|
|
|
|
-
|
|
|
|
- if (v != rb)
|
|
|
|
- con_printf("\r%p : read %08x wrote %08x\r\n", p, rb, v);
|
|
|
|
|
|
+ data_check(p, v);
|
|
}
|
|
}
|
|
|
|
|
|
|
|
+#define ERROR_RATELIMIT 8
|
|
|
|
+
|
|
|
|
+#define SOME_NUMBER 0x78dacecb
|
|
|
|
+
|
|
static void test_sdram(void)
|
|
static void test_sdram(void)
|
|
{
|
|
{
|
|
- uint32_t * const sdram_start = (uint32_t *)SDRAM_ADDR;
|
|
|
|
- uint32_t * const sdram_end = (uint32_t *)(SDRAM_ADDR + SDRAM_SIZE);
|
|
|
|
- volatile uint32_t *p;
|
|
|
|
-
|
|
|
|
- con_printf("Testing SDRAM from %p to %p...\r\n", sdram_start, sdram_end);
|
|
|
|
|
|
+ static unsigned int stride = 4;
|
|
|
|
+ uint32_t start_time = rdtime();
|
|
|
|
+ uint32_t w = 0;
|
|
|
|
+ uint32_t n;
|
|
|
|
|
|
- for (p = sdram_start ; p < sdram_end ; p++) {
|
|
|
|
- uint32_t a = (uint32_t)p;
|
|
|
|
|
|
+
|
|
|
|
+ con_printf("Testing SDRAM from 0x%08x to 0x%08x, stride 0x%08x...\r\n",
|
|
|
|
+ SDRAM_ADDR, SDRAM_END, stride);
|
|
|
|
|
|
- if (!(a & 0xffff))
|
|
|
|
- con_printf("\r%p ", p);
|
|
|
|
|
|
+ n = 0;
|
|
|
|
+ err_char = '-';
|
|
|
|
+ rate_limit = ERROR_RATELIMIT;
|
|
|
|
+ do {
|
|
|
|
+ uint32_t a = w + SDRAM_ADDR;
|
|
|
|
+ volatile uint32_t *p = (volatile uint32_t *)a;
|
|
|
|
|
|
write_check(p, 0);
|
|
write_check(p, 0);
|
|
write_check(p, ~0);
|
|
write_check(p, ~0);
|
|
- write_check(p, ~a);
|
|
|
|
- write_check(p, a);
|
|
|
|
- }
|
|
|
|
|
|
+ write_check(p, ~w);
|
|
|
|
+ write_check(p, w);
|
|
|
|
+ write_check(p, w + SOME_NUMBER);
|
|
|
|
+
|
|
|
|
+ if (!(++n & 0x3ffff)) {
|
|
|
|
+ CONSOLE = err_char;
|
|
|
|
+ err_char = '-';
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ w = (w + stride) & SDRAM_MASK;
|
|
|
|
+ } while (w);
|
|
|
|
|
|
- con_puts("\rReading back to check for aliases...\r\n");
|
|
|
|
|
|
+ con_puts("\r\nReading back to check for aliases...\r\n");
|
|
|
|
|
|
- for (p = sdram_start ; p < sdram_end ; p++) {
|
|
|
|
- uint32_t a = (uint32_t)p;
|
|
|
|
- uint32_t v = *p;
|
|
|
|
|
|
+ rate_limit = ERROR_RATELIMIT;
|
|
|
|
+ do {
|
|
|
|
+ uint32_t a = w + SDRAM_ADDR;
|
|
|
|
+ volatile uint32_t *p = (volatile uint32_t *)a;
|
|
|
|
|
|
- if (!(a & 0xffff))
|
|
|
|
- con_printf("\r%p ", p);
|
|
|
|
|
|
+ data_check(p, w + SOME_NUMBER);
|
|
|
|
|
|
-#if 0
|
|
|
|
- if (v != a)
|
|
|
|
- con_printf("\r%p : read %08x expected %08x\r\n", p, v, a);
|
|
|
|
-#endif
|
|
|
|
- }
|
|
|
|
|
|
+ if (!(++n & 0x3ffff)) {
|
|
|
|
+ CONSOLE = err_char;
|
|
|
|
+ err_char = '-';
|
|
|
|
+ }
|
|
|
|
|
|
- con_puts("\rSDRAM test complete\r\n");
|
|
|
|
|
|
+ w = (w - stride) & SDRAM_MASK;
|
|
|
|
+ } while (w);
|
|
|
|
+
|
|
|
|
+ con_printf("\rSDRAM test complete, time = %u ms\r\n",
|
|
|
|
+ (rdtime() - start_time)/(CPU_CLK_HZ/1000));
|
|
|
|
+
|
|
|
|
+ stride *= 3;
|
|
|
|
+ stride = ((stride & SDRAM_MASK) ^ (stride >> (SDRAM_ADDR_BITS-2))) & ~3;
|
|
}
|
|
}
|
|
|
|
|
|
void main(void)
|
|
void main(void)
|
|
{
|
|
{
|
|
- static const char hello[] = "\r\n\nHello, World!\r\n";
|
|
|
|
|
|
+ static const char hello[] = "\f\033[2J\033[H"
|
|
|
|
+ "*** Hello, World! ***\r\n"
|
|
|
|
+ "Firmware compiled on: " __DATE__ " " __TIME__ "\r\n\n";
|
|
uint8_t led = 0;
|
|
uint8_t led = 0;
|
|
- unsigned int loops = 0;
|
|
|
|
|
|
+ uint8_t loops;
|
|
|
|
|
|
con_set_baudrate(115200);
|
|
con_set_baudrate(115200);
|
|
set_led(led = 0);
|
|
set_led(led = 0);
|
|
|
|
|
|
- con_puts(hello);
|
|
|
|
-
|
|
|
|
while ( 1 ) {
|
|
while ( 1 ) {
|
|
|
|
+ con_puts(hello);
|
|
|
|
+ con_printf("Loops: %u, errors = %u\r\n\n", loops++, errors);
|
|
test_sdram();
|
|
test_sdram();
|
|
led = (led << 1) | ((~led >> 2) & 1);
|
|
led = (led << 1) | ((~led >> 2) & 1);
|
|
set_led(led);
|
|
set_led(led);
|
|
- udelay(400000);
|
|
|
|
- loops++;
|
|
|
|
- con_printf("Loops: %u\r\n\n", loops);
|
|
|
|
}
|
|
}
|
|
-
|
|
|
|
- die();
|
|
|
|
}
|
|
}
|