文字列を延々と歪ませる

文字列（＆画像＆線）を延々と歪ませる　ソースコードをこしらえました。
x'=x , y'=1/(e^(x)+e^(-x))+y　という式を使って　あとは、行列を使って回転移動させたりしただけです。

+ expand sourceview plainprint?

1. #module  
2. #uselib "gdi32.dll"  
3. #func GetTextExtentPoint32 "GetTextExtentPoint32A" int,int,int,int  
4. #deffunc messize var tBuf,array tSize  
5. notesel tBuf  
6. repeat notemax  
7. noteget tBuf2,cnt  
8.  tBuf3=tBuf2  
9.  txtLen=strlen(tBuf3)  
10.  dim tSize,2  
11.  GetTextExtentPoint32 hdc,varptr(tBuf3),txtLen,varptr(tSize)  
12.  if cnt=0:x=tSize(0)  
13.  if x<tSize(0):x=tSize(0)  
14.  loop  
15.  tSize(0)=x  
16.  tSize(1)=tSize(1)*notemax  
17.  return  
18. #global  
19.   
20. #include "hspmath.as"  
21. #define ctype stogx(%1) (( (%1)-offsetx )*(bai)+ginfo_winx/2)  
22. #define ctype stogy(%1) (((%1)-offsety )*(-1.0)*(bai)+ginfo_winy/2)   
23. #define e 2.718281828459045235360287471352   
24. #define pi 3.1415926535897932384626433832795028841971  
25. bai=1.0       //表示倍率  
26. offsetx=0      //表示中心 X  
27. offsety=0      //表示中心 Y  
28. randomize  
29. title "文字列を延々と歪ませる"  
30. onexit *exit  
31. goto *sake  
32. *exit  
33.  end  
34. *sake  
35.   
36. screen 3  
37.   
38. dialog "",16,""  
39. picload refstr,1  
40. skx=-320.0  
41. sky=-240.0  
42. smx=320.0  
43. smy=240.0  
44.   
45. color 255,128,128  
46.   
47. repeat  
48. x+=30  
49. line x,-1,x,ginfo_winy  
50. if x>ginfo_winx:break  
51. loop  
52.   
53. repeat  
54. y+=30  
55. line -1,y,ginfo_winx,y  
56. if y>ginfo_winy:break  
57. loop  
58.   
59.   
60. font "",30  
61.   
62. buf=""  
63.   
64. repeat 8  
65. f=rnd(2)  
66. buf+=strf("%c",f*(rnd(26)+65)+(f!1)*(rnd(26)+97))  
67. loop  
68. messize Buf,textSize  
69.   
70. pos stogx(-textSize(0)/2),stogy(-textSize(1)/2)  
71. color 0,0,0  
72. mes buf  
73.   
74. gsel 0,1  
75.   
76.   
77. repeat   
78.   
79. x_=skx  
80. y_=sky  
81.   
82. ox=1.0*rnd(300)-150  
83. sx=1.0*rnd(60)+5  
84. bx=1.0*rnd(100)+5  
85. rad=1.0*rnd(360)*pi/180  
86.   
87. repeat  
88. x__=x_*cos(rad)-y_*sin(rad)  
89. y__=x_*sin(rad)+y_*cos(rad)  
90. x=x__*cos(rad)+(1.0/(pow(e,(x__-ox)/sx)+pow(e,-(x__-ox)/sx))*bx+y__)*sin(rad)  
91. y=-x__*sin(rad)+(1.0/(pow(e,(x__-ox)/sx)+pow(e,-(x__-ox)/sx))*bx+y__)*cos(rad)  
92.   
93. gsel 3  
94. pget stogx(x),stogy(y)  
95. r=ginfo_r  
96. g=ginfo_g  
97. b=ginfo_b  
98.   
99. gsel 0  
100. color r,g,b  
101. pset stogx(x_),stogy(y_)  
102.   
103. x_+  
104. if x_>=smx:x_=skx:y_+:if y_>=smy:y_=sky:break  
105.   
106. wait 0  
107. loop  
108. gsel 3  
109. gmode 0,640,480,0  
110. pos 0,0  
111. gcopy 0,0,0,640,480  
112.   
113. loop  

#module
#uselib "gdi32.dll"
#func GetTextExtentPoint32 "GetTextExtentPoint32A" int,int,int,int
#deffunc messize var tBuf,array tSize
notesel tBuf
repeat notemax
noteget tBuf2,cnt
 tBuf3=tBuf2
 txtLen=strlen(tBuf3)
 dim tSize,2
 GetTextExtentPoint32 hdc,varptr(tBuf3),txtLen,varptr(tSize)
 if cnt=0:x=tSize(0)
 if x<tSize(0):x=tSize(0)
 loop
 tSize(0)=x
 tSize(1)=tSize(1)*notemax
 return
#global

#include "hspmath.as"
#define ctype stogx(%1) (( (%1)-offsetx )*(bai)+ginfo_winx/2)
#define ctype stogy(%1) (((%1)-offsety )*(-1.0)*(bai)+ginfo_winy/2) 
#define e 2.718281828459045235360287471352 
#define pi 3.1415926535897932384626433832795028841971
bai=1.0       //表示倍率
offsetx=0      //表示中心 X
offsety=0      //表示中心 Y
randomize
title "文字列を延々と歪ませる"
onexit *exit
goto *sake
*exit
 end
*sake

screen 3

dialog "",16,""
picload refstr,1
skx=-320.0
sky=-240.0
smx=320.0
smy=240.0

color 255,128,128

repeat
x+=30
line x,-1,x,ginfo_winy
if x>ginfo_winx:break
loop

repeat
y+=30
line -1,y,ginfo_winx,y
if y>ginfo_winy:break
loop


font "",30

buf=""

repeat 8
f=rnd(2)
buf+=strf("%c",f*(rnd(26)+65)+(f!1)*(rnd(26)+97))
loop
messize Buf,textSize

pos stogx(-textSize(0)/2),stogy(-textSize(1)/2)
color 0,0,0
mes buf

gsel 0,1


repeat 

x_=skx
y_=sky

ox=1.0*rnd(300)-150
sx=1.0*rnd(60)+5
bx=1.0*rnd(100)+5
rad=1.0*rnd(360)*pi/180

repeat
x__=x_*cos(rad)-y_*sin(rad)
y__=x_*sin(rad)+y_*cos(rad)
x=x__*cos(rad)+(1.0/(pow(e,(x__-ox)/sx)+pow(e,-(x__-ox)/sx))*bx+y__)*sin(rad)
y=-x__*sin(rad)+(1.0/(pow(e,(x__-ox)/sx)+pow(e,-(x__-ox)/sx))*bx+y__)*cos(rad)

gsel 3
pget stogx(x),stogy(y)
r=ginfo_r
g=ginfo_g
b=ginfo_b

gsel 0
color r,g,b
pset stogx(x_),stogy(y_)

x_+
if x_>=smx:x_=skx:y_+:if y_>=smy:y_=sky:break

wait 0
loop
gsel 3
gmode 0,640,480,0
pos 0,0
gcopy 0,0,0,640,480

loop

リンクシミュレータ的な？

簡易リンクシミュレータ　なるものをちょいとこしらえました。
データの打ち込みがめんどくさいですけど、　そこそこ　使えるかも（？

+ expand sourceview plainprint?

1. #define POS_X 0  
2. #define POS_Y 1  
3.   
4. #define LINK_LEN_1 2  
5. #define LINK_LEN_2 3  
6.   
7. #define SPEED 8  
8.   
9. #define CENTER_X 2  
10. #define CENTER_Y 3  
11.   
12. #define LINK_1 0  
13. #define LINK_2 1  
14.   
15. #define MODE 3  
16.   
17. #define FREE 0  
18. #define PIN 1  
19. #define MOTOR 2  
20. #define MOTOR_R 3  
21.   
22. #define END_DATA 2  
23.   
24. #define PEN 7  
25. #define ON_ 1  
26. #define OFF_ 0  
27.   
28. #define _MODE data2(id,MODE)  
29. #define _SPEED data1(id,SPEED)  
30. #define _POS_X data1(id,POS_X)  
31. #define _POS_Y data1(id,POS_Y)  
32. #define _CENTER_X data1(id,CENTER_X)  
33. #define _CENTER_Y data1(id,CENTER_Y)  
34. #define _PEN data2(id,PEN)  
35. #define _LINK_1 data2(id,LINK_1)  
36. #define _LINK_2 data2(id,LINK_2)  
37. #define _LINK_1_LEN data2(id,4)=1:data1(id,LINK_LEN_1)  
38. #define _LINK_2_LEN data2(id,9)=1:data1(id,LINK_LEN_2)  
39. #define END_OF_DATA data2(id,END_DATA)=END_DATA  
40.   
41. goto *main  
42. *datum  
43. //////////////////////リンクデータ開始//////////////////////////  
44.   
45.   
46.   
47. name="テオヤンセン リンク"  
48.   
49. id=0  
50.  _MODE=MOTOR_R     //モータを定義する  
51.  _SPEED=10.0     //スピード [DEG per TURN]  
52.    
53.  _POS_X=50.0     //モータ作業点初期位置 X  
54.  _POS_Y=25.0     //モータ作業点初期位置 Y  
55.  _CENTER_X=_POS_X-10   //モータ軸X  
56.  _CENTER_Y=_POS_Y+10   //モータ軸Y  
57.    
58. id=1  
59.  _MODE=PIN      //固定点を定義する  
60.   
61.  _POS_X=0.0      //固定点位置 X  
62.  _POS_Y=0.0     //固定点位置 Y  
63.   
64. id=2  
65.  _MODE=FREE     //自由点を定義する  
66.    
67.  _POS_X=0.0      //自由点初期位置 X  
68.  _POS_Y=50.0     //自由点初期位置 Y  
69.    
70.  _LINK_1=0      //接続される点a   
71.  _LINK_2=1      //接続される点b  
72.   
73. id=3  
74.  _MODE=FREE     //自由点を定義する  
75.    
76.  _POS_X=-50.0     //自由点初期位置 X  
77.  _POS_Y=0.0     //自由点初期位置 Y  
78.    
79.  _LINK_1=2      //接続される点a   
80.  _LINK_2=1      //接続される点b  
81.   
82. id=4  
83.  _MODE=FREE     //自由点を定義する  
84.    
85.  _POS_X=0.0      //自由点初期位置 X  
86.  _POS_Y=-75.0    //自由点初期位置 Y  
87.    
88.  _LINK_1=0      //接続される点a   
89.  _LINK_2=1      //接続される点b  
90.   
91. id=5  
92.  _MODE=FREE     //自由点を定義する  
93.    
94.  _POS_X=-40.0     //自由点初期位置 X  
95.  _POS_Y=-75.0    //自由点初期位置 Y  
96.    
97.  _LINK_1=4      //接続される点a   
98.  _LINK_2=3      //接続される点b  
99.    
100. id=6  
101.  _MODE=FREE     //自由点を定義する  
102.    
103.  _POS_X=0.0      //自由点初期位置 X  
104.  _POS_Y=-75.0-100.0   //自由点初期位置 Y  
105.    
106.  _LINK_1=4     //接続される点a   
107.  _LINK_2=5      //接続される点b  
108.  _PEN=ON_  
109.    
110. id=6  
111.   
112. /*  
113. name="ごく普通のリンク"  
114.   
115. id=0  
116.  _MODE=MOTOR_R     //モータを定義する  
117.  _SPEED=10.0     //スピード [DEG per TURN]  
118.    
119.  _POS_X=0.0   //モータ作業点初期位置 X  
120.  _POS_Y=100.0  //モータ作業点初期位置 Y  
121.  _CENTER_X=0.0    //モータ軸X  
122.  _CENTER_Y=0.0    //モータ軸Y  
123.   
124. id=1  
125.  _MODE=PIN      //固定点を定義する  
126.   
127.  _POS_X=200.0   //固定点位置 X  
128.  _POS_Y=0.0   //固定点位置 Y  
129.   
130. id=2  
131.    
132.  _MODE=FREE     //自由点を定義する  
133.    
134.  _POS_X=200.0   //自由点初期位置 X  
135.  _POS_Y=100.0  //自由点初期位置 Y  
136.    
137.  _LINK_1=0      //接続される点a   
138.  _LINK_1_LEN=200.0   //点aとの距離  
139.  _LINK_2=1      //接続される点b  
140.  _LINK_2_LEN=250.0    //点bとの距離  
141.   
142. id=3  
143.    
144.  _MODE=FREE     //自由点を定義する  
145.    
146.  _POS_X=0.0   //自由点初期位置 X  
147.  _POS_Y=260.0  //自由点初期位置 Y  
148.    
149.  _LINK_1=0      //接続される点a   
150.  _LINK_1_LEN=200.0   //点aとの距離  
151.  _LINK_2=2      //接続される点b  
152.  _LINK_2_LEN=200.0    //点bとの距離  
153.  _PEN=ON_  
154.   
155. id=3  
156. */  
157.    
158. ////////////////////////////////////////////////////////////////  
159. id+  
160.  END_OF_DATA  //終了  
161. id=0  
162. //////////////////////リンクデータ終了//////////////////////////  
163. title "簡易リンクシミュレータ  -"+name+"-"  
164. return  
165.   
166. #define napier 2.718281828459045235360287471352   
167. #define once repeat  
168. #define end_once break %c loop  
169. #define ctype stogx(%1) (( (%1)-offsetx )*(bai)+ginfo_winx/2)  
170. #define ctype stogy(%1) (((%1)-offsety )*(-1.0)*(bai)+ginfo_winy/2)   
171. #define ctype pp(%1) ((%1)*(%1))  
172. #define ctype leng(%1,%2,%3, %4) (sqrt( pp((%1)-(%3))+pp((%2)-(%4))))  
173. #define pi 3.1415926535897932384626433832795028841971  
174. #define mmousex ((ginfo(0)-(ginfo(4)+(ginfo(10)-ginfo(12))/2)))  
175. #define mmousey ((ginfo(1)-(ginfo(5)+(ginfo(11)-ginfo(13))-(ginfo(10)-ginfo(12))/2)))  
176. *hankei  
177.  id=0  
178.  repeat  
179.  if data2(id,2)=2:id=0:break  
180.  if data2(id,3)=0{  
181.   if data2(id,4)=0{  
182.    data1(id,2)=leng(data1(data2(id,0),0),data1(data2(id,0),1),data1(id,0),data1(id,1))  
183.    data2(id,4)=1  
184.   }  
185.   if data2(id,9)=0{  
186.    data1(id,3)=leng(data1(data2(id,1),0),data1(data2(id,1),1),data1(id,0),data1(id,1))  
187.    data2(id,9)=1  
188.   }  
189.  }  
190.  id+  
191.  loop  
192.    
193.  return  
194. *mem  
195.   
196. bai=1.0       //表示倍率  
197. offsetx=0      //表示中心 X  
198. offsety=0      //表示中心 Y  
199.   
200. gsel 3  
201. color  
202. boxf  
203. gsel 0  
204.   
205.   
206.   
207. waku=1  
208. max=16  
209. rate=1  
210. c=4  
211. ddim data1,max,9  
212. dim data2,max,10  
213.   
214. /*  
215. data1  
216.   
217. x  
218. y  
219. r1  
220. r2  
221. rad  
222.   
223. data2  
224.   
225. ID1  
226. ID2  
227. flag  
228.  0 未演算  
229.  1 演算済  
230.  2 エンド  
231. att  
232.  0 自由  
233.  1 固定  
234.  2 モータ  
235. */  
236.   
237.   
238. return  
239.   
240. *draw  
241.  mes_ =""  
242.  repeat  
243.  color 128  
244.  line -1, stogy(0.0),ginfo_winx,stogy(0.0)  
245.  line stogx(0.0), -1,stogx(0.0),ginfo_winy  
246.  if data2(id,2)=2:id=0:break  
247.  data2(id,2)=0  
248.    
249.  if data2(id,3)=2||data2(id,3)=3{  
250.   color 0,128,0  
251.   line stogx(data1(id,0)),stogy(data1(id,1)),stogx(data1(id,2)),stogy(data1(id,3))  
252.  }  
253.  if data2(id,3)=0{  
254.   color 0,0,0  
255.   s1=data2(id,0)  
256.   s2=data2(id,1)  
257.   a1=data1(s1,0)  
258.   b1=data1(s1,1)  
259.   a2=data1(s2,0)  
260.   b2=data1(s2,1)  
261.   muri_lo=0  
262.   muri_lo1=0  
263.   randomize  287465827  
264.   randomize (id+33)*91+90+rnd(354265320)  
265.   du=rnd(256)  
266.   du=rnd(256)  
267.   du=rnd(256)  
268.   aa=rnd(3)  
269.   bb=3;rnd(3)  
270.   r=(rnd(128)+128)*(aa=0||bb=0)  
271.   g=(rnd(128)+128)*(aa=1||bb=1)  
272.   b=(rnd(128)+128)*(aa=2||bb=2)  
273.   if data2(id,6)=1:muri_lo=1  
274.   if data2(id,6)=2:muri_lo=2  
275.   if data2(id,5)=1:color r,g,b:muri_lo1=1  
276.   if data2(id,5)=2:color r,g,b:muri_lo1=2  
277.   line stogx(data1(id,0)),stogy(data1(id,1)),stogx(a1),stogy(b1)  
278.   line stogx(data1(id,0)),stogy(data1(id,1)),stogx(a2),stogy(b2)  
279.     
280.   if muri_lo{   
281.    color r,g,b  
282.    if muri_lo1=1:mes_=""+mes_+"点"+id+" において長さが足りません\n"  
283.    if muri_lo1=2:mes_=""+mes_+"点"+id+" において長すぎです。\n"  
284.    circle stogx(data1(data2(id,0),0)-data1(id,2)),stogy(data1(data2(id,0),1)-data1(id,2)),stogx(data1(data2(id,0),0)+data1(id,2)),stogy(data1(data2(id,0),1)+data1(id,2)),0  
285.    circle stogx(data1(data2(id,1),0)-data1(id,3)),stogy(data1(data2(id,1),1)-data1(id,3)),stogx(data1(data2(id,1),0)+data1(id,3)),stogy(data1(data2(id,1),1)+data1(id,3)),0  
286.   }  
287.  }  
288.  color 255,255,255  
289.  circle stogx(data1(id,0))-c,stogy(data1(id,1))-c,stogx(data1(id,0))+c,stogy(data1(id,1))+c,1  
290.  color 0,0,255  
291.  circle stogx(data1(id,0))-c,stogy(data1(id,1))-c,stogx(data1(id,0))+c,stogy(data1(id,1))+c,0  
292. if data2(id,3)=1{  
293.  color 255,255,255  
294.  circle stogx(data1(id,0))-c,stogy(data1(id,1))-c,stogx(data1(id,0))+c,stogy(data1(id,1))+c,1  
295.  color 255,128,0  
296.  circle stogx(data1(id,0))-c,stogy(data1(id,1))-c,stogx(data1(id,0))+c,stogy(data1(id,1))+c,0  
297. }  
298.    
299. if data2(id,3)=2||data2(id,3)=3{  
300.  color 255,255,255  
301.  circle stogx(data1(id,2))-c,stogy(data1(id,3))-c,stogx(data1(id,2))+c,stogy(data1(id,3))+c,1  
302.  color 0,128,0  
303.  circle stogx(data1(id,2))-c,stogy(data1(id,3))-c,stogx(data1(id,2))+c,stogy(data1(id,3))+c,0  
304.  }  
305.   
306. if pen_flag=1{  
307.  gsel 3  
308.  color  
309.  boxf  
310.  gsel 0  
311.  pen_flag=0  
312. }  
313. if data2(id,PEN)=ON_{  
314.  gsel 3  
315.   randomize  356745267875  
316.   randomize (id+33)*91+90+rnd(654356564)  
317.   du=rnd(256)  
318.   du=rnd(256)  
319.   du=rnd(256)  
320.   du=rnd(256)  
321.   aa=rnd(3)  
322.   bb=4;rnd(3)  
323.   r=(rnd(128)+128)*(aa=0||bb=0)  
324.   g=(rnd(128)+128)*(aa=1||bb=1)  
325.   b=(rnd(128)+128)*(aa=2||bb=2)  
326.   color r,g,b  
327.  if data2(id,8)=0:data2(id,8)=1: data1(id,6)=data1(id,0):data1(id,7)=data1(id,1)  
328.  line stogx(data1(id,6)),stogy(data1(id,7)),stogx(data1(id,0)),stogy(data1(id,1))  
329.  data1(id,6)=data1(id,0):data1(id,7)=data1(id,1)  
330.  gsel 0  
331. }  
332. color 0,0,255  
333.  pos stogx(data1(id,0))+10, stogy(data1(id,1))  
334.  mes id  
335.   
336.  id+  
337.  loop  
338.    
339.  pos 0,0  
340.  gmode 2,800,600  
341.  gcopy 3,0,0,800,600  
342.  color 255,0,0  
343.  pos waku+5,waku+5  
344.  mes mes_  
345.  pos ginfo_winx-120,5  
346.  mes "倍率"+bai  
347.  mes_ =""  
348.  color 0,0,0  
349.  if muri{  
350.   color 255,0,0  
351.  }  
352.    
353.  boxf 0,0,ginfo_winx,waku  
354.  boxf 0,0,waku,ginfo_winy  
355.  boxf 0,ginfo_winy-waku-1,ginfo_winx,ginfo_winy  
356.  boxf ginfo_winx-waku-1,0,ginfo_winx,ginfo_winx  
357.    
358.  return  
359. *main  
360.   
361.    
362.   
363. screen 0,800,600  
364. buffer 3,800,600  
365. gsel 3  
366. color  
367. boxf  
368. gsel 0  
369. onexit *exit  
370. onclick gosub *oncli  
371.   
372.   
373. gosub *mem  
374. gosub *datum  
375. gosub *hankei  
376. id=0  
377. rad=0.0  
378.   
379. pos 0+3,ginfo_winy-21-3  
380. objsize 88,21  
381. button gosub "実行/停止",*strt_  
382. loop_once=1  
383. gosub *mainloop  
384.   
385.   
386. repeat  
387. wait 5  
388. if shutu=1:shutu=0:break  
389. loop  
390. goto *strt  
391. *mainloop  
392.  id=0  
393. repeat  
394.   
395. if data2(id,2)=0{  
396.  once  
397.  if data2(id,3)=2{  
398.   if data2(id,4)=0{  
399.    data2(id,4)=1  
400.    data1(id,4)=sqrt((data1(id,0)-data1(id,2))*(data1(id,0)-data1(id,2))+(data1(id,1)-data1(id,3))*(data1(id,1)-data1(id,3)))  
401.    data1(id,5)=pi+atan((data1(id,0)-data1(id,2)),(data1(id,1)-data1(id,3)))  
402.   }  
403.   r=data1(id,4)  
404.   rad=data1(id,5)  
405.   data1(id,0)=r*cos(rad)+data1(id,2)  
406.   data1(id,1)=r*sin(rad)+data1(id,3)  
407.   data1(id,5)+= pi*data1(id,8)/180.0  
408.   data2(id,2)=1  
409.   hen=1  
410.   break  
411.  }  
412.  if data2(id,3)=3{  
413.   if data2(id,4)=0{  
414.    data2(id,4)=1  
415.    data1(id,4)=sqrt((data1(id,0)-data1(id,2))*(data1(id,0)-data1(id,2))+(data1(id,1)-data1(id,3))*(data1(id,1)-data1(id,3)))  
416.    data1(id,5)=pi+atan((data1(id,0)-data1(id,2)),(data1(id,1)-data1(id,3)))  
417.   }  
418.   r=data1(id,4)  
419.   rad=data1(id,5)  
420.   data1(id,0)=r*cos(rad)+data1(id,2)  
421.   data1(id,1)=r*sin(rad)+data1(id,3)  
422.   data1(id,5)-= pi*data1(id,8)/180.0  
423.   data2(id,2)=1  
424.   hen=1  
425.   break  
426.  }  
427.  if data2(id,3)=0{  
428.   if ((((data2(data2(id,LINK_1),2)=1)|| (data2(data2(id,LINK_1),MODE))=PIN))&&(((data2(data2(id,LINK_2),2)=1)||(data2(data2(id,LINK_2),MODE))=PIN))){  
429.    s1=data2(id,LINK_1)  
430.    s2=data2(id,LINK_2)  
431.    a1=data1(s1,0)  
432.    b1=data1(s1,1)  
433.    a2=data1(s2,0)  
434.    b2=data1(s2,1)  
435.    r1=data1(id,2)  
436.    r2=data1(id,3)  
437.    l=0.0  
438.    l=leng(a1,b1,a2,b2)  
439.    rad_a=atan(sqrt(pp(2.0*r1*l)-pp(pp(r1)+pp(l)-pp(r2))),(pp(r1)+pp(l)-pp(r2)))  
440.    rad_b=atan(b2-b1,a2-a1)  
441.    nuke=0  
442.    iti=data2(id,5)  
443.      
444.    if l>=(r1+r2):muri=1:data2(id,5)=1:data2(id,6)=1:nuke=1:if iti!=1:hen=1  
445.    if abs(r1-r2)>=l:muri=1:data2(id,5)=2:data2(id,6)=2:nuke=1:if iti!=2:hen=1  
446.    if nuke=1:data2(id,2)=1:break  
447.    data2(id,5)=0  
448.      
449.    my1=sin(-rad_a+rad_b)*r1+b1  
450.    mx1=cos(-rad_a+rad_b)*r1+a1  
451.   
452.    my2=sin(rad_a+rad_b)*r1+b1  
453.    mx2=cos(rad_a+rad_b)*r1+a1  
454.     
455.    if leng(mx1,my1,data1(id,0),data1(id,1))<leng(mx2,my2,data1(id,0),data1(id,1)){  
456.     data1(id,0)=mx1  
457.     data1(id,1)=my1  
458.    }else{  
459.     data1(id,0)=mx2  
460.     data1(id,1)=my2  
461.    }  
462.    hen=1  
463.    data2(id,2)=1  
464.    break  
465.   }  
466.  }  
467.  if data2(id,3)=1{  
468.  hen=1  
469.  data2(id,2)=1  
470.  }  
471.  end_once  
472. }  
473.   
474.   
475. if data2(id,2)=2{  
476.  id=0  
477.  if hen=1{  
478.   hen=0:continue  
479.  }else{  
480.   color 255,255,255  
481.   boxf   
482.   color 0,0,0  
483.   gosub *draw  
484.   muri=0  
485.     
486.   redraw 1  
487.   if loop_once:loop_once=0:return  
488.   wait 5  
489.   redraw 0  
490.   mww=mousew  
491. if (mww/120)>0{  
492.  bai*=(1.0+0.5)  
493.  pen_flag=1  
494.  offsetx=1.0*(-ginfo_winx/2+mmousex)/bai/napier+offsetx  
495.  offsety=-1.0*(-ginfo_winy/2+mmousey)/bai/napier+offsety  
496. }  
497.   
498. if (mww/120)<0{  
499.  bai*=(1.0/(1.0+0.5))  
500.  pen_flag=1  
501.  offsetx=-1.0*(-ginfo_winx/2+mmousex)/bai/napier+offsetx  
502.  offsety=1.0*(-ginfo_winy/2+mmousey)/bai/napier+offsety  
503. }  
504. getkey click_,1  
505. if click=1&&click_once=0:click_once=1{  
506.  offsetx_=offsetx  
507.  offsety_=offsety  
508.  mou_x1=mmousex  
509.  mou_y1=mmousey  
510. }  
511.   
512. if click{  
513. pen_flag=1  
514.   
515.  offsetx=-1.0*((mmousex)-mou_x1)/bai+offsetx_  
516.  offsety=1.0*((mmousey)-mou_y1)/bai+offsety_  
517.  ;dialog offsetx  
518. }  
519. if click_=0:click_once=0:click=0{  
520. }  
521.   
522.  continue  
523.  }  
524. }  
525.   
526.   
527. id+  
528. if shutu=1:shutu=0:break  
529. loop  
530. goto *strt  
531.   
532. *strt_  
533.  shutu=1  
534.  return  
535.   
536. *strt  
537.  if switch_=0:switch_=1{  
538.  if obj_make:clrobj obj_id:obj_make=0  
539.  goto *mainloop  
540. }  
541.  switch_=0  
542.  pos 88+3,ginfo_winy-21-3  
543.  objsize 88,21  
544.  button "初期化",*shoki  
545.  obj_id=stat  
546.  obj_make=1  
547.  repeat  
548.  wait 5  
549.  if shutu=1:shutu=0:break  
550.  loop  
551.  goto *strt  
552. *shoki  
553.  id=0  
554.  hen=0  
555.  obj_make=0  
556.  clrobj obj_id  
557.  gosub *mem:gosub *datum:gosub *hankei  
558.  switch_=0  
559.  loop_once=1  
560.  gosub *mainloop  
561.  repeat  
562.  wait 5  
563.  if shutu=1:shutu=0:break  
564.  loop  
565.  goto *strt  
566. *exit  
567.  end  
568. *oncli  
569.  click=1  
570.  return  

#define POS_X 0
#define POS_Y 1

#define LINK_LEN_1 2
#define LINK_LEN_2 3

#define SPEED 8

#define CENTER_X 2
#define CENTER_Y 3

#define LINK_1 0
#define LINK_2 1

#define MODE 3

#define FREE 0
#define PIN 1
#define MOTOR 2
#define MOTOR_R 3

#define END_DATA 2

#define PEN 7
#define ON_ 1
#define OFF_ 0

#define _MODE data2(id,MODE)
#define _SPEED data1(id,SPEED)
#define _POS_X data1(id,POS_X)
#define _POS_Y data1(id,POS_Y)
#define _CENTER_X data1(id,CENTER_X)
#define _CENTER_Y data1(id,CENTER_Y)
#define _PEN data2(id,PEN)
#define _LINK_1 data2(id,LINK_1)
#define _LINK_2 data2(id,LINK_2)
#define _LINK_1_LEN data2(id,4)=1:data1(id,LINK_LEN_1)
#define _LINK_2_LEN data2(id,9)=1:data1(id,LINK_LEN_2)
#define END_OF_DATA data2(id,END_DATA)=END_DATA

goto *main
*datum
//////////////////////リンクデータ開始//////////////////////////



name="テオヤンセン リンク"

id=0
 _MODE=MOTOR_R     //モータを定義する
 _SPEED=10.0     //スピード [DEG per TURN]
 
 _POS_X=50.0     //モータ作業点初期位置 X
 _POS_Y=25.0     //モータ作業点初期位置 Y
 _CENTER_X=_POS_X-10   //モータ軸X
 _CENTER_Y=_POS_Y+10   //モータ軸Y
 
id=1
 _MODE=PIN      //固定点を定義する

 _POS_X=0.0      //固定点位置 X
 _POS_Y=0.0     //固定点位置 Y

id=2
 _MODE=FREE     //自由点を定義する
 
 _POS_X=0.0      //自由点初期位置 X
 _POS_Y=50.0     //自由点初期位置 Y
 
 _LINK_1=0      //接続される点a 
 _LINK_2=1      //接続される点b

id=3
 _MODE=FREE     //自由点を定義する
 
 _POS_X=-50.0     //自由点初期位置 X
 _POS_Y=0.0     //自由点初期位置 Y
 
 _LINK_1=2      //接続される点a 
 _LINK_2=1      //接続される点b

id=4
 _MODE=FREE     //自由点を定義する
 
 _POS_X=0.0      //自由点初期位置 X
 _POS_Y=-75.0    //自由点初期位置 Y
 
 _LINK_1=0      //接続される点a 
 _LINK_2=1      //接続される点b

id=5
 _MODE=FREE     //自由点を定義する
 
 _POS_X=-40.0     //自由点初期位置 X
 _POS_Y=-75.0    //自由点初期位置 Y
 
 _LINK_1=4      //接続される点a 
 _LINK_2=3      //接続される点b
 
id=6
 _MODE=FREE     //自由点を定義する
 
 _POS_X=0.0      //自由点初期位置 X
 _POS_Y=-75.0-100.0   //自由点初期位置 Y
 
 _LINK_1=4     //接続される点a 
 _LINK_2=5      //接続される点b
 _PEN=ON_
 
id=6

/*
name="ごく普通のリンク"

id=0
 _MODE=MOTOR_R     //モータを定義する
 _SPEED=10.0     //スピード [DEG per TURN]
 
 _POS_X=0.0   //モータ作業点初期位置 X
 _POS_Y=100.0  //モータ作業点初期位置 Y
 _CENTER_X=0.0    //モータ軸X
 _CENTER_Y=0.0    //モータ軸Y

id=1
 _MODE=PIN      //固定点を定義する

 _POS_X=200.0   //固定点位置 X
 _POS_Y=0.0   //固定点位置 Y

id=2
 
 _MODE=FREE     //自由点を定義する
 
 _POS_X=200.0   //自由点初期位置 X
 _POS_Y=100.0  //自由点初期位置 Y
 
 _LINK_1=0      //接続される点a 
 _LINK_1_LEN=200.0   //点aとの距離
 _LINK_2=1      //接続される点b
 _LINK_2_LEN=250.0    //点bとの距離

id=3
 
 _MODE=FREE     //自由点を定義する
 
 _POS_X=0.0   //自由点初期位置 X
 _POS_Y=260.0  //自由点初期位置 Y
 
 _LINK_1=0      //接続される点a 
 _LINK_1_LEN=200.0   //点aとの距離
 _LINK_2=2      //接続される点b
 _LINK_2_LEN=200.0    //点bとの距離
 _PEN=ON_

id=3
*/
 
////////////////////////////////////////////////////////////////
id+
 END_OF_DATA  //終了
id=0
//////////////////////リンクデータ終了//////////////////////////
title "簡易リンクシミュレータ  -"+name+"-"
return

#define napier 2.718281828459045235360287471352 
#define once repeat
#define end_once break %c loop
#define ctype stogx(%1) (( (%1)-offsetx )*(bai)+ginfo_winx/2)
#define ctype stogy(%1) (((%1)-offsety )*(-1.0)*(bai)+ginfo_winy/2) 
#define ctype pp(%1) ((%1)*(%1))
#define ctype leng(%1,%2,%3, %4) (sqrt( pp((%1)-(%3))+pp((%2)-(%4))))
#define pi 3.1415926535897932384626433832795028841971
#define mmousex ((ginfo(0)-(ginfo(4)+(ginfo(10)-ginfo(12))/2)))
#define mmousey ((ginfo(1)-(ginfo(5)+(ginfo(11)-ginfo(13))-(ginfo(10)-ginfo(12))/2)))
*hankei
 id=0
 repeat
 if data2(id,2)=2:id=0:break
 if data2(id,3)=0{
  if data2(id,4)=0{
   data1(id,2)=leng(data1(data2(id,0),0),data1(data2(id,0),1),data1(id,0),data1(id,1))
   data2(id,4)=1
  }
  if data2(id,9)=0{
   data1(id,3)=leng(data1(data2(id,1),0),data1(data2(id,1),1),data1(id,0),data1(id,1))
   data2(id,9)=1
  }
 }
 id+
 loop
 
 return
*mem

bai=1.0       //表示倍率
offsetx=0      //表示中心 X
offsety=0      //表示中心 Y

gsel 3
color
boxf
gsel 0



waku=1
max=16
rate=1
c=4
ddim data1,max,9
dim data2,max,10

/*
data1

x
y
r1
r2
rad

data2

ID1
ID2
flag
 0 未演算
 1 演算済
 2 エンド
att
 0 自由
 1 固定
 2 モータ
*/


return

*draw
 mes_ =""
 repeat
 color 128
 line -1, stogy(0.0),ginfo_winx,stogy(0.0)
 line stogx(0.0), -1,stogx(0.0),ginfo_winy
 if data2(id,2)=2:id=0:break
 data2(id,2)=0
 
 if data2(id,3)=2||data2(id,3)=3{
  color 0,128,0
  line stogx(data1(id,0)),stogy(data1(id,1)),stogx(data1(id,2)),stogy(data1(id,3))
 }
 if data2(id,3)=0{
  color 0,0,0
  s1=data2(id,0)
  s2=data2(id,1)
  a1=data1(s1,0)
  b1=data1(s1,1)
  a2=data1(s2,0)
  b2=data1(s2,1)
  muri_lo=0
  muri_lo1=0
  randomize  287465827
  randomize (id+33)*91+90+rnd(354265320)
  du=rnd(256)
  du=rnd(256)
  du=rnd(256)
  aa=rnd(3)
  bb=3;rnd(3)
  r=(rnd(128)+128)*(aa=0||bb=0)
  g=(rnd(128)+128)*(aa=1||bb=1)
  b=(rnd(128)+128)*(aa=2||bb=2)
  if data2(id,6)=1:muri_lo=1
  if data2(id,6)=2:muri_lo=2
  if data2(id,5)=1:color r,g,b:muri_lo1=1
  if data2(id,5)=2:color r,g,b:muri_lo1=2
  line stogx(data1(id,0)),stogy(data1(id,1)),stogx(a1),stogy(b1)
  line stogx(data1(id,0)),stogy(data1(id,1)),stogx(a2),stogy(b2)
  
  if muri_lo{ 
   color r,g,b
   if muri_lo1=1:mes_=""+mes_+"点"+id+" において長さが足りません\n"
   if muri_lo1=2:mes_=""+mes_+"点"+id+" において長すぎです。\n"
   circle stogx(data1(data2(id,0),0)-data1(id,2)),stogy(data1(data2(id,0),1)-data1(id,2)),stogx(data1(data2(id,0),0)+data1(id,2)),stogy(data1(data2(id,0),1)+data1(id,2)),0
   circle stogx(data1(data2(id,1),0)-data1(id,3)),stogy(data1(data2(id,1),1)-data1(id,3)),stogx(data1(data2(id,1),0)+data1(id,3)),stogy(data1(data2(id,1),1)+data1(id,3)),0
  }
 }
 color 255,255,255
 circle stogx(data1(id,0))-c,stogy(data1(id,1))-c,stogx(data1(id,0))+c,stogy(data1(id,1))+c,1
 color 0,0,255
 circle stogx(data1(id,0))-c,stogy(data1(id,1))-c,stogx(data1(id,0))+c,stogy(data1(id,1))+c,0
if data2(id,3)=1{
 color 255,255,255
 circle stogx(data1(id,0))-c,stogy(data1(id,1))-c,stogx(data1(id,0))+c,stogy(data1(id,1))+c,1
 color 255,128,0
 circle stogx(data1(id,0))-c,stogy(data1(id,1))-c,stogx(data1(id,0))+c,stogy(data1(id,1))+c,0
}
 
if data2(id,3)=2||data2(id,3)=3{
 color 255,255,255
 circle stogx(data1(id,2))-c,stogy(data1(id,3))-c,stogx(data1(id,2))+c,stogy(data1(id,3))+c,1
 color 0,128,0
 circle stogx(data1(id,2))-c,stogy(data1(id,3))-c,stogx(data1(id,2))+c,stogy(data1(id,3))+c,0
 }

if pen_flag=1{
 gsel 3
 color
 boxf
 gsel 0
 pen_flag=0
}
if data2(id,PEN)=ON_{
 gsel 3
  randomize  356745267875
  randomize (id+33)*91+90+rnd(654356564)
  du=rnd(256)
  du=rnd(256)
  du=rnd(256)
  du=rnd(256)
  aa=rnd(3)
  bb=4;rnd(3)
  r=(rnd(128)+128)*(aa=0||bb=0)
  g=(rnd(128)+128)*(aa=1||bb=1)
  b=(rnd(128)+128)*(aa=2||bb=2)
  color r,g,b
 if data2(id,8)=0:data2(id,8)=1: data1(id,6)=data1(id,0):data1(id,7)=data1(id,1)
 line stogx(data1(id,6)),stogy(data1(id,7)),stogx(data1(id,0)),stogy(data1(id,1))
 data1(id,6)=data1(id,0):data1(id,7)=data1(id,1)
 gsel 0
}
color 0,0,255
 pos stogx(data1(id,0))+10, stogy(data1(id,1))
 mes id

 id+
 loop
 
 pos 0,0
 gmode 2,800,600
 gcopy 3,0,0,800,600
 color 255,0,0
 pos waku+5,waku+5
 mes mes_
 pos ginfo_winx-120,5
 mes "倍率"+bai
 mes_ =""
 color 0,0,0
 if muri{
  color 255,0,0
 }
 
 boxf 0,0,ginfo_winx,waku
 boxf 0,0,waku,ginfo_winy
 boxf 0,ginfo_winy-waku-1,ginfo_winx,ginfo_winy
 boxf ginfo_winx-waku-1,0,ginfo_winx,ginfo_winx
 
 return
*main

 

screen 0,800,600
buffer 3,800,600
gsel 3
color
boxf
gsel 0
onexit *exit
onclick gosub *oncli


gosub *mem
gosub *datum
gosub *hankei
id=0
rad=0.0

pos 0+3,ginfo_winy-21-3
objsize 88,21
button gosub "実行/停止",*strt_
loop_once=1
gosub *mainloop


repeat
wait 5
if shutu=1:shutu=0:break
loop
goto *strt
*mainloop
 id=0
repeat

if data2(id,2)=0{
 once
 if data2(id,3)=2{
  if data2(id,4)=0{
   data2(id,4)=1
   data1(id,4)=sqrt((data1(id,0)-data1(id,2))*(data1(id,0)-data1(id,2))+(data1(id,1)-data1(id,3))*(data1(id,1)-data1(id,3)))
   data1(id,5)=pi+atan((data1(id,0)-data1(id,2)),(data1(id,1)-data1(id,3)))
  }
  r=data1(id,4)
  rad=data1(id,5)
  data1(id,0)=r*cos(rad)+data1(id,2)
  data1(id,1)=r*sin(rad)+data1(id,3)
  data1(id,5)+= pi*data1(id,8)/180.0
  data2(id,2)=1
  hen=1
  break
 }
 if data2(id,3)=3{
  if data2(id,4)=0{
   data2(id,4)=1
   data1(id,4)=sqrt((data1(id,0)-data1(id,2))*(data1(id,0)-data1(id,2))+(data1(id,1)-data1(id,3))*(data1(id,1)-data1(id,3)))
   data1(id,5)=pi+atan((data1(id,0)-data1(id,2)),(data1(id,1)-data1(id,3)))
  }
  r=data1(id,4)
  rad=data1(id,5)
  data1(id,0)=r*cos(rad)+data1(id,2)
  data1(id,1)=r*sin(rad)+data1(id,3)
  data1(id,5)-= pi*data1(id,8)/180.0
  data2(id,2)=1
  hen=1
  break
 }
 if data2(id,3)=0{
  if ((((data2(data2(id,LINK_1),2)=1)|| (data2(data2(id,LINK_1),MODE))=PIN))&&(((data2(data2(id,LINK_2),2)=1)||(data2(data2(id,LINK_2),MODE))=PIN))){
   s1=data2(id,LINK_1)
   s2=data2(id,LINK_2)
   a1=data1(s1,0)
   b1=data1(s1,1)
   a2=data1(s2,0)
   b2=data1(s2,1)
   r1=data1(id,2)
   r2=data1(id,3)
   l=0.0
   l=leng(a1,b1,a2,b2)
   rad_a=atan(sqrt(pp(2.0*r1*l)-pp(pp(r1)+pp(l)-pp(r2))),(pp(r1)+pp(l)-pp(r2)))
   rad_b=atan(b2-b1,a2-a1)
   nuke=0
   iti=data2(id,5)
   
   if l>=(r1+r2):muri=1:data2(id,5)=1:data2(id,6)=1:nuke=1:if iti!=1:hen=1
   if abs(r1-r2)>=l:muri=1:data2(id,5)=2:data2(id,6)=2:nuke=1:if iti!=2:hen=1
   if nuke=1:data2(id,2)=1:break
   data2(id,5)=0
   
   my1=sin(-rad_a+rad_b)*r1+b1
   mx1=cos(-rad_a+rad_b)*r1+a1

   my2=sin(rad_a+rad_b)*r1+b1
   mx2=cos(rad_a+rad_b)*r1+a1
  
   if leng(mx1,my1,data1(id,0),data1(id,1))<leng(mx2,my2,data1(id,0),data1(id,1)){
    data1(id,0)=mx1
    data1(id,1)=my1
   }else{
    data1(id,0)=mx2
    data1(id,1)=my2
   }
   hen=1
   data2(id,2)=1
   break
  }
 }
 if data2(id,3)=1{
 hen=1
 data2(id,2)=1
 }
 end_once
}


if data2(id,2)=2{
 id=0
 if hen=1{
  hen=0:continue
 }else{
  color 255,255,255
  boxf 
  color 0,0,0
  gosub *draw
  muri=0
  
  redraw 1
  if loop_once:loop_once=0:return
  wait 5
  redraw 0
  mww=mousew
if (mww/120)>0{
 bai*=(1.0+0.5)
 pen_flag=1
 offsetx=1.0*(-ginfo_winx/2+mmousex)/bai/napier+offsetx
 offsety=-1.0*(-ginfo_winy/2+mmousey)/bai/napier+offsety
}

if (mww/120)<0{
 bai*=(1.0/(1.0+0.5))
 pen_flag=1
 offsetx=-1.0*(-ginfo_winx/2+mmousex)/bai/napier+offsetx
 offsety=1.0*(-ginfo_winy/2+mmousey)/bai/napier+offsety
}
getkey click_,1
if click=1&&click_once=0:click_once=1{
 offsetx_=offsetx
 offsety_=offsety
 mou_x1=mmousex
 mou_y1=mmousey
}

if click{
pen_flag=1

 offsetx=-1.0*((mmousex)-mou_x1)/bai+offsetx_
 offsety=1.0*((mmousey)-mou_y1)/bai+offsety_
 ;dialog offsetx
}
if click_=0:click_once=0:click=0{
}

 continue
 }
}


id+
if shutu=1:shutu=0:break
loop
goto *strt

*strt_
 shutu=1
 return

*strt
 if switch_=0:switch_=1{
 if obj_make:clrobj obj_id:obj_make=0
 goto *mainloop
}
 switch_=0
 pos 88+3,ginfo_winy-21-3
 objsize 88,21
 button "初期化",*shoki
 obj_id=stat
 obj_make=1
 repeat
 wait 5
 if shutu=1:shutu=0:break
 loop
 goto *strt
*shoki
 id=0
 hen=0
 obj_make=0
 clrobj obj_id
 gosub *mem:gosub *datum:gosub *hankei
 switch_=0
 loop_once=1
 gosub *mainloop
 repeat
 wait 5
 if shutu=1:shutu=0:break
 loop
 goto *strt
*exit
 end
*oncli
 click=1
 return