aboutsummaryrefslogtreecommitdiff
path: root/math/gsurfit/gssubd.x
blob: 7f4dd1ba6d4c3a348f071912c7886fdad20e67e6 (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
# Copyright(c) 1986 Association of Universities for Research in Astronomy Inc.

include <math/gsurfit.h>
include "dgsurfitdef.h"

# 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.

procedure dgssub (sf1, sf2, sf3)

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	fpequald()
int	dgsgeti()

begin
	# test for NULL surface
	if (sf1 == NULL && sf2 == NULL) {
	    sf3 = NULL
	    return
	} else if (sf1 == NULL) {
	    ncoeff = dgsgeti (sf2, GSNSAVE)
	    call smark (sp)
	    call salloc (coeff, ncoeff, TY_DOUBLE)
	    call gssave (sf2, Memd[coeff])
	    call amulkd (Memd[coeff], -1.0d0, Memd[coeff], ncoeff)
	    call gsrestore (sf3, Memd[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 (! fpequald (GS_XMIN(sf1), GS_XMIN(sf2)))
	    call error (0, "GSADD: X ranges not identical.")
	if (! fpequald (GS_XMAX(sf1), GS_XMAX(sf2)))
	    call error (0, "GSADD: X ranges not identical.")
	if (! fpequald (GS_YMIN(sf1), GS_YMIN(sf2)))
	    call error (0, "GSADD: Y ranges not identical.")
	if (! fpequald (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
	call calloc (GS_COEFF(sf3), GS_NCOEFF(sf3), TY_DOUBLE)

	# 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 amovd (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 asubd (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