位移约束求解

fujiande

大家来围观我的错误吧，并请教！
位移约束如下：
/solu

*DO,I,0,25.5,0.5
d,1,ux,0,,,,uy,uz,rotx,roty    !施加载荷和约束
d,7,ux,0,,,,uy,uz,rotx,roty
d,26,ux,0,,,,uy,uz,rotx,roty
d,29,ux,0,,,,uy,uz,rotx,roty
d,4,uz,0,,,,rotx,roty        
f,5,fy,-hweight
cp,,all,3,32
cp,,all,9,34
cp,,all,13,25
cp,,all,15,28
cp,,all,35,44
cp,,all,36,40                              
w1=((v/r)/pi)*180
w=(ang3-ang1)/((hr-hrx)*60/vz/1000)  
ang1=ang1+w*I
BLL=sqrt(bch**2+bcl**2)
XL=BLL*cos(ang1)
YL=BLL*sin(ang1)
b=atan((cy-y0)/(cx-x0))
x=r*cos(w1*I+b)+x0
y=r*sin(w1*I+b)+y0
BB=atan((YL-y)/(XL-x))
xx=v*I*cos(atan(BB))
yy=v*I*sin(atan(BB))                             
                              
d,4,ux,xx,,,,rotx,roty
d,4,uy,yy,,,,rotx,roty
SOLVE
*ENDDO

本意是在一个时间段内连续动态运行节点4，却是有错误！还请大侠们不吝赐教。v和r为常数值，ang1初值为常数。

fujiande

补充的图形

fujiande

/solu

ALLSEL
ANTYPE,static  
TRNOPT,FULL
TIMINT,OFF
NLGEOM,OFF
TIME,1E-8
NSUBST,2
KBC,1
Acel,0,9.8e3,0
SOLVE
TIMINT,ON
TIM=0
DELE=1



*DO,I,0,25.5,0.5
TIM=TIM+1
TIME,TIM

                              

w1=((v/r)/pi)*180
w=(ang3-ang1)/((hr-hrx)*60/vz/1000)  
ang1=ang1+w*I
BLL=sqrt(bch**2+bcl**2)
XL=BLL*cos(ang1)
YL=BLL*sin(ang1)
b=atan((cy-y0)/(cx-x0))
x=r*cos(w1*I+b)+x0
y=r*sin(w1*I+b)+y0
BB=atan((YL-y)/(XL-x))
                           
                              
d,4,ux,v*I*cos(atan(BB)),,,,rotx,roty   !施加载荷和约束
d,4,uy,v*I*sin(atan(BB)),,,,rotx,roty




ALLSEL
NSUBST,1
OUTRES,ALL,ALL
SOLVE
*ENDDO
命令流修改上。仍然是有点问题，望高手解答！