1 |
|
#ifndef lint |
2 |
< |
static char SCCSid[] = "$SunId$ LBL"; |
2 |
> |
static const char RCSid[] = "$Id$"; |
3 |
|
#endif |
4 |
– |
|
5 |
– |
/* Copyright (c) 1989 Regents of the University of California */ |
6 |
– |
|
4 |
|
/* |
5 |
|
* genrev.c - program to generate functions of rotation about z |
6 |
|
* |
11 |
|
* 8/6/86 |
12 |
|
*/ |
13 |
|
|
14 |
+ |
#include <stdlib.h> |
15 |
|
#include <stdio.h> |
16 |
+ |
#include <string.h> |
17 |
+ |
#include <math.h> |
18 |
+ |
#include "calcomp.h" |
19 |
|
|
20 |
|
#define ZNAME "Z`SYS`" /* z function name */ |
21 |
|
#define RNAME "R`SYS`" /* r function name */ |
29 |
|
#define UP 04 |
30 |
|
#define DOWN 010 |
31 |
|
|
32 |
< |
double funvalue(), l_hermite(), l_bezier(), l_bspline(), argument(); |
32 |
> |
void quit(), eputs(), wputs(); |
33 |
|
|
34 |
|
|
35 |
+ |
computen(nzp, nrp, z0, r0, z1, r1) /* compute normal */ |
36 |
+ |
double *nzp, *nrp, z0, r0, z1, r1; |
37 |
+ |
{ |
38 |
+ |
double dr, dz, len; |
39 |
+ |
|
40 |
+ |
dz = r0 - r1; /* right angle vector */ |
41 |
+ |
dr = z1 - z0; |
42 |
+ |
len = sqrt(dr*dr + dz*dz); |
43 |
+ |
*nzp = dz/len; |
44 |
+ |
*nrp = dr/len; |
45 |
+ |
} |
46 |
+ |
|
47 |
+ |
|
48 |
+ |
void |
49 |
+ |
eputs(msg) |
50 |
+ |
char *msg; |
51 |
+ |
{ |
52 |
+ |
fputs(msg, stderr); |
53 |
+ |
} |
54 |
+ |
|
55 |
+ |
|
56 |
+ |
void |
57 |
+ |
wputs(msg) |
58 |
+ |
char *msg; |
59 |
+ |
{ |
60 |
+ |
eputs(msg); |
61 |
+ |
} |
62 |
+ |
|
63 |
+ |
|
64 |
+ |
void |
65 |
+ |
quit(code) |
66 |
+ |
int code; |
67 |
+ |
{ |
68 |
+ |
exit(code); |
69 |
+ |
} |
70 |
+ |
|
71 |
+ |
|
72 |
+ |
printhead(ac, av) /* print command header */ |
73 |
+ |
register int ac; |
74 |
+ |
register char **av; |
75 |
+ |
{ |
76 |
+ |
putchar('#'); |
77 |
+ |
while (ac--) { |
78 |
+ |
putchar(' '); |
79 |
+ |
fputs(*av++, stdout); |
80 |
+ |
} |
81 |
+ |
putchar('\n'); |
82 |
+ |
} |
83 |
+ |
|
84 |
+ |
|
85 |
+ |
double |
86 |
+ |
l_hermite(char *nm) |
87 |
+ |
{ |
88 |
+ |
double t; |
89 |
+ |
|
90 |
+ |
t = argument(5); |
91 |
+ |
return( argument(1)*((2.0*t-3.0)*t*t+1.0) + |
92 |
+ |
argument(2)*(-2.0*t+3.0)*t*t + |
93 |
+ |
argument(3)*((t-2.0)*t+1.0)*t + |
94 |
+ |
argument(4)*(t-1.0)*t*t ); |
95 |
+ |
} |
96 |
+ |
|
97 |
+ |
|
98 |
+ |
double |
99 |
+ |
l_bezier(char *nm) |
100 |
+ |
{ |
101 |
+ |
double t; |
102 |
+ |
|
103 |
+ |
t = argument(5); |
104 |
+ |
return( argument(1) * (1.+t*(-3.+t*(3.-t))) + |
105 |
+ |
argument(2) * 3.*t*(1.+t*(-2.+t)) + |
106 |
+ |
argument(3) * 3.*t*t*(1.-t) + |
107 |
+ |
argument(4) * t*t*t ); |
108 |
+ |
} |
109 |
+ |
|
110 |
+ |
|
111 |
+ |
double |
112 |
+ |
l_bspline(char *nm) |
113 |
+ |
{ |
114 |
+ |
double t; |
115 |
+ |
|
116 |
+ |
t = argument(5); |
117 |
+ |
return( argument(1) * (1./6.+t*(-1./2.+t*(1./2.-1./6.*t))) + |
118 |
+ |
argument(2) * (2./3.+t*t*(-1.+1./2.*t)) + |
119 |
+ |
argument(3) * (1./6.+t*(1./2.+t*(1./2.-1./2.*t))) + |
120 |
+ |
argument(4) * (1./6.*t*t*t) ); |
121 |
+ |
} |
122 |
+ |
|
123 |
+ |
|
124 |
|
main(argc, argv) |
125 |
|
int argc; |
126 |
|
char *argv[]; |
127 |
|
{ |
38 |
– |
extern long eclock; |
128 |
|
char stmp[256]; |
129 |
|
char *modname; |
130 |
|
int smooth = 0; |
246 |
|
} |
247 |
|
|
248 |
|
|
160 |
– |
computen(nzp, nrp, z0, r0, z1, r1) /* compute normal */ |
161 |
– |
double *nzp, *nrp, z0, r0, z1, r1; |
162 |
– |
{ |
163 |
– |
extern double sqrt(); |
164 |
– |
double dr, dz, len; |
165 |
– |
|
166 |
– |
dz = r0 - r1; /* right angle vector */ |
167 |
– |
dr = z1 - z0; |
168 |
– |
len = sqrt(dr*dr + dz*dz); |
169 |
– |
*nzp = dz/len; |
170 |
– |
*nrp = dr/len; |
171 |
– |
} |
172 |
– |
|
173 |
– |
|
174 |
– |
eputs(msg) |
175 |
– |
char *msg; |
176 |
– |
{ |
177 |
– |
fputs(msg, stderr); |
178 |
– |
} |
179 |
– |
|
180 |
– |
|
181 |
– |
wputs(msg) |
182 |
– |
char *msg; |
183 |
– |
{ |
184 |
– |
eputs(msg); |
185 |
– |
} |
186 |
– |
|
187 |
– |
|
188 |
– |
quit(code) |
189 |
– |
{ |
190 |
– |
exit(code); |
191 |
– |
} |
192 |
– |
|
193 |
– |
|
194 |
– |
printhead(ac, av) /* print command header */ |
195 |
– |
register int ac; |
196 |
– |
register char **av; |
197 |
– |
{ |
198 |
– |
putchar('#'); |
199 |
– |
while (ac--) { |
200 |
– |
putchar(' '); |
201 |
– |
fputs(*av++, stdout); |
202 |
– |
} |
203 |
– |
putchar('\n'); |
204 |
– |
} |
205 |
– |
|
206 |
– |
|
207 |
– |
double |
208 |
– |
l_hermite() |
209 |
– |
{ |
210 |
– |
double t; |
211 |
– |
|
212 |
– |
t = argument(5); |
213 |
– |
return( argument(1)*((2.0*t-3.0)*t*t+1.0) + |
214 |
– |
argument(2)*(-2.0*t+3.0)*t*t + |
215 |
– |
argument(3)*((t-2.0)*t+1.0)*t + |
216 |
– |
argument(4)*(t-1.0)*t*t ); |
217 |
– |
} |
218 |
– |
|
219 |
– |
|
220 |
– |
double |
221 |
– |
l_bezier() |
222 |
– |
{ |
223 |
– |
double t; |
224 |
– |
|
225 |
– |
t = argument(5); |
226 |
– |
return( argument(1) * (1.+t*(-3.+t*(3.-t))) + |
227 |
– |
argument(2) * 3.*t*(1.+t*(-2.+t)) + |
228 |
– |
argument(3) * 3.*t*t*(1.-t) + |
229 |
– |
argument(4) * t*t*t ); |
230 |
– |
} |
231 |
– |
|
232 |
– |
|
233 |
– |
double |
234 |
– |
l_bspline() |
235 |
– |
{ |
236 |
– |
double t; |
237 |
– |
|
238 |
– |
t = argument(5); |
239 |
– |
return( argument(1) * (1./6.+t*(-1./2.+t*(1./2.-1./6.*t))) + |
240 |
– |
argument(2) * (2./3.+t*t*(-1.+1./2.*t)) + |
241 |
– |
argument(3) * (1./6.+t*(1./2.+t*(1./2.-1./2.*t))) + |
242 |
– |
argument(4) * (1./6.*t*t*t) ); |
243 |
– |
} |