summaryrefslogtreecommitdiffhomepage
diff options
context:
space:
mode:
-rw-r--r--digital/avr/modules/trace/test/test_target/flood.c20
-rw-r--r--digital/avr/modules/trace/trace.c8
2 files changed, 13 insertions, 15 deletions
diff --git a/digital/avr/modules/trace/test/test_target/flood.c b/digital/avr/modules/trace/test/test_target/flood.c
index 38d5506c..b919d0a6 100644
--- a/digital/avr/modules/trace/test/test_target/flood.c
+++ b/digital/avr/modules/trace/test/test_target/flood.c
@@ -57,16 +57,16 @@ flood (void)
/* A little more than 3 memory sectors, a sector is 4 kbytes. */
for (count = 0; count < 2000; count ++)
{
- /* Right motor. */
- speed = 1;
- position = 2;
- acc = 3;
- arg1 = 1;
- arg2 = 2;
- arg3 = 3;
- TRACE (TRACE_ASSERV__RIGHT_MOTOR, speed, position, acc);
- TRACE (TRACE_ASSERV__LEFT_MOTOR, speed, position, acc);
- TRACE (TRACE_IA__IA_CMD, arg1, arg2, arg3);
+ /* Right motor. */
+ speed = 1;
+ position = 2;
+ acc = 3;
+ arg1 = 1;
+ arg2 = 2;
+ arg3 = 3;
+ TRACE (TRACE_ASSERV__RIGHT_MOTOR, speed, position, acc);
+ TRACE (TRACE_ASSERV__LEFT_MOTOR, speed, position, acc);
+ TRACE (TRACE_IA__IA_CMD, arg1, arg2, arg3);
}
/* Print the end of the address. */
diff --git a/digital/avr/modules/trace/trace.c b/digital/avr/modules/trace/trace.c
index 33488150..e904c2fa 100644
--- a/digital/avr/modules/trace/trace.c
+++ b/digital/avr/modules/trace/trace.c
@@ -110,12 +110,10 @@ trace_init (void)
trace_erase_next_sector ();
/* Store the start code. */
- for (i = 24; i >= 0; i -= 8)
+ for (i = 4; i; i--)
{
- flash_write (trace_global.addr,
- TRACE_CODE_START >> i);
- trace_global.addr =
- FLASH_ADDRESS_INC(trace_global.addr);
+ flash_write (trace_global.addr, v32_to_v8(TRACE_CODE_START, i-1));
+ trace_global.addr = FLASH_ADDRESS_INC(trace_global.addr);
}
return TRACE_STATUS_ON;
}