summaryrefslogtreecommitdiff
diff options
context:
space:
mode:
authorschodet2005-02-26 20:12:25 +0000
committerschodet2005-02-26 20:12:25 +0000
commit6c50382285b4dcf2fbb340f60fb2761e8b77c8ae (patch)
treec71f2bb2013c5d914c73fed6aa3110af7394520c
parentd706cae394a324ede905605442571ff7a7f3527b (diff)
Ajout du test de dsp_sqrt.
-rw-r--r--n/asserv/src/test_dsp.c28
1 files changed, 20 insertions, 8 deletions
diff --git a/n/asserv/src/test_dsp.c b/n/asserv/src/test_dsp.c
index 870980d..b1a0c9b 100644
--- a/n/asserv/src/test_dsp.c
+++ b/n/asserv/src/test_dsp.c
@@ -80,9 +80,9 @@ proto_callback (uint8_t cmd, uint8_t size, uint8_t *args)
break;
case 'c' | 1 << 8:
rl = dsp_cos (sa);
- proto_send1w ('r', rl);
+ proto_send1d ('r', rl);
rl = dsp_sin (sa);
- proto_send1w ('r', rl);
+ proto_send1d ('r', rl);
break;
case 'M' | 0 << 8:
for (k = 0; k < 2; k++)
@@ -93,16 +93,16 @@ proto_callback (uint8_t cmd, uint8_t size, uint8_t *args)
for (j = 32; j >= 0; j--)
{
bl = wl[k] >> j;
- proto_send1w ('A', al);
- proto_send1w ('B', bl);
+ proto_send1d ('A', al);
+ proto_send1d ('B', bl);
rl = dsp_mul_f824 (al, bl);
- proto_send1w ('r', rl);
+ proto_send1d ('r', rl);
rl = dsp_mul_f824 (-al, bl);
- proto_send1w ('r', rl);
+ proto_send1d ('r', rl);
rl = dsp_mul_f824 (al, -bl);
- proto_send1w ('r', rl);
+ proto_send1d ('r', rl);
rl = dsp_mul_f824 (-al, -bl);
- proto_send1w ('r', rl);
+ proto_send1d ('r', rl);
}
}
}
@@ -140,6 +140,18 @@ proto_callback (uint8_t cmd, uint8_t size, uint8_t *args)
proto_send1d ('r', rl);
}
break;
+ case 's' | 0 << 8:
+ for (k = 0; k < 2; k++)
+ {
+ for (i = 32; i > 0; i--)
+ {
+ al = wl[k] >> i;
+ proto_send1d ('s', al);
+ rl = dsp_sqrt (al);
+ proto_send1d ('r', rl);
+ }
+ }
+ break;
case 'z' | 0 << 8:
reset ();
default: