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

DUHUIDUHUI

编译和链接都没有错误，只是在载入ug中时报错说数组超出范围，错误在第48行，已用红色标记
NUMBER/r(3),h(3),bt(3),i,st,stm(3),al,a3,p1,p3
                                           $$1-定义变量
ENTITY/ax,ps1(1001),ps2(1001),m(3),g(3),sl1,$
      sl2,pt(4),pt0(2)
pds1:                                      $$2-生成输入参数的对话框
  r! M1 ^( D* Y5 z    PARAM/'请输入罐体和螺旋线参数:',$
7 x, a8 ]0 }/ U. X, e) K8 n7 p4 S      '前锥小端半径:',r(1),$
      '前锥高度:',h(1),$
      '中柱半径:',r(2),$
      '中柱高度:',h(2),$
0 a  ]2 D$ W( `' Q      '后锥小端半径:',r(3),$
      '后锥高度:',h(3),$
      '前锥螺旋角:',bt(1),$
      '中锥螺旋角:',bt(2),$
# V' x& a0 f; Q1 ?* K      '后锥螺旋角:',bt(3),rsp
   JUMP/pds1:,stop1:,rsp
   ax=LINE/(pt0(1)=POINT/0,0,0),(pt0(2)=POINT/0,0,600)
                                           $$3-生成罐体
! E) ^' A0 z+ Y9 u+ |# L   g(1)=LINE/(pt(1)=POINT/r(1),0,0),(pt(2)=POINT/r(2),0,h(1))
/ s" D2 d5 s$ T& x+ J/ k   g(2)=LINE/pt(2),(pt(3)=POINT/r(2),0,(h(1)+h(2)))
   g(3)=LINE/PT(3),(pt(4)=POINT/r(3),0,(h(1)+h(2)+h(3)))
   m(1)=REVSRF/g(1),AXIS,ax,0,360
2 `' L7 e& M. T   m(2)=REVSRF/g(2),AXIS,ax,0,360
. s' W" J3 I* ~, ?' b; {   m(3)=REVSRF/g(3),AXIS,ax,0,360
   a1=ATANF((r(2)-r(1)/h(1)))          $$4-计算基本参数
2 [, {( R: o- Q% ~8 i( x8 J   a3=ATANF((r(3)-r(2)/h(3)))
. l8 K2 l; s: j  t7 o' o   p1=(r(2)-r(1))/h(1)*COSF(a1)*COSF(bt(1))/SINF(bt(1))
6 O5 Z8 x- a1 y; S   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
1 z4 y2 N+ n1 M+ l   stm(2)=stm(1)+h(2)/r(2)*SINF(bt(2))/cosf(bt(2))
( O7 F9 I8 r+ }% Q1 Y0 |, j   stm(3)=stm(2)+LOGF((r(3)-r(2))/r(2)+1)/p3
   i=1
- e  S5 j9 v* @) p   STR1:                              $$5-计算曲线上点的坐标
   st=(i-1)*stm(3)/1000
  L3 U3 B# M. M  IFTHEN/st<=stm(1)
   xc=r(1)*EXPF(p1*st)*COSF(st*180/3.14159)
   yc=r(1)*EXPF(p1*st)*SINF(st*180/3.14159)
   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)
+ D4 `. d) ?% D: _   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)
   xc=r(2)*EXPF(p3*(st-stm(2)))*COSF(st*180/3.14159)
' v; j! m7 p+ q5 M8 c! [5 ?; c8 S1 j   yc=r(2)*EXPF(p3*(st-stm(2)))*SINF(st*180/3.14159)
  U, N9 `$ i, a" i& v' ?. [& `3 i   zc=r(2)*h(3)/(r(3)-r(2))*(EXPF(p3*(st-stm(2)))-1)+h(1)+h(2)
  ENDIF
8 g0 r1 T  P% y' j   ps1(i)=POINT/xc,yc,zc            $$6-生成螺旋线
   ps2(i)=POINT/-xc,-yc,zc
2 [  J( P8 O6 b  s% P0 ?' J   i=i+1
( M9 }$ C" g& I; U' F+ _  IF/st<=stm(3),JUMP/STR1:
5 C& f$ b& c( n/ L' ]7 H7 Y5 d& S9 u8 ~  sl1=SPLINE/ps1(1..(i-1))
7 j/ f: M% I. s  sl2=SPLINE/ps2(1..(i-1))
# q. X; ]; r! J2 S BLANK/ax,g,pt,pt0,ps1(1..(i-1)),ps1(1..(i-1))
/ u+ |4 f0 c2 r. Q! T+ @  `& z                                       $$结束处理
  stop1:
2 [. E) o+ _* V. O. r: h* t  J7 Q# L   HALT

27699885

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