/* dsp_check2.c - check dsp algorithms. */ /* asserv - Position & speed motor control on a ATmega128. {{{ * * Copyright (C) 2004 Nicolas Schodet * * Robot APB Team/Efrei 2005. * Web: http://assos.efrei.fr/robot/ * Email: robot AT efrei DOT fr * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation; either version 2 of the License, or * (at your option) any later version. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License * along with this program; if not, write to the Free Software * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. * * }}} */ #include #include /* +AutoDec */ /* -AutoDec */ static int failled = 0; void check_mul_f824 (int a, int b, int r) { long long m = ((long long) a * b) >> 24; if (m > (1LL << 31) - 1 || m < -(1LL << 31)) printf ("overflow %d * %d = %d (%Ld)", a, b, r, m); else if (m == r) printf ("pass %d * %d = %d", a, b, r); else { printf ("fail %d * %d = %d (%Ld)", a, b, r, m); failled = 1; } printf (" | %08x %08x %08x\n", a, b, r); } void check_div_f824 (int d, int v, int r) { long long m; if (v == 0) { printf ("zero div %d / %d", d, v); } else { m = (((long long) d) << 24) / v; if (m > (1LL << 31) - 1 || m < -(1LL << 31)) printf ("overflow %d / %d = %d (%Ld)", d, v, r, m); else if (m == r) printf ("pass %d / %d = %d", d, v, r); else { printf ("fail %d / %d = %d (%Ld)", d, v, r, m); failled = 1; } } printf (" | %08x %08x %08x\n", d, v, r); } void check_sqrt (unsigned int s, unsigned int r) { double ds = (double) s / (1 << 8); unsigned int m = sqrt (ds) * (1 << 8); m &= ~0xf; if (m == r) printf ("pass sqrt (%u) = %u", s, r); else { printf ("fail sqrt (%u) = %u (%u)", s, r, m); failled = 1; } printf (" | %08x %08x %08x\n", s, r, m); } int peek (void) { int ret; char cs; ret = scanf (" %c", &cs); if (ret != 1) return 0; ungetc (cs, stdin); return cs; } int get (int c, int *v) { int ret; char cs; ret = scanf (" %c", &cs); if (ret != 1 || cs != c) return 0; ret = scanf (" %d", v); return ret == 1; } int main (void) { int incomplete = 0; int a, b, r1, r2, r3, r4, c; while (!feof (stdin)) { c = peek (); if (c == 'A') { if (get ('A', &a) && get ('B', &b) && get ('r', &r1) && get ('r', &r2) && get ('r', &r3) && get ('r', &r4)) { check_mul_f824 (a, b, r1); check_mul_f824 (-a, b, r2); check_mul_f824 (a, -b, r3); check_mul_f824 (-a, -b, r4); } else if (!feof (stdin)) incomplete++; } else if (c == 'd') { if (get ('d', &a) && get ('v', &b) && get ('r', &r1) && get ('r', &r2) && get ('r', &r3) && get ('r', &r4)) { check_div_f824 (a, b, r1); check_div_f824 (-a, b, r1); check_div_f824 (a, -b, r1); check_div_f824 (-a, -b, r1); } else if (!feof (stdin)) incomplete++; } else if (c == 's') { if (get ('s', &a) && get ('r', &r1)) { check_sqrt (a, r1); } else if (!feof (stdin)) incomplete++; } else if (c == 0) ; else printf ("unexpected character '%c'\n", c); } if (incomplete) printf ("%d incomplete tests\n", incomplete); if (failled) { printf ("test failled\n"); return 1; } else { printf ("test passed\n"); return 0; } }