From 6c50382285b4dcf2fbb340f60fb2761e8b77c8ae Mon Sep 17 00:00:00 2001 From: schodet Date: Sat, 26 Feb 2005 20:12:25 +0000 Subject: Ajout du test de dsp_sqrt. --- n/asserv/src/test_dsp.c | 28 ++++++++++++++++++++-------- 1 file changed, 20 insertions(+), 8 deletions(-) (limited to 'n/asserv') 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: -- cgit v1.2.3