diff options
Diffstat (limited to 'src/cmd/astro/cosadd.c')
-rw-r--r-- | src/cmd/astro/cosadd.c | 64 |
1 files changed, 64 insertions, 0 deletions
diff --git a/src/cmd/astro/cosadd.c b/src/cmd/astro/cosadd.c new file mode 100644 index 00000000..a632149a --- /dev/null +++ b/src/cmd/astro/cosadd.c @@ -0,0 +1,64 @@ +#include "astro.h" + + +void +icosadd(double *fp, char *cp) +{ + + cafp = fp; + cacp = cp; +} + +double +cosadd(int n, double coef, ...) +{ + double *coefp; + char *cp; + int i; + double sum, a1, a2; + + sum = 0; + cp = cacp; + +loop: + a1 = *cafp++; + if(a1 == 0) { + cacp = cp; + return sum; + } + a2 = *cafp++; + i = n; + coefp = &coef; + do + a2 += *cp++ * *coefp++; + while(--i); + sum += a1 * cos(a2); + goto loop; +} + +double +sinadd(int n, double coef, ...) +{ + double *coefp; + char *cp; + int i; + double sum, a1, a2; + + sum = 0; + cp = cacp; + +loop: + a1 = *cafp++; + if(a1 == 0) { + cacp = cp; + return sum; + } + a2 = *cafp++; + i = n; + coefp = &coef; + do + a2 += *cp++ * *coefp++; + while(--i); + sum += a1 * sin(a2); + goto loop; +} |