]>
cloudbase.mooo.com Git - z180-stamp.git/blob - avr/cmd_mem.c
2 * (C) Copyright 2014 Leo C. <erbl259-lmu@yahoo.de>
5 * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
7 * SPDX-License-Identifier: GPL-2.0
13 * Copied from FADS ROM, Dan Malek (dmalek@jlc.net)
18 #include <avr/interrupt.h>
21 #include "cli_readline.h"
22 #include "print-utils.h"
23 #include "con-utils.h"
24 #include "getopt-min.h"
31 #ifndef CONFIG_SYS_MEMTEST_SCRATCH
32 #define CONFIG_SYS_MEMTEST_SCRATCH 0
35 /* Display values from last command.
36 * Memory modify remembered values are different from display memory.
38 static uint32_t dp_last_addr
;
39 static uint32_t dp_last_length
= 0x100;
40 static uint32_t mm_last_addr
;
42 static uint32_t base_address
= 0;
44 /*--------------------------------------------------------------------------*/
46 int z180_read_buf(uint8_t *buf
, uint32_t addr
, uint8_t count
)
48 if (!(z80_bus_cmd(Request
) & ZST_ACQUIRED
))
51 z80_read_block (buf
, addr
, count
);
56 /*--------------------------------------------------------------------------*/
63 command_ret_t
do_mem_md(cmd_tbl_t
*cmdtp
, int flag
, int argc
, char * const argv
[])
65 uint32_t addr
, length
;
70 printf_P(PSTR("flag: %d, argc: %d"), flag
, argc
);
71 for (int i
= 0; i
< argc
; i
++) {
72 printf_P(PSTR(", argv[%d]: %s"), i
, argv
[i
] ? argv
[i
] : "<NULL>");
77 /* We use the last specified parameters, unless new ones are
81 length
= dp_last_length
;
86 if ((flag
& CMD_FLAG_REPEAT
) == 0) {
87 /* Address is specified since argc > 1 */
88 addr
= eval_arg(argv
[1], NULL
);
91 /* If another parameter, it is the length to display. */
93 length
= eval_arg(argv
[2], NULL
);
96 /* Print the lines. */
97 int ret
= dump_mem(addr
, addr
, length
, z180_read_buf
, NULL
);
98 if (ret
== -2) { /* TODO: Error codes */
99 my_puts_P(PSTR("Bus timeout\n"));
100 return CMD_RET_FAILURE
;
104 dp_last_addr
= addr
+ length
;
105 dp_last_length
= length
;
107 return CMD_RET_SUCCESS
;
117 mod_mem(cmd_tbl_t
*cmdtp
, int incrflag
, int flag
, int argc
, char * const argv
[])
126 return CMD_RET_USAGE
;
128 /* We use the last specified parameters, unless new ones are
133 if ((flag
& CMD_FLAG_REPEAT
) == 0) {
134 /* New command specified.
137 /* Address is specified since argc > 1
139 addr
= eval_arg(argv
[1], NULL
);
140 addr
+= base_address
;
143 /* Print the address, followed by value. Then accept input for
144 * the next value. A non-converted value exits.
147 if (!(z80_bus_cmd(Request
) & ZST_ACQUIRED
)) {
148 my_puts_P(PSTR("Bus timeout\n"));
149 return CMD_RET_FAILURE
;
151 data
= z80_read(addr
);
152 z80_bus_cmd(Release
);
153 printf_P(PSTR("%05lx: %02x"), addr
, data
);
155 nbytes
= cli_readline(PSTR(" ? "), 0);
156 if (nbytes
== 0 || (nbytes
== 1 && console_buffer
[0] == '-')) {
157 /* <CR> pressed as only input, don't modify current
158 * location and move to next. "-" pressed will go back.
161 addr
+= nbytes
? -1 : 1;
166 data
= eval_arg(console_buffer
, &endp
);
167 nbytes
= endp
- console_buffer
;
169 if (!(z80_bus_cmd(Request
) & ZST_ACQUIRED
)) {
170 my_puts_P(PSTR("Bus timeout\n"));
171 return CMD_RET_FAILURE
;
173 z80_write(addr
, data
);
174 z80_bus_cmd(Release
);
179 } while (nbytes
> 0);
182 return CMD_RET_SUCCESS
;
186 command_ret_t
do_mem_mm(cmd_tbl_t
*cmdtp
, int flag
, int argc
, char * const argv
[])
188 return mod_mem (cmdtp
, 1, flag
, argc
, argv
);
190 command_ret_t
do_mem_nm(cmd_tbl_t
*cmdtp
, int flag
, int argc
, char * const argv
[])
192 return mod_mem (cmdtp
, 0, flag
, argc
, argv
);
195 command_ret_t
do_mem_mw(cmd_tbl_t
*cmdtp
, int flag
, int argc
, char * const argv
[])
200 uint_fast8_t width
= 1;
202 (void) cmdtp
; (void) flag
;
208 while ((opt
= getopt(argc
, argv
, PSTR("bwl"))) != -1) {
220 return CMD_RET_USAGE
;
224 /* remaining arguments */
226 if ((argc
< 2) || (argc
> 3))
227 return CMD_RET_USAGE
;
229 /* Address and value are specified since (adjusted) argc >= 2 */
230 addr
= eval_arg(argv
[optind
++], NULL
);
231 addr
+= base_address
;
232 writeval
= eval_arg(argv
[optind
++], NULL
);
236 count
= eval_arg(argv
[optind
], NULL
);
238 if (!(z80_bus_cmd(Request
) & ZST_ACQUIRED
)) {
239 my_puts_P(PSTR("Bus timeout\n"));
240 return CMD_RET_FAILURE
;
244 z80_memset(addr
, writeval
, count
);
247 z80_write_block((const uint8_t *) &writeval
, addr
, width
);
251 z80_bus_cmd(Release
);
253 return CMD_RET_SUCCESS
;
256 #ifdef CONFIG_MX_CYCLIC
257 command_ret_t
do_mem_mdc ( cmd_tbl_t
*cmdtp
, int flag
, int argc
, char * const argv
[])
266 if (argv
[0][1] != 'd') {
268 while ((opt
= getopt(argc
, argv
, PSTR("bwl"))) != -1)
270 return CMD_RET_USAGE
;
274 if (argc
-optind
!= 4)
275 return CMD_RET_USAGE
;
277 count
= eval_arg(argv
[optind
+ 3], NULL
);
279 clear_ctrlc(); /* forget any previous Control C */
282 if (argv
[0][1] == 'd')
283 do_mem_md (NULL
, 0, argc
-1, argv
); /* memory display */
285 do_mem_mw (NULL
, 0, argc
-1, argv
); /* memory write */
288 /* delay for <count> ms... */
291 /* check for ctrl-c to abort... */
292 if (had_ctrlc() || ctrlc()) {
293 my_puts_P(PSTR("Abort\n"));
294 return CMD_RET_SUCCESS
;
296 } while (get_timer(ts
) < count
);
299 return CMD_RET_SUCCESS
;
301 #endif /* CONFIG_MX_CYCLIC */
303 command_ret_t
do_mem_cmp(cmd_tbl_t
*cmdtp
, int flag
, int argc
, char * const argv
[])
305 uint32_t addr1
, addr2
, count
, ngood
;
306 command_ret_t rcode
= CMD_RET_SUCCESS
;
307 uint8_t byte1
, byte2
;
313 return CMD_RET_USAGE
;
316 addr1
= eval_arg(argv
[1], NULL
);
317 addr1
+= base_address
;
318 addr2
= eval_arg(argv
[2], NULL
);
319 addr2
+= base_address
;
320 count
= eval_arg(argv
[3], NULL
);
322 for (ngood
= 0; ngood
< count
; ++ngood
) {
323 if (!(z80_bus_cmd(Request
) & ZST_ACQUIRED
)) {
324 my_puts_P(PSTR("Bus timeout\n"));
325 rcode
= CMD_RET_FAILURE
;
328 byte1
= z80_read(addr1
);
329 byte2
= z80_read(addr2
);
330 z80_bus_cmd(Release
);
331 if (byte1
!= byte2
) {
332 printf_P(PSTR("byte at 0x%05lx (%#02x) != "
333 "byte at 0x%05lx (%#02x)\n"),
334 addr1
, byte1
, addr2
, byte2
);
335 rcode
= CMD_RET_FAILURE
;
341 /* check for ctrl-c to abort... */
343 my_puts_P(PSTR("Abort\n"));
344 return CMD_RET_SUCCESS
;
348 printf_P(PSTR("Total of %ld byte(s) (0x%lx) were the same\n"), ngood
, ngood
);
352 command_ret_t
do_mem_cp(cmd_tbl_t
*cmdtp
, int flag
, int argc
, char * const argv
[])
354 uint32_t src
, dest
, count
;
361 return CMD_RET_USAGE
;
363 src
= eval_arg(argv
[1], NULL
);
365 dest
= eval_arg(argv
[2], NULL
);
366 dest
+= base_address
;
367 count
= eval_arg(argv
[3], NULL
);
370 my_puts_P(PSTR("Zero length?\n"));
371 return CMD_RET_FAILURE
;
381 while (count
-- > 0) {
383 if (!(z80_bus_cmd(Request
) & ZST_ACQUIRED
)) {
384 my_puts_P(PSTR("Bus timeout\n"));
385 return CMD_RET_FAILURE
;
387 data
= z80_read(src
);
388 z80_write(dest
, data
);
389 z80_bus_cmd(Release
);
393 /* check for ctrl-c to abort... */
395 my_puts_P(PSTR("Abort\n"));
396 return CMD_RET_SUCCESS
;
399 return CMD_RET_SUCCESS
;
402 command_ret_t
do_mem_base(cmd_tbl_t
*cmdtp
, int flag
, int argc
,
409 /* Set new base address. */
410 base_address
= eval_arg(argv
[1], NULL
);
412 /* Print the current base address. */
413 printf_P(PSTR("Base Address: 0x%05lx\n"), base_address
);
414 return CMD_RET_SUCCESS
;
417 command_ret_t
do_mem_loop(cmd_tbl_t
*cmdtp
, int flag
, int argc
,
420 uint32_t addr
, length
;
426 return CMD_RET_USAGE
;
428 /* Address is always specified. */
429 addr
= eval_arg(argv
[1], NULL
);
431 /* Length is the number of bytes. */
432 length
= eval_arg(argv
[2], NULL
);
435 /* We want to optimize the loops to run as fast as possible.
436 * If we have only one object, just run infinite loops.
439 if (!(z80_bus_cmd(Request
) & ZST_ACQUIRED
)) {
440 my_puts_P(PSTR("Bus timeout\n"));
441 return CMD_RET_FAILURE
;
448 if (!(z80_bus_cmd(Request
) & ZST_ACQUIRED
)) {
449 my_puts_P(PSTR("Bus timeout\n"));
450 return CMD_RET_FAILURE
;
460 return CMD_RET_SUCCESS
;
463 command_ret_t
do_mem_loopw (cmd_tbl_t
*cmdtp
, int flag
, int argc
, char * const argv
[])
465 uint32_t addr
, length
;
472 return CMD_RET_USAGE
;
474 /* Address is always specified. */
475 addr
= eval_arg(argv
[1], NULL
);
477 /* Length is the number of bytes. */
478 length
= eval_arg(argv
[2], NULL
);
480 data
= eval_arg(argv
[3], NULL
);
483 * We want to optimize the loops to run as fast as possible.
484 * If we have only one object, just run infinite loops.
487 if (!(z80_bus_cmd(Request
) & ZST_ACQUIRED
)) {
488 my_puts_P(PSTR("Bus timeout\n"));
489 return CMD_RET_FAILURE
;
493 z80_write(addr
, data
);
496 if (!(z80_bus_cmd(Request
) & ZST_ACQUIRED
)) {
497 my_puts_P(PSTR("Bus timeout\n"));
498 return CMD_RET_FAILURE
;
505 z80_write(p
++, data
);
509 //#define CONFIG_SYS_ALT_MEMTEST
511 #ifdef CONFIG_CMD_MEMTEST
512 static uint32_t mem_test_alt(uint32_t start_addr
, uint32_t end_addr
)
518 uint32_t test_offset
;
520 uint8_t anti_pattern
;
524 static const FLASH
uint8_t bitpattern
[] = {
525 0x01, /* single bit */
526 0x03, /* two adjacent bits */
527 0x07, /* three adjacent bits */
528 0x0F, /* four adjacent bits */
529 0x05, /* two non-adjacent bits */
530 0x15, /* three non-adjacent bits */
531 0x55, /* four non-adjacent bits */
532 0xaa, /* alternating 1/0 */
536 * Data line test: write a pattern to the first
537 * location, write the 1's complement to a 'parking'
538 * address (changes the state of the data bus so a
539 * floating bus doesn't give a false OK), and then
540 * read the value back. Note that we read it back
541 * into a variable because the next time we read it,
542 * it might be right (been there, tough to explain to
543 * the quality guys why it prints a failure when the
544 * "is" and "should be" are obviously the same in the
547 * Rather than exhaustively testing, we test some
548 * patterns by shifting '1' bits through a field of
549 * '0's and '0' bits through a field of '1's (i.e.
550 * pattern and ~pattern).
553 dummy
= start_addr
+1;
554 for (unsigned int j
= 0; j
< ARRAY_SIZE(bitpattern
); j
++) {
555 pattern
= bitpattern
[j
];
556 for (; pattern
!= 0; pattern
<<= 1) {
557 anti_pattern
= ~pattern
;
558 z80_write(addr
, pattern
);
559 z80_write(dummy
, anti_pattern
); /* clear the test data off the bus */
560 temp
= z80_read(addr
);
561 if (temp
!= pattern
) {
562 printf_P(PSTR("FAILURE (data line): "
563 "expected %02x, actual %02x\n"),
567 z80_write(addr
, anti_pattern
);
568 z80_write(dummy
, pattern
); /* clear the test data off the bus */
569 temp
= z80_read(addr
);
570 if (temp
!= anti_pattern
) {
571 printf_P(PSTR("FAILURE (data line): "
572 "Is %02x, should be %02x\n"),
586 * Based on code whose Original Author and Copyright
587 * information follows: Copyright (c) 1998 by Michael
588 * Barr. This software is placed into the public
589 * domain and may be used for any purpose. However,
590 * this notice must not be changed or removed and no
591 * warranty is either expressed or implied by its
592 * publication or distribution.
598 * Description: Test the address bus wiring in a
599 * memory region by performing a walking
600 * 1's test on the relevant bits of the
601 * address and checking for aliasing.
602 * This test will find single-bit
603 * address failures such as stuck-high,
604 * stuck-low, and shorted pins. The base
605 * address and size of the region are
606 * selected by the caller.
608 * Notes: For best results, the selected base
609 * address should have enough LSB 0's to
610 * guarantee single address bit changes.
611 * For example, to test a 64-Kbyte
612 * region, select a base address on a
613 * 64-Kbyte boundary. Also, select the
614 * region size as a power-of-two if at
617 * Returns: 0 if the test succeeds, 1 if the test fails.
620 num_bytes
= (end_addr
- start_addr
) / sizeof(uint8_t);
625 // debug("## %s:%d: length = 0x%.5lx\n", __func__, __LINE__, num_bytes);
627 * Write the default pattern at each of the
628 * power-of-two offsets.
630 for (offset
= 1; offset
< num_bytes
; offset
<<= 1)
631 z80_write(addr
+offset
, pattern
);
634 * Check for address bits stuck high.
636 z80_write(start_addr
, anti_pattern
);
638 for (offset
= 1; offset
< num_bytes
; offset
<<= 1) {
639 temp
= z80_read(start_addr
+ offset
);
640 if (temp
!= pattern
) {
641 printf_P(PSTR("FAILURE: Address bit stuck high @ 0x%.5lx:"
642 " expected 0x%.2x, actual 0x%.2x\n"),
643 start_addr
+ offset
, pattern
, temp
);
649 z80_write(start_addr
, pattern
);
652 * Check for addr bits stuck low or shorted.
654 for (test_offset
= 1; test_offset
< num_bytes
; test_offset
<<= 1) {
655 z80_write(start_addr
+ test_offset
, anti_pattern
);
657 for (offset
= 1; offset
< num_bytes
; offset
<<= 1) {
658 temp
= z80_read(start_addr
+ offset
);
659 if ((temp
!= pattern
) && (offset
!= test_offset
)) {
660 printf_P(PSTR("FAILURE: Address bit stuck low or shorted"
661 " @ 0x%.5lx: expected 0x%.2x, actual 0x%.2x\n"),
662 start_addr
+ offset
, pattern
, temp
);
668 z80_write(start_addr
+ test_offset
, pattern
);
675 * Description: Test the integrity of a physical
676 * memory device by performing an
677 * increment/decrement test over the
678 * entire region. In the process every
679 * storage bit in the device is tested
680 * as a zero and a one. The base address
681 * and the size of the region are
682 * selected by the caller.
684 * Returns: 0 if the test succeeds, 1 if the test fails.
689 * Fill memory with a known pattern.
691 for (pattern
= 1, addr
= start_addr
; addr
<= end_addr
; pattern
++, addr
++)
692 z80_write(addr
, pattern
);
695 * Check each location and invert it for the second pass.
697 for (pattern
= 1, addr
= start_addr
; addr
<= end_addr
; pattern
++, addr
++) {
698 temp
= z80_read(addr
);
699 if (temp
!= pattern
) {
700 printf_P(PSTR("FAILURE (read/write) @ 0x%.5lx:"
701 " expected 0x%.2x, actual 0x%.2x)\n"),
702 addr
, pattern
, temp
);
708 anti_pattern
= ~pattern
;
709 z80_write(addr
, anti_pattern
);
713 * Check each location for the inverted pattern and zero it.
715 for (pattern
= 1, addr
= start_addr
; addr
<= end_addr
; pattern
++, addr
++) {
716 anti_pattern
= ~pattern
;
717 temp
= z80_read(addr
);
718 if (temp
!= anti_pattern
) {
719 printf_P(PSTR("FAILURE (read/write) @ 0x%.5lx:"
720 " expected 0x%.2x, actual 0x%.2x)\n"),
721 start_addr
, anti_pattern
, temp
);
733 * Perform a memory test. A more complete alternative test can be
734 * configured using CONFIG_SYS_ALT_MEMTEST. The complete test loops until
735 * interrupted by ctrl-c or by a failure of one of the sub-tests.
737 command_ret_t
do_mem_mtest(cmd_tbl_t
*cmdtp
, int flag
, int argc
,
742 unsigned int iteration_limit
= 0;
743 unsigned int iteration
;
744 uint32_t errs
= 0; /* number of errors */
751 start
= eval_arg(argv
[1], NULL
);
754 end
= eval_arg(argv
[2], NULL
);
756 end
= CONFIG_SYS_RAMSIZE_MAX
- 1;
759 iteration_limit
= (unsigned int) eval_arg(argv
[3], NULL
);
761 printf_P(PSTR("Testing %05lx ... %05lx:\n"), start
, end
);
762 // debug("## %s:%d: start %#05lx end %#05lx\n", __func__, __LINE__, start, end);
764 clear_ctrlc(); /* forget any previous Control C */
767 !iteration_limit
|| iteration
< iteration_limit
;
770 printf_P(PSTR("Iteration: %6d\r"), iteration
+ 1);
773 if (!(z80_bus_cmd(Request
) & ZST_ACQUIRED
)) {
774 my_puts_P(PSTR("Bus timeout\n"));
775 return CMD_RET_FAILURE
;
777 errs
+= mem_test_alt(start
, end
);
778 z80_bus_cmd(Release
);
780 if (had_ctrlc() || ctrlc()) {
786 /* Memory test was aborted - write a newline to finish off */
788 ret
= CMD_RET_FAILURE
;
790 printf_P(PSTR("Tested %d iteration(s) with %lu errors.\n"),
792 ret
= errs
? CMD_RET_FAILURE
: CMD_RET_SUCCESS
;
797 #endif /* CONFIG_CMD_MEMTEST */