-
Notifications
You must be signed in to change notification settings - Fork 0
/
contour.f
220 lines (207 loc) · 7.53 KB
/
contour.f
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
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
c Automatic routine for doing raw contour-ing.
subroutine autocontour(zin,Lz,nx,ny)
real zin(Lz,ny)
parameter(nxmax=2000,nymax=2000,nlmax=16)
real x(nxmax,nymax),y(nxmax,nymax),z(nxmax,nymax),cl(nlmax)
real x1(nxmax*nymax),y1(nxmax*nymax),z1(nxmax*nymax)
equivalence (x1,x),(y1,y),(z1,z)
character*10 string
character*5 pstring
if(nx.gt.nxmax.or.ny.gt.nymax)then
write(*,*)nx,ny,' autocontour nx,ny too large c.f.',nxmax,nymax
return
endif
zmin=1.e20
zmax=-1.e20
do i=1,nx
do j=1,ny
index=i+(j-1)*nx
x1(index)=(i-1.)/(nx-1.)
y1(index)=(j-1.)/(ny-1.)
z1(index)=zin(i,j)
zmax=max(zmax,zin(i,j))
zmin=min(zmin,zin(i,j))
enddo
enddo
c Initialize the plot.
call pltinit(x1(1),x1(nx),y1(1),y1(1+(ny-1)*nx))
call axis()
call axis2()
nl=nlmax
call fitrange(zmin,zmax,nlmax-1,ipow,fac10,delta,first,xlast)
do i=1,nl
cl(i)=first+i*delta
if(cl(i).gt.xlast-.9999*delta) goto 1
cl(i)=cl(i)
call color(i)
call contour(z,x,y,nx,ny,cl(i),1)
if(ipow.lt.-1.or.ipow.gt.1)then
call fwrite(cl(i)/fac10,iwidth,2,string)
if(i.eq.1)then
call iwrite(ipow,iwidth,pstring)
call jdrwstr(.1,.13,
$ '!AX!@10!u'//pstring(1:iwidth)//'!u',1.2)
endif
else
call fwrite(cl(i),iwidth,2,string)
endif
call jdrwstr(.1,.1+i*.03,string,-1.)
enddo
1 continue
call color(15)
end
c_______________________________________________________________________
subroutine CONTOUR(z,x,y,nx,ny,cl,nl)
c Contour a function z(1:nx,1:ny)
c On a mesh of dimensions nx times ny
c with coordinates x(nx,ny),y(nx,ny)
c at levels cl(nl)
c whose number is nl
c External routines called
c Polyline to draw line segment(s).
integer nx,ny
real z(nx,ny),x(nx,ny),y(nx,ny),cl(nl)
real xp(5),yp(5),zc(5),zd1,zd2
integer i,j,i1,i2,j1,k,kl,kk,kb,kp,k0
integer ic(5),jc(5)
logical ldebug
c Indices for the unit cell.
data ic/0,0,1,1,0/
data jc/0,1,1,0,0/
data ldebug/.false./
if(ldebug)then
write(*,*)'x'
write(*,'(10f7.3)')((x(i,j),j=1,min(ny,10)),i=1,nx)
write(*,*)'y'
write(*,'(10f7.3)')((y(i,j),j=1,min(ny,10)),i=1,nx)
write(*,*)'z'
write(*,'(10f7.3)')((z(i,j),j=1,min(ny,10)),i=1,nx)
write(*,*)nx,ny
endif
zd1=nint((x(nx,1)-x(1,1))/10.)
zd2=nint((y(1,ny)-y(1,1))/10.)
c For a cell, find if contour goes through its boundary.
c If so, interpolate for the intersection points and draw.
do 1000 i=1,nx-1
do 2000 j=1,ny-1
zc(1)=z(i,j)
zc(2)=z(i,j+1)
zc(3)=z(i+1,j+1)
zc(4)=z(i+1,j)
zc(5)=zc(1)
do 3000 n=1,nl
zl=cl(n)
kp=0
k0=0
do 2100 k=1,4
zd1=zc(k)-zl
zd2=zl-zc(k+1)
c if(zd1*zd2)2100,9,10
if(zd1*zd2.lt.0.)then
goto 2100
elseif(zd1*zd2.gt.0.)then
goto 10
endif
if(zd2.ne.0)then
goto 2100
else
goto 11
endif
11 if(zd1.eq.0) then
k0=k0+1
goto 2100
endif
10 kp=kp+1
i1=i+ic(k)
i2=i+ic(k+1)
j1=j+jc(k)
j2=j+jc(k+1)
xp(kp)=(x(i1,j1)*zd2+x(i2,j2)*zd1)/(zd1+zd2)
yp(kp)=(y(i1,j1)*zd2+y(i2,j2)*zd1)/(zd1+zd2)
2100 continue
if(kp.gt.1)then
if(kp.eq.2) then
c If this case is standard, less than two double zero segments.
if(k0.lt.2) then
call polyline(xp,yp,kp)
C++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
c Sections to deal with special cases.
elseif (k0.eq.2) then
c Special case of three nodes having z=zl; two double zero segments.
c Join the adjacent nodes.
kl=0
do 2300 kk=1,5
i1=i+ic(kk)
j1=j+jc(kk)
c If this is a zero
if((z(i1,j1)-zl).eq.0) then
c then we have found the next zero
kl=kl+1
xp(mod(kl+1,4)+1)=x(i1,j1)
yp(mod(kl+1,4)+1)=y(i1,j1)
c else this is a nonzero, and if we have already found a zero
elseif(kl.gt.0)then
c then skip and determine the bottom of the polyline.
kl=kl+1
kb=mod(kl+2,4)+1
call polyline(xp(kb),yp(kb),3)
endif
2300 continue
c call polyline(xp(kb),yp(kb),3)
endif
elseif(kp.eq.4) then
c Case of two line-segments in a cell.
c Join the pairs of points that are closest.
if(((xp(1)-xp(2))**2+(yp(1)-yp(2))**2
& +(xp(3)-xp(4))**2+(yp(3)-yp(4))**2).le.
& ((xp(1)-xp(4))**2+(yp(1)-yp(4))**2
& +(xp(2)-xp(3))**2+(yp(2)-yp(3))**2)) then
call polyline(xp,yp,2)
call polyline(xp(3),yp(3),2)
else
xp(5)=xp(1)
yp(5)=yp(1)
call polyline(xp(4),yp(4),2)
call polyline(xp(2),yp(2),2)
endif
else
c Here if kp=3
c Special case of two vertices of the cell having z=zl.
do 2200 k=1,4
zd1=zc(k)-zl
zd2=zl-zc(k+1)
if(zd1*zd2.gt.0) then
c Project across the cell from the side intersection.
i1=i+ic(k)
i2=i+ic(k+1)
j1=j+jc(k)
j2=j+jc(k+1)
xp(1)=(x(i1,j1)*zd2+x(i2,j2)*zd1)/(zd1+zd2)
yp(1)=(y(i1,j1)*zd2+y(i2,j2)*zd1)/(zd1+zd2)
i1=i+ic(mod(k+1,4)+1)
i2=i+ic(mod(k+2,4)+1)
j1=j+jc(mod(k+1,4)+1)
j2=j+jc(mod(k+2,4)+1)
xp(2)=(x(i1,j1)*zd1+x(i2,j2)*zd2)/(zd1+zd2)
yp(2)=(y(i1,j1)*zd1+y(i2,j2)*zd2)/(zd1+zd2)
call polyline(xp,yp,2)
c Join the opposing points.
xp(3)=x(i1,j1)
yp(3)=y(i1,j1)
xp(4)=x(i2,j2)
yp(4)=y(i2,j2)
call polyline(xp(3),yp(3),2)
goto 3100
endif
2200 continue
3100 continue
endif
c End of special sections.
c+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
endif
3000 continue
2000 continue
1000 continue
c call pltend()
return
end