请各位高手帮忙改一下生成混凝土搅拌车拌筒和螺旋线的GRIP程序的错误

DUHUIDUHUI

编译和链接都没有错误，只是在载入ug中时报错说数组超出范围，错误在第48行，已用红色标记
# p4 ]+ M+ v" m& TNUMBER/r(3),h(3),bt(3),i,st,stm(3),al,a3,p1,p3
                                           $$1-定义变量
+ T- g1 p# {- r0 dENTITY/ax,ps1(1001),ps2(1001),m(3),g(3),sl1,$
      sl2,pt(4),pt0(2)
pds1:                                      $$2-生成输入参数的对话框
6 d; X+ M% a6 V4 a    PARAM/'请输入罐体和螺旋线参数:',$
      '前锥小端半径:',r(1),$
/ a7 h8 S2 z3 q2 q9 X* y5 }      '前锥高度:',h(1),$
      '中柱半径:',r(2),$
, [# O0 Z8 V2 t4 c  Z0 Y! X* p      '中柱高度:',h(2),$
, P2 a; R  Y9 h' s! Q6 B6 v      '后锥小端半径:',r(3),$
      '后锥高度:',h(3),$
: |+ c: t5 s5 ]" g$ n- R' b      '前锥螺旋角:',bt(1),$
1 s8 ]$ ?1 R: y1 t7 _      '中锥螺旋角:',bt(2),$
: x; j+ v/ C3 P5 `; T5 a4 q+ Z      '后锥螺旋角:',bt(3),rsp
; ?, u, }; t4 R) \" \9 V0 C   JUMP/pds1:,stop1:,rsp
6 B( f& f2 v3 ^0 G* u   ax=LINE/(pt0(1)=POINT/0,0,0),(pt0(2)=POINT/0,0,600)
                                           $$3-生成罐体
   g(1)=LINE/(pt(1)=POINT/r(1),0,0),(pt(2)=POINT/r(2),0,h(1))
   g(2)=LINE/pt(2),(pt(3)=POINT/r(2),0,(h(1)+h(2)))
9 x. g* Y! O* W+ ?   g(3)=LINE/PT(3),(pt(4)=POINT/r(3),0,(h(1)+h(2)+h(3)))
6 b% D. }; e  C& \/ C   m(1)=REVSRF/g(1),AXIS,ax,0,360
1 q2 \6 y/ q/ ?   m(2)=REVSRF/g(2),AXIS,ax,0,360
   m(3)=REVSRF/g(3),AXIS,ax,0,360
   a1=ATANF((r(2)-r(1)/h(1)))          $$4-计算基本参数
   a3=ATANF((r(3)-r(2)/h(3)))
   p1=(r(2)-r(1))/h(1)*COSF(a1)*COSF(bt(1))/SINF(bt(1))
7 O; \5 O4 E) |2 F   p3=(r(3)-r(2))/h(3)*COSF(a3)*COSF(bt(3))/SINF(bt(3))
   stm(1)=LOGF((r(2)-r(1))/r(1)+1)/p1
0 t  i7 I0 ?) w   stm(2)=stm(1)+h(2)/r(2)*SINF(bt(2))/cosf(bt(2))
2 k1 w0 R  T+ G6 V5 j   stm(3)=stm(2)+LOGF((r(3)-r(2))/r(2)+1)/p3
  B- G5 N( X0 p) M2 w0 t0 D7 E   i=1
   STR1:                              $$5-计算曲线上点的坐标
- K5 ?( v9 X1 x7 v   st=(i-1)*stm(3)/1000
  IFTHEN/st<=stm(1)
5 z' r& g. N( i" K: L. h+ w* g( B0 o   xc=r(1)*EXPF(p1*st)*COSF(st*180/3.14159)
   yc=r(1)*EXPF(p1*st)*SINF(st*180/3.14159)
% Q  ^8 w  \* C   zc=r(1)*h(1)/(r(2)-r(1))*(EXPF(pl*st)-1)
  ELSEIF/stm(1)<st AND st<=stm(2)
   xc=r(2)*COSF(st*180/3.14159)
8 T" n. T  g$ q  c* }4 p   yc=r(2)*SINF(st*180/3.14159)
   zc=r(2)*COSF(bt(2))/SINF(bt(2))*(st-stm(1))+h(1)
  ELSEIF/stm(2)<st AND st<=stm(3)
, m$ b5 S' b; [; |+ a/ C   xc=r(2)*EXPF(p3*(st-stm(2)))*COSF(st*180/3.14159)
   yc=r(2)*EXPF(p3*(st-stm(2)))*SINF(st*180/3.14159)
   zc=r(2)*h(3)/(r(3)-r(2))*(EXPF(p3*(st-stm(2)))-1)+h(1)+h(2)
" A6 o$ B0 x# K* Q8 j$ F  ENDIF
0 Y" [5 X/ o& Q( H9 v& Q   ps1(i)=POINT/xc,yc,zc            $$6-生成螺旋线
8 W4 G! q: c/ f+ f- b9 ]- c   ps2(i)=POINT/-xc,-yc,zc
   i=i+1
  IF/st<=stm(3),JUMP/STR1:
- A( I2 H) |" d) q  sl1=SPLINE/ps1(1..(i-1))
  sl2=SPLINE/ps2(1..(i-1))
BLANK/ax,g,pt,pt0,ps1(1..(i-1)),ps1(1..(i-1))
                                       $$结束处理
  stop1:
- n3 p  n/ i0 \8 f1 e1 C" n, j   HALT

27699885

亲自测试过这个程序，对数螺旋线grip吧，也曾出现过这问题qq137303928