Last modified by nozzin on 2024/02/26 09:16

From version 1.1
edited by Mora Zhou
on 2024/02/23 11:20
Change comment: There is no comment for this version
To version 6.1
edited by Mora Zhou
on 2024/02/23 13:44
Change comment: There is no comment for this version

Summary

Details

Page properties
Content
... ... @@ -1,2 +1,200 @@
1 += 1 Introduction =
1 1  
3 +This project uses Wecon Codesys PLC LX6C and bus type servo VD3E for delta robot control. Through simple debugging, the point-to-point interpolation motion of the delta robot is realized.
2 2  
5 += 2 Main kit composition =
6 +
7 +(% style="text-align:center" %)
8 +[[image:1708658466693-778.png]]
9 +
10 +(% style="margin-left:auto; margin-right:auto" %)
11 +|(% style="width:799px" %)(((
12 +(% style="text-align:center" %)
13 +(((
14 +(% style="display:inline-block; width:334px;" %)
15 +[[==== **LX6C** ====>>image:1708658932564-782.png||height="319" width="334"]]
16 +)))
17 +)))|(% style="width:823px" %)(((
18 +(% style="text-align:center" %)
19 +(((
20 +(% style="display:inline-block; width:513px;" %)
21 +[[==== **VD3E Servo** ====>>image:1708666409644-249.png||height="289" width="513"]]
22 +)))
23 +)))
24 +
25 +(% style="margin-left:auto; margin-right:auto" %)
26 +|=(% style="width: 801px;" %)NAME|=(% style="width: 821px;" %)QUANTITY
27 +|(% style="width:801px" %)LX6C-0808MT-DD|(% style="width:821px" %)1
28 +|(% style="width:801px" %)VD3E-014SA1G|(% style="width:821px" %)3
29 +|(% style="width:801px" %)WE80M-07530S-A1F|(% style="width:821px" %)3
30 +|(% style="width:801px" %)Upper arm|(% style="width:821px" %)3
31 +|(% style="width:801px" %)Lower arm|(% style="width:821px" %)6
32 +|(% style="width:801px" %)Motor shaft connector|(% style="width:821px" %)3
33 +|(% style="width:801px" %)Top plate|(% style="width:821px" %)1
34 +|(% style="width:801px" %)Tool plate|(% style="width:821px" %)1
35 +|(% style="width:801px" %)Hexagon socket screws|(% style="width:821px" %)6 (M4 and M5)
36 +
37 += 3 Mechanical parameters =
38 +
39 +[[image:1708659158007-639.png||style="float:left"]][[image:1708659191216-488.png||style="float:left"]][[image:1708659202564-503.png]]
40 +
41 +Length of the upper arm **d1**: 330mm
42 +
43 +Length of the lower arm **d2**: 600mm
44 +
45 +Distance between lower arm in one pair **d3**: 20mm
46 +
47 +Radius of circle where lower arm contact point is located **r1**: 50mm
48 +
49 +Radius of circle where motor shaft is located **r2**: 100mm
50 +
51 +Maximum angle in ± for ball joints: 60°
52 +
53 += 4 Program preparation =
54 +
55 +== 4.1 Language settings ==
56 +
57 +Select “Tools”~-~->“Options”
58 +
59 +(% style="text-align:center" %)
60 +[[image:1708659282790-309.png]]
61 +
62 +
63 +Set software language in “International Settings”
64 +
65 +(% style="text-align:center" %)
66 +[[image:1708659276549-637.png]]
67 +
68 +== 4.2 Device file import ==
69 +
70 +Select “Tools“~-~->“Device Repository“
71 +
72 +(% style="text-align:center" %)
73 +[[image:1708659330267-186.png]]
74 +
75 +Install LX6C xml file.
76 +
77 +(% style="text-align:center" %)
78 +[[image:1708659348892-129.png]]
79 +
80 +Install VD3E xml file.
81 +
82 +(% style="text-align:center" %)
83 +[[image:1708659363849-556.png]]
84 +
85 +
86 +|(((
87 +(% style="text-align:center" %)
88 +[[image:1708666791453-744.png]]
89 +)))|(((
90 +(% style="text-align:center" %)
91 +[[image:1708666805375-462.png]]
92 +)))
93 +
94 +
95 +
96 += 5 Device connection =
97 +
98 +== 5.1 New project ==
99 +
100 +Create a new standard project
101 +
102 +(% style="text-align:center" %)
103 +[[image:1708659481680-311.png]]
104 +
105 +Select device and programming language
106 +
107 +(% style="text-align:center" %)
108 +[[image:1708659504171-928.png]]
109 +
110 +== 5.2 Connect LX6C ==
111 +
112 +Double click “Device” and select Scan Network
113 +
114 +Select LX6C and click OK, make sure your PC and LX6C in the same LAN (LX6C default IP is 192.168.8.8)
115 +
116 +(% style="text-align:center" %)
117 +[[image:1708659630178-665.png]]
118 +
119 +Login device with account and password
120 +
121 +(% style="text-align:center" %)
122 +[[image:1708659646762-832.png]]
123 +
124 +
125 += 6 Project configuration =
126 +
127 +== 6.1 Add Axis Group ==
128 +
129 +Right click Application, “Add Object” and select “Axis Group”
130 +
131 +
132 +(% style="text-align:center" %)
133 +[[image:1708659668179-463.png]]
134 +
135 +Click “Select Kinematics” and select “TRAFO.Kin_Tripod_Rotary”
136 +
137 +(% style="text-align:center" %)
138 +[[image:1708659683686-935.png]]
139 +
140 +Fill in the mechanical parameters (Use the same user units)
141 +
142 +(% style="text-align:center" %)
143 +[[image:1708659724005-484.png]]
144 +
145 +Right click “Device” and add device
146 +
147 +(% style="text-align:center" %)
148 +[[image:1708659738998-621.png]]
149 +
150 +Add “EtherCAT Master SoftMotion”
151 +
152 +(% style="text-align:center" %)
153 +[[image:1708659810951-477.png]]
154 +
155 +Right click “EtherCAT_Master_SoftMotion” and add device, select “Wecon VD3E EtherCAT Servo_v1.10” (Servo xml file should be same with servo firmware, you can check servo firmware in U2-04 through servo panel)
156 +
157 +(% style="text-align:center" %)
158 +[[image:1708659837241-566.png]]
159 +
160 +
161 +(% style="text-align:center" %)
162 +[[image:1708659844978-946.png]]
163 +
164 +Add 3 motion axis
165 +
166 +(% style="text-align:center" %)
167 +[[image:1708659868961-294.png]]
168 +
169 +Set the correct resolution based on the motor encoder
170 +
171 +(% style="text-align:center" %)
172 +[[image:1708659882131-694.png]]
173 +
174 +Double click “EtherCAT_Master_SoftMotion” and select network name “eth1” in “General”
175 +
176 +(% style="text-align:center" %)
177 +[[image:1708659902425-597.png]]
178 +
179 +Bind axis to robot.
180 +
181 +(% style="text-align:center" %)
182 +[[image:1708659921571-879.png]]
183 +
184 +Move “PLC_PRG” from “MainTask” to “EtherCAT_Task”
185 +
186 +(% style="text-align:center" %)
187 +[[image:1708660033766-909.png]]
188 +
189 +(% style="text-align:center" %)
190 +[[image:1708660038539-524.png]]
191 +
192 +== 6.2 Demo program ==
193 +
194 +Build a simple program for absolute move
195 +
196 +(% style="text-align:center" %)
197 +[[image:1708660054738-287.png]]
198 +
199 +(% style="text-align:center" %)
200 +[[image:1708660060148-798.png]]
1708658466693-778.png
Author
... ... @@ -1,0 +1,1 @@
1 +XWiki.Mora
Size
... ... @@ -1,0 +1,1 @@
1 +737.5 KB
Content
1708658513710-135.png
Author
... ... @@ -1,0 +1,1 @@
1 +XWiki.Mora
Size
... ... @@ -1,0 +1,1 @@
1 +55.1 KB
Content
1708658523058-160.png
Author
... ... @@ -1,0 +1,1 @@
1 +XWiki.Mora
Size
... ... @@ -1,0 +1,1 @@
1 +34.4 KB
Content
1708658729658-347.png
Author
... ... @@ -1,0 +1,1 @@
1 +XWiki.Mora
Size
... ... @@ -1,0 +1,1 @@
1 +34.4 KB
Content
1708658804795-796.png
Author
... ... @@ -1,0 +1,1 @@
1 +XWiki.Mora
Size
... ... @@ -1,0 +1,1 @@
1 +34.4 KB
Content
1708658932564-782.png
Author
... ... @@ -1,0 +1,1 @@
1 +XWiki.Mora
Size
... ... @@ -1,0 +1,1 @@
1 +55.1 KB
Content
1708658950128-652.png
Author
... ... @@ -1,0 +1,1 @@
1 +XWiki.Mora
Size
... ... @@ -1,0 +1,1 @@
1 +34.4 KB
Content
1708659114097-405.png
Author
... ... @@ -1,0 +1,1 @@
1 +XWiki.Mora
Size
... ... @@ -1,0 +1,1 @@
1 +37.3 KB
Content
1708659158007-639.png
Author
... ... @@ -1,0 +1,1 @@
1 +XWiki.Mora
Size
... ... @@ -1,0 +1,1 @@
1 +37.3 KB
Content
1708659168917-262.png
Author
... ... @@ -1,0 +1,1 @@
1 +XWiki.Mora
Size
... ... @@ -1,0 +1,1 @@
1 +41.4 KB
Content
1708659191216-488.png
Author
... ... @@ -1,0 +1,1 @@
1 +XWiki.Mora
Size
... ... @@ -1,0 +1,1 @@
1 +41.4 KB
Content
1708659202564-503.png
Author
... ... @@ -1,0 +1,1 @@
1 +XWiki.Mora
Size
... ... @@ -1,0 +1,1 @@
1 +34.9 KB
Content
1708659222231-551.png
Author
... ... @@ -1,0 +1,1 @@
1 +XWiki.Mora
Size
... ... @@ -1,0 +1,1 @@
1 +136.5 KB
Content
1708659276549-637.png
Author
... ... @@ -1,0 +1,1 @@
1 +XWiki.Mora
Size
... ... @@ -1,0 +1,1 @@
1 +187.9 KB
Content
1708659282790-309.png
Author
... ... @@ -1,0 +1,1 @@
1 +XWiki.Mora
Size
... ... @@ -1,0 +1,1 @@
1 +136.5 KB
Content
1708659330267-186.png
Author
... ... @@ -1,0 +1,1 @@
1 +XWiki.Mora
Size
... ... @@ -1,0 +1,1 @@
1 +168.0 KB
Content
1708659348892-129.png
Author
... ... @@ -1,0 +1,1 @@
1 +XWiki.Mora
Size
... ... @@ -1,0 +1,1 @@
1 +75.5 KB
Content
1708659363849-556.png
Author
... ... @@ -1,0 +1,1 @@
1 +XWiki.Mora
Size
... ... @@ -1,0 +1,1 @@
1 +91.0 KB
Content
1708659372629-274.png
Author
... ... @@ -1,0 +1,1 @@
1 +XWiki.Mora
Size
... ... @@ -1,0 +1,1 @@
1 +64.7 KB
Content
1708659390655-234.png
Author
... ... @@ -1,0 +1,1 @@
1 +XWiki.Mora
Size
... ... @@ -1,0 +1,1 @@
1 +52.4 KB
Content
1708659481680-311.png
Author
... ... @@ -1,0 +1,1 @@
1 +XWiki.Mora
Size
... ... @@ -1,0 +1,1 @@
1 +150.2 KB
Content
1708659504171-928.png
Author
... ... @@ -1,0 +1,1 @@
1 +XWiki.Mora
Size
... ... @@ -1,0 +1,1 @@
1 +89.9 KB
Content
1708659630178-665.png
Author
... ... @@ -1,0 +1,1 @@
1 +XWiki.Mora
Size
... ... @@ -1,0 +1,1 @@
1 +108.0 KB
Content
1708659646762-832.png
Author
... ... @@ -1,0 +1,1 @@
1 +XWiki.Mora
Size
... ... @@ -1,0 +1,1 @@
1 +63.7 KB
Content
1708659668179-463.png
Author
... ... @@ -1,0 +1,1 @@
1 +XWiki.Mora
Size
... ... @@ -1,0 +1,1 @@
1 +193.0 KB
Content
1708659683686-935.png
Author
... ... @@ -1,0 +1,1 @@
1 +XWiki.Mora
Size
... ... @@ -1,0 +1,1 @@
1 +193.4 KB
Content
1708659724005-484.png
Author
... ... @@ -1,0 +1,1 @@
1 +XWiki.Mora
Size
... ... @@ -1,0 +1,1 @@
1 +166.8 KB
Content
1708659738998-621.png
Author
... ... @@ -1,0 +1,1 @@
1 +XWiki.Mora
Size
... ... @@ -1,0 +1,1 @@
1 +66.5 KB
Content
1708659810951-477.png
Author
... ... @@ -1,0 +1,1 @@
1 +XWiki.Mora
Size
... ... @@ -1,0 +1,1 @@
1 +39.2 KB
Content
1708659837241-566.png
Author
... ... @@ -1,0 +1,1 @@
1 +XWiki.Mora
Size
... ... @@ -1,0 +1,1 @@
1 +56.6 KB
Content
1708659844978-946.png
Author
... ... @@ -1,0 +1,1 @@
1 +XWiki.Mora
Size
... ... @@ -1,0 +1,1 @@
1 +28.6 KB
Content
1708659868961-294.png
Author
... ... @@ -1,0 +1,1 @@
1 +XWiki.Mora
Size
... ... @@ -1,0 +1,1 @@
1 +77.4 KB
Content
1708659882131-694.png
Author
... ... @@ -1,0 +1,1 @@
1 +XWiki.Mora
Size
... ... @@ -1,0 +1,1 @@
1 +140.8 KB
Content
1708659902425-597.png
Author
... ... @@ -1,0 +1,1 @@
1 +XWiki.Mora
Size
... ... @@ -1,0 +1,1 @@
1 +114.9 KB
Content
1708659921571-879.png
Author
... ... @@ -1,0 +1,1 @@
1 +XWiki.Mora
Size
... ... @@ -1,0 +1,1 @@
1 +124.2 KB
Content
1708660033766-909.png
Author
... ... @@ -1,0 +1,1 @@
1 +XWiki.Mora
Size
... ... @@ -1,0 +1,1 @@
1 +61.3 KB
Content
1708660038539-524.png
Author
... ... @@ -1,0 +1,1 @@
1 +XWiki.Mora
Size
... ... @@ -1,0 +1,1 @@
1 +56.1 KB
Content
1708660054738-287.png
Author
... ... @@ -1,0 +1,1 @@
1 +XWiki.Mora
Size
... ... @@ -1,0 +1,1 @@
1 +92.8 KB
Content
1708660060148-798.png
Author
... ... @@ -1,0 +1,1 @@
1 +XWiki.Mora
Size
... ... @@ -1,0 +1,1 @@
1 +84.8 KB
Content
1708666409644-249.png
Author
... ... @@ -1,0 +1,1 @@
1 +XWiki.Mora
Size
... ... @@ -1,0 +1,1 @@
1 +6.0 MB
Content
1708666791453-744.png
Author
... ... @@ -1,0 +1,1 @@
1 +XWiki.Mora
Size
... ... @@ -1,0 +1,1 @@
1 +64.7 KB
Content
1708666805375-462.png
Author
... ... @@ -1,0 +1,1 @@
1 +XWiki.Mora
Size
... ... @@ -1,0 +1,1 @@
1 +52.4 KB
Content