aboutsummaryrefslogtreecommitdiff
path: root/math/gsurfit/gssub.gx
blob: 533417a7d10cf21b670b4088a348bf561951280b (plain) (blame)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
# Copyright(c) 1986 Association of Universities for Research in Astronomy Inc.

include <math/gsurfit.h>
$if (datatype == r)
include "gsurfitdef.h"
$else
include "dgsurfitdef.h"
$endif

# GSSUB -- Procedure to subtract two surfaces. The surfaces
# must be the same type and the fit must cover the same range of data in x
# and y. This is a special function.

$if (datatype == r)
procedure gssub (sf1, sf2, sf3)
$else
procedure dgssub (sf1, sf2, sf3)
$endif

pointer	sf1		# pointer to the first surface
pointer	sf2		# pointer to the second surface
pointer	sf3		# pointer to the output surface

int	i, ncoeff, order, maxorder1, maxorder2, maxorder3
int	nmove1, nmove2, nmove3
pointer	sp, coeff, ptr1, ptr2, ptr3

bool	fpequal$t()
$if (datatype == r)
int	gsgeti()
$else
int	dgsgeti()
$endif

begin
	# test for NULL surface
	if (sf1 == NULL && sf2 == NULL) {
	    sf3 = NULL
	    return
	} else if (sf1 == NULL) {
$if (datatype == r)
	    ncoeff = gsgeti (sf2, GSNSAVE)
$else
	    ncoeff = dgsgeti (sf2, GSNSAVE)
$endif
	    call smark (sp)
	    $if (datatype == r)
	    call salloc (coeff, ncoeff, TY_REAL)
	    $else
	    call salloc (coeff, ncoeff, TY_DOUBLE)
	    $endif
	    call gssave (sf2, Mem$t[coeff])
	    $if (datatype == r)
	    call amulk$t (Mem$t[coeff], -1.0, Mem$t[coeff], ncoeff)
	    $else
	    call amulk$t (Mem$t[coeff], -1.0d0, Mem$t[coeff], ncoeff)
	    $endif
	    call gsrestore (sf3, Mem$t[coeff])
	    call sfree (sp)
	    return
	} else if (sf2 == NULL) {
	    call gscopy (sf1, sf3)
	    return
	}

	# test that function type is the same
	if (GS_TYPE(sf1) != GS_TYPE(sf2))
	    call error (0, "GSSUB: Incompatable surface types.")

	# test that mins and maxs are the same
	if (! fpequal$t (GS_XMIN(sf1), GS_XMIN(sf2)))
	    call error (0, "GSADD: X ranges not identical.")
	if (! fpequal$t (GS_XMAX(sf1), GS_XMAX(sf2)))
	    call error (0, "GSADD: X ranges not identical.")
	if (! fpequal$t (GS_YMIN(sf1), GS_YMIN(sf2)))
	    call error (0, "GSADD: Y ranges not identical.")
	if (! fpequal$t (GS_YMAX(sf1), GS_YMAX(sf2)))
	    call error (0, "GSADD: Y ranges not identical.")

	# allocate space for the pointer
	call calloc (sf3, LEN_GSSTRUCT, TY_STRUCT)

	# copy parameters
	GS_TYPE(sf3) = GS_TYPE(sf1)

	switch (GS_TYPE(sf3)) {
	case GS_LEGENDRE, GS_CHEBYSHEV, GS_POLYNOMIAL:
	    GS_NXCOEFF(sf3) = max (GS_NXCOEFF(sf1), GS_NXCOEFF(sf2))
	    GS_XORDER(sf3) = max (GS_XORDER(sf1), GS_XORDER(sf2))
	    GS_XMIN(sf3) = GS_XMIN(sf1)
	    GS_XMAX(sf3) = GS_XMAX(sf1)
	    GS_XRANGE(sf3) = GS_XRANGE(sf1)
	    GS_XMAXMIN(sf3) = GS_XMAXMIN(sf1)
	    GS_NYCOEFF(sf3) = max (GS_NYCOEFF(sf1), GS_NYCOEFF(sf2))
	    GS_YORDER(sf3) = max (GS_YORDER(sf1), GS_YORDER(sf2))
	    GS_YMIN(sf3) = GS_YMIN(sf1)
	    GS_YMAX(sf3) = GS_YMAX(sf1)
	    GS_YRANGE(sf3) = GS_YRANGE(sf1)
	    GS_YMAXMIN(sf3) = GS_YMAXMIN(sf1)
	    if (GS_XTERMS(sf1) == GS_XTERMS(sf2))
		GS_XTERMS(sf3) = GS_XTERMS(sf1)
	    else if (GS_XTERMS(sf1) == GS_XFULL || GS_XTERMS(sf2) == GS_XFULL)
		GS_XTERMS(sf3) = GS_XFULL
	    else
		GS_XTERMS(sf3) = GS_XHALF
	    switch (GS_XTERMS(sf3)) {
	    case GS_XNONE:
		GS_NCOEFF(sf3) = GS_NXCOEFF(sf3) + GS_NYCOEFF(sf3) - 1
	    case GS_XHALF:
		order = min (GS_XORDER(sf3), GS_YORDER(sf3))
	        GS_NCOEFF(sf3) = GS_NXCOEFF(sf3) * GS_NYCOEFF(sf3) - order *
		    (order - 1) / 2
	    default:
	        GS_NCOEFF(sf3) = GS_NXCOEFF(sf3) * GS_NYCOEFF(sf3)
	    }
	default:
	    call error (0, "GSADD: Unknown curve type.")
	}

	# set pointers to NULL
	GS_XBASIS(sf3) = NULL
	GS_YBASIS(sf3) = NULL
	GS_MATRIX(sf3) = NULL
	GS_CHOFAC(sf3) = NULL
	GS_VECTOR(sf3) = NULL
	GS_COEFF(sf3) = NULL
	GS_WZ(sf3) = NULL

	# calculate the coefficients
	$if (datatype == r)
	call calloc (GS_COEFF(sf3), GS_NCOEFF(sf3), TY_REAL)
	$else
	call calloc (GS_COEFF(sf3), GS_NCOEFF(sf3), TY_DOUBLE)
	$endif

	# set up the line counters.
        maxorder1 = max (GS_XORDER(sf1) + 1, GS_YORDER(sf1) + 1)
        maxorder2 = max (GS_XORDER(sf2) + 1, GS_YORDER(sf2) + 1)
        maxorder3 = max (GS_XORDER(sf3) + 1, GS_YORDER(sf3) + 1)

        # add in the first surface.
        ptr1 = GS_COEFF(sf1)
        ptr3 = GS_COEFF(sf3)
        nmove1 = GS_NXCOEFF(sf1)
        nmove3 = GS_NXCOEFF(sf3)
        do i = 1, GS_NYCOEFF(sf1) {
            call amov$t (COEFF(ptr1), COEFF(ptr3), nmove1)
            ptr1 = ptr1 + nmove1
            ptr3 = ptr3 + nmove3
            switch (GS_XTERMS(sf1)) {
            case GS_XNONE:
                nmove1 = 1
            case GS_XHALF:
                if ((i + GS_XORDER(sf1) + 1) > maxorder1)
                    nmove1 = nmove1 - 1
            case GS_XFULL:
                ;
            }
            switch (GS_XTERMS(sf3)) {
            case GS_XNONE:
                nmove3 = 1
            case GS_XHALF:
                if ((i + GS_XORDER(sf3) + 1) > maxorder3)
                    nmove3 = nmove3 - 1
            case GS_XFULL:
                ;
            }
        }

        # subtract the second surface.
        ptr2 = GS_COEFF(sf2)
        ptr3 = GS_COEFF(sf3)
        nmove2 = GS_NXCOEFF(sf2)
        nmove3 = GS_NXCOEFF(sf3)
        do i = 1, GS_NYCOEFF(sf2) {
            call asub$t (COEFF(ptr3), COEFF(ptr2), COEFF(ptr3), nmove2)
            ptr2 = ptr2 + nmove2
            ptr3 = ptr3 + nmove3
            switch (GS_XTERMS(sf2)) {
            case GS_XNONE:
                nmove2 = 1
            case GS_XHALF:
                if ((i + GS_XORDER(sf2) + 1) > maxorder2)
                    nmove2 = nmove2 - 1
            case GS_XFULL:
                ;
            }
            switch (GS_XTERMS(sf3)) {
            case GS_XNONE:
                nmove3 = 1
            case GS_XHALF:
                if ((i + GS_XORDER(sf3) + 1) > maxorder3)
                    nmove3 = nmove3 - 1
            case GS_XFULL:
                ;
            }
        }
end