AFsoft World

// リンクその３（改）
//　リンク２の終点に制限を入れる事を考えます
//　リンク１の位置Yと同じになるようにします
//　　＝リンク２の角度を算出
#VAR
　dmy1 = "---リンク(1)---"　　;dmy1
　px1 = 0　　　　;*位置X
　py1 = 0　　　　;*位置Y
　pa1 = 0　　　　;*角度[°]＿＿TR:0,360
　ll1 =50　　　　;*リンク長さ＿＿TR:0,500
　lw1 =10　　　　;*リンク幅＿＿TR:0,300
　dmy2 = "---リンク(2)---"　　;dmy2
　px2　　　　　　;位置X
　py2　　　　　　;位置Y
　pa2　　　　　　;角度[°]
　ll2 =80　　　　;*リンク長さ＿＿TR:0,500
　lw2 =15　　　　;*リンク幅＿＿TR:0,300
　// 作業用
　no
　px
　py
　ll
　lw
　pan
　w1
　w2
　w3
　w4
　w5
　w6
　w7
　w8

#DRAW
　LAYER SetLineLay1　　// 外形線
　PEN SetLineCol1,SetLineLtp1,SetLineWid1

　CAL　no = 1
　CAL　pan = pa1/180.0*PI
　CAL　px = px1
　CAL　py = py1
　CAL　ll = ll1
　CAL　lw = lw1
　#GOTO *LINKDRAW
*RET1
　CAL　w1 = ll1*Sin(pan)
　CAL　w2 = ASIN(w1/ll2)
　CAL　w3 = -(pan + w2)
　CAL　pa2 = w3*180.0/PI

　CAL　no = 2
　CAL　px2 = px1 + ll1*Cos(pan)
　CAL　py2 = py1 + ll1*Sin(pan)
　CAL　pan = (pa1+pa2)/180.0*PI
　CAL　px = px2
　CAL　py = py2
　CAL　ll = ll2
　CAL　lw = lw2
　#GOTO *LINKDRAW
*RET2
　#EXIT


// リンク１本を作図
//　　no = 1、2
*LINKDRAW
　CAL　w1 = px
　CAL　w2 = py
　CAL　w3 = lw/2.0
　CAL　w4 = pan + 0.5*PI
　CAL　w5 = pan + 1.5*PI
　ARC　w1,w2,w3,w4,w5

　CAL　w1 = px
　CAL　w2 = py + lw/2.0
　CAL　w3 = px + ll
　CAL　w4 = w2
　GETREV　w5,w6, w1,w2,px,py,pan
　GETREV　w7,w8, w3,w4,px,py,pan
　LINE　w5,w6,w7,w8

　CAL　w1 = px
　CAL　w2 = py - lw/2.0
　CAL　w3 = px + ll
　CAL　w4 = w2
　GETREV　w5,w6, w1,w2,px,py,pan
　GETREV　w7,w8, w3,w4,px,py,pan
　LINE　w5,w6,w7,w8

　CAL　w3 = px + ll
　CAL　w4 = py
　GETREV　w1,w2, w3,w4,px,py,pan
　CAL　w3 = lw/2.0
　CAL　w4 = pan + 1.5*PI
　CAL　w5 = pan + 0.5*PI
　ARC　w1,w2,w3,w4,w5

　#IF ( no == 1 )
　　#GOTO　*RET1
　#END
　#GOTO　*RET2