Cánh tay#
Giới thiệu#
Cánh tay robot 6 trục là một thiết bị thao tác robot được sử dụng trong CTE Workcell. Trong VEXcode EXP, các khối lệnh Arm cho phép EXP Brain di chuyển cánh tay 6 trục, xoay đầu cuối của nó, kiểm tra xem các chuyển động có khả thi hay không và điều khiển các công cụ được gắn kèm như Công cụ gắp nam châm hoặc Công cụ giữ bút.
Trang này dành cho các dự án CTE Workcell trong đó Cánh tay 6 trục được kết nối với EXP Brain. Nếu bạn đang sử dụng Cánh tay 6 trục riêng lẻ với CTE Tile, hãy sử dụng trang CTE Arm API thay thế.
Dưới đây là danh sách các khối có sẵn:
Thao tác — Di chuyển cánh tay 6 trục đến các vị trí hoặc hướng mong muốn.
di chuyển cánh tay đến vị trí — Di chuyển cánh tay 6 trục đến tọa độ x, y và z được chỉ định.
tăng vị trí tay cần — Di chuyển tay cần 6 trục một khoảng cách so với vị trí hiện tại của nó.
di chuyển cánh tay đến hướng — Xoay bộ phận cuối đến hướng được chỉ định.
tăng hướng cánh tay — Xoay bộ phận cuối cùng một số độ nhất định.
Cài đặt — Cấu hình chuyển động, công cụ và cài đặt điều khiển.
đặt tốc độ tay — Đặt tốc độ di chuyển của tay 6 trục.
đặt đầu cuối cánh tay — Chọn công cụ được gắn vào Cánh tay 6 trục.
đặt chế độ nam châm tay — Kích hoạt hoặc vô hiệu hóa Công cụ Nhặt Nam châm.
đặt độ lệch bút trên cánh tay — Đặt độ lệch dọc cho Công cụ Giá đỡ Bút.
đặt tay điều khiển dừng — Dừng tay 6 trục và ngăn chuyển động tiếp theo của tay.
Giá trị — Kiểm tra xem một chuyển động có thể thực hiện được không, chuyển động đã hoàn thành chưa, có xảy ra sự cố không, đọc vị trí hoặc hướng hiện tại, hoặc chạy các khối lệnh khi sự kiện Arm xảy ra.
cánh tay di chuyển đến vị trí? — Trả về liệu Cánh tay 6 trục có thể di chuyển đến vị trí được chỉ định hay không.
vị trí tăng dần của cánh tay? — Trả về liệu cánh tay 6 trục có thể di chuyển một khoảng cách được chỉ định hay không.
cánh tay di chuyển đầu cuối? — Trả về liệu đầu cuối có thể xoay đến hướng được chỉ định hay không.
hướng tăng dần của cánh tay? — Trả về liệu đầu cuối có thể xoay theo một số độ nhất định hay không.
cánh tay đã ngừng di chuyển chưa? — Trả về trạng thái cho biết cánh tay 6 trục đã ngừng di chuyển hay chưa.
cánh tay bị va chạm? — Trả về liệu cánh tay 6 trục có bị va chạm trong khi di chuyển hay không.
vị trí cánh tay — Trả về vị trí hiện tại của Cánh tay 6 trục dọc theo trục đã chọn.
hướng cánh tay — Trả về hướng hiện tại của bộ phận cuối dọc theo trục đã chọn.
khi dừng điều khiển cánh tay — Chạy ngăn xếp đính kèm khi dừng điều khiển được bật.
khi arm gặp sự cố — Chạy ngăn xếp đính kèm khi phát hiện sự cố.
Hành động#
di chuyển cánh tay đến vị trí#
Khối lệnh di chuyển tay cần đến vị trí di chuyển tay cần 6 trục đến tọa độ x, y và z được chỉ định.
Tọa độ x, y và z mô tả vị trí của đầu cuối trong không gian ba chiều. Sử dụng arm move to position? trước khối này nếu vị trí mục tiêu có thể nằm ngoài không gian làm việc có thể tiếp cận của Cánh tay 6 trục.
di chuyển [Arm1 v] đến vị trí x:[120] y:[0] z:[100] [mm v] ▶
Tham số |
Sự miêu tả |
|---|---|
thiết bị |
Cấu hình tay cần 6 trục để sử dụng. |
x |
Tọa độ x của vị trí mục tiêu. |
y |
Tọa độ y của vị trí mục tiêu. |
z |
Tọa độ z của vị trí mục tiêu. |
đơn vị |
Đơn vị được sử dụng cho tọa độ x, y và z là: mm (milimét) hoặc inch. |
mũi tên mở rộng |
Theo mặc định, cánh tay 6 trục sẽ hoàn thành chuyển động trước khi khối lệnh tiếp theo chạy. Mở rộng khối lệnh đến và đừng chờ để bắt đầu chuyển động và tiếp tục ngay lập tức đến khối lệnh tiếp theo. |
Ví dụ
khi bắt đầu
[Move Arm1 to a standard position at the start of the project.]
di chuyển [Arm1 v] đến vị trí x:(120) y:(120) z:(75) [mm v] ▶
tăng vị trí cánh tay#
Khối điều khiển tăng vị trí tay cần di chuyển tay cần 6 trục một khoảng cách xác định so với vị trí hiện tại dọc theo các trục x, y và z.
Sử dụng khối này để di chuyển tương đối so với vị trí hiện tại của bộ phận cuối. Sử dụng vị trí tăng cánh tay? trước khối này nếu chuyển động có thể đặt Cánh tay 6 trục ra ngoài không gian làm việc có thể tiếp cận của nó.
tăng vị trí [Arm1 v] theo x:[0] y:[0] z:[0] [mm v] ▶
Tham số |
Sự miêu tả |
|---|---|
thiết bị |
Cấu hình tay cần 6 trục để sử dụng. |
x |
Khoảng cách di chuyển dọc theo trục x. |
y |
Khoảng cách di chuyển dọc theo trục y. |
z |
Khoảng cách di chuyển dọc theo trục z. |
đơn vị |
Đơn vị được sử dụng cho khoảng cách x, y và z là: mm (milimét) hoặc inch. |
mũi tên mở rộng |
Theo mặc định, cánh tay 6 trục sẽ hoàn thành chuyển động trước khi khối lệnh tiếp theo chạy. Mở rộng khối lệnh đến và đừng chờ để bắt đầu chuyển động và tiếp tục ngay lập tức đến khối lệnh tiếp theo. |
Ví dụ
khi bắt đầu
[Move Arm1 100 millimeters along the x-axis.]
tăng vị trí [Arm1 v] theo x:[100] y:[0] z:[0] [mm v] ▶
di chuyển cánh tay về hướng#
Khối lệnh di chuyển tay cần theo hướng xoay đầu cuối của thiết bị đến một hướng được chỉ định.
Hướng xoay mô tả cách đầu cuối của thiết bị được xoay. Pitch nghiêng đầu cuối lên hoặc xuống, Roll xoay nó sang hai bên, và Yaw xoay nó sang trái hoặc phải.
di chuyển [Arm1 v] đến hướng [pitch v] [0] độ ▶
Tham số |
Sự miêu tả |
|---|---|
thiết bị |
Cấu hình tay cần 6 trục để sử dụng. |
định hướng |
Trục quay của đầu cuối robot:
|
bằng cấp |
Góc định hướng mục tiêu, tính bằng độ. |
mũi tên mở rộng |
Theo mặc định, cánh tay 6 trục sẽ hoàn thành chuyển động trước khi khối lệnh tiếp theo chạy. Mở rộng khối lệnh đến và đừng chờ để bắt đầu chuyển động và tiếp tục ngay lập tức đến khối lệnh tiếp theo. |
Ví dụ
khi bắt đầu
[Rotate the end effector to 270 degrees of yaw.]
di chuyển [Arm1 v] đến hướng [yaw v] [270] độ ▶
tăng hướng cánh tay#
Khối điều chỉnh hướng tay cần xoay (increment arm orientation) sẽ xoay đầu cuối của thiết bị một số độ nhất định so với hướng hiện tại của nó.
Sử dụng khối lệnh này để xoay tương đối so với góc nghiêng, góc xoay hoặc góc lệch hiện tại của đầu cuối robot.
tăng hướng [Arm1 v] theo [pitch v] [0] độ ▶
Tham số |
Sự miêu tả |
|---|---|
thiết bị |
Cấu hình tay cần 6 trục để sử dụng. |
định hướng |
Trục quay của đầu cuối robot:
|
bằng cấp |
Số độ xoay của đầu cuối thiết bị. |
mũi tên mở rộng |
Theo mặc định, cánh tay 6 trục sẽ hoàn thành chuyển động trước khi khối lệnh tiếp theo chạy. Mở rộng khối lệnh đến và đừng chờ để bắt đầu chuyển động và tiếp tục ngay lập tức đến khối lệnh tiếp theo. |
Ví dụ
khi bắt đầu
[Rotate the end effector 40 degrees in pitch.]
tăng hướng [Arm1 v] theo [pitch v] [40] độ ▶
Cài đặt#
đặt tốc độ cánh tay#
Khối lệnh set arm speed thiết lập tốc độ chuyển động của cánh tay robot 6 trục.
Tốc độ của cánh tay robot 6 trục được đặt ở mức 50% khi bắt đầu dự án.
đặt tốc độ [Arm1 v] thành [50] %
Tham số |
Sự miêu tả |
|---|---|
thiết bị |
Cấu hình tay cần 6 trục để sử dụng. |
phần trăm |
Tốc độ chuyển động của cánh tay robot 6 trục, từ 1 đến 100 phần trăm. |
Ví dụ
khi bắt đầu
[Set Arm1's speed to 30%.]
đặt tốc độ [Arm1 v] thành [30] %
di chuyển [Arm1 v] đến vị trí x:[120] y:[120] z:[70] [mm v] ▶
đặt bộ phận đầu cuối tay đòn#
Khối bộ phận đầu cuối tay cần chọn công cụ được gắn vào tay cần 6 trục.
Khi thay đổi đầu kẹp, cần trục 6 trục sẽ tự động điều chỉnh độ lệch trục Z để phù hợp với công cụ đã chọn. Đầu kẹp được thiết lập là Công cụ gắp từ tính khi bắt đầu dự án.
đặt đầu cuối [Arm1 v] thành [nam châm v]
Tham số |
Sự miêu tả |
|---|---|
thiết bị |
Cấu hình tay cần 6 trục để sử dụng. |
bộ phận cuối cùng |
Công cụ được gắn vào Cánh tay 6 trục: nam châm (Công cụ gắp bằng nam châm) hoặc bút (Công cụ giữ bút). |
Ví dụ
khi bắt đầu
[Set Arm1 to use the Pen Holder Tool.]
đặt đầu cuối [Arm1 v] thành [bút v]
thiết lập chế độ nam châm tay#
Khối xếp chế độ nam châm tay đỡ sẽ kích hoạt hoặc nhả dụng cụ gắp nam châm.
Chế độ nam châm vẫn hoạt động cho đến khi một khối lệnh thiết lập chế độ nam châm cánh tay khác thay đổi nó. Chế độ nam châm được đặt lại về trạng thái đã nhả khi bắt đầu một dự án.
đặt nam châm [Arm1 v] thành [đã kích hoạt v]
Tham số |
Sự miêu tả |
|---|---|
thiết bị |
Cấu hình tay cần 6 trục để sử dụng. |
cách thức |
Trạng thái của Công cụ Nhặt Nam châm: được kích hoạt để nhặt vật thể hoặc được nhả ra để thả bất kỳ vật thể nào đang giữ và không nhặt thêm vật thể mới. |
Ví dụ
khi bắt đầu
[Pick up objects, then drop them after 2 seconds.]
đặt nam châm [Arm1 v] thành [đã kích hoạt v]
chờ [2] giây
đặt nam châm [Arm1 v] thành [đã thả v]
đặt tay bút bù trừ#
Khối xếp chồng set arm pen offset thiết lập độ lệch dọc cho Công cụ Giữ Bút.
Hãy đặt đầu cuối của dụng cụ thành bút trước khi sử dụng khối lệnh này. Nếu Công cụ Giữ Bút không được chọn, khối lệnh này sẽ không có tác dụng.
Khoảng cách lệch bút là khoảng cách từ đỉnh của dụng cụ giữ bút đến đầu bút xóa bảng. Khi bắt đầu một dự án, khoảng cách lệch bút được đặt là 0. Khoảng cách lệch bút bằng 0 đặt gốc trục Z của cánh tay robot tại điểm mà dụng cụ giữ bút kết nối với cánh tay robot 6 trục.
đặt độ lệch bút [Arm1 v] thành [0] [mm v]
Tham số |
Sự miêu tả |
|---|---|
thiết bị |
Cấu hình tay cần 6 trục để sử dụng. |
bù lại |
Giá trị bù trừ của bút. |
đơn vị |
Đơn vị dùng để đo độ lệch của bút: mm (milimet) hoặc inch. |
Ví dụ
khi bắt đầu
[Set the end effector to the Pen Holder Tool and set the pen offset to 1 inch.]
đặt đầu cuối [Arm1 v] thành [bút v]
đặt độ lệch bút [Arm1 v] thành [1] [inch v]
di chuyển [Arm1 v] đến vị trí x:[120] y:[120] z:[0] [mm v] ▶
đặt cần gạt để điều khiển dừng#
Khối lệnh đặt tay điều khiển dừng sẽ ngay lập tức dừng tay điều khiển 6 trục và ngăn không cho bất kỳ khối lệnh tay điều khiển nào khác hoạt động.
Sau khi khối lệnh này chạy xong, cánh tay robot 6 trục không thể được kích hoạt lại cho đến khi dự án được khởi động lại.
đặt [Arm1 v] để dừng điều khiển
Tham số |
Sự miêu tả |
|---|---|
thiết bị |
Cấu hình tay cần 6 trục để sử dụng. |
Ví dụ
khi bắt đầu
[Control stop after a movement.]
di chuyển [Arm1 v] đến vị trí x:[120] y:[120] z:[70] [mm v] ▶
đặt [Arm1 v] để dừng điều khiển
Giá trị#
Di chuyển cánh tay đến vị trí thích hợp?#
Khối Boolean Cánh tay di chuyển đến vị trí? trả về liệu cánh tay 6 trục có thể di chuyển đến tọa độ x, y và z được chỉ định hay không.
Khối này kiểm tra vị trí mục tiêu trước khi cánh tay robot 6 trục di chuyển. Nó có thể giúp ngăn chặn dự án cố gắng di chuyển cánh tay ra ngoài phạm vi làm việc có thể tiếp cận được.
<[Arm1 v] di chuyển đến vị trí x:[0] y:[0] z:[0] [mm v]?>
Tham số |
Sự miêu tả |
|---|---|
thiết bị |
Cấu hình tay cần 6 trục để sử dụng. |
x |
Tọa độ x của vị trí mục tiêu. |
y |
Tọa độ y của vị trí mục tiêu. |
z |
Tọa độ z của vị trí mục tiêu. |
đơn vị |
Đơn vị được sử dụng cho tọa độ x, y và z là: mm (milimét) hoặc inch. |
Ví dụ
khi bắt đầu
[Check if Arm1 can move to a position.]
nếu <không <[Arm1 v] di chuyển đến vị trí x:[0] y:[0] z:[0] [mm v]?>> thì
in [The 6-Axis Arm can't move to this position.] trên màn hình ▶
fin
Vị trí tăng dần của cánh tay?#
Khối Boolean vị trí gia tăng của cánh tay? trả về liệu cánh tay 6 trục có thể di chuyển khoảng cách được chỉ định từ vị trí hiện tại của nó hay không.
Khối này kiểm tra chuyển động tăng dần trước khi cánh tay 6 trục di chuyển.
<[Arm1 v] tăng vị trí theo x:[0] y:[0] z:[0] [mm v]?>
Tham số |
Sự miêu tả |
|---|---|
thiết bị |
Cấu hình tay cần 6 trục để sử dụng. |
x |
Khoảng cách di chuyển dọc theo trục x. |
y |
Khoảng cách di chuyển dọc theo trục y. |
z |
Khoảng cách di chuyển dọc theo trục z. |
đơn vị |
Đơn vị được sử dụng cho khoảng cách x, y và z là: mm (milimét) hoặc inch. |
Ví dụ
khi bắt đầu
[Check if Arm1 can increment from its current position.]
nếu <không <[Arm1 v] tăng vị trí theo x:[0] y:[500] z:[0] [mm v]?>> thì
in [The 6-Axis Arm can't move that distance.] trên màn hình ▶
fin
Bộ phận cuối cánh tay có thể di chuyển được không?#
Khối Boolean arm move end effector? trả về giá trị cho biết đầu cuối của cánh tay robot có thể xoay theo hướng đã chỉ định hay không.
Sử dụng khối lệnh này để kiểm tra xem giá trị góc nghiêng, góc xoay hoặc góc lệch hướng mục tiêu có nằm trong phạm vi cho phép hay không trước khi xoay đầu cuối của thiết bị.
<[Arm1 v] di chuyển đầu cuối đến [pitch v] [0] độ?>
Tham số |
Sự miêu tả |
|---|---|
thiết bị |
Cấu hình tay cần 6 trục để sử dụng. |
định hướng |
Trục quay của đầu cuối robot:
|
bằng cấp |
Góc định hướng mục tiêu, tính bằng độ. |
Ví dụ
khi bắt đầu
[Check if Arm1 can roll its end effector to an orientation.]
nếu <[Arm1 v] di chuyển đầu cuối đến [roll v] [40] độ?> thì
in [The end effector can roll to that orientation.] trên màn hình ▶
fin
Hướng tăng dần của cánh tay?#
Khối Boolean arm increment orientation? trả về giá trị cho biết liệu đầu cuối của thiết bị có thể xoay một số độ nhất định so với hướng hiện tại hay không.
Sử dụng khối này để kiểm tra chuyển động nghiêng, xoay hoặc lệch hướng từng bước trước khi xoay đầu cuối của thiết bị.
<[Arm1 v] tăng hướng theo [pitch v] [0] độ?>
Tham số |
Sự miêu tả |
|---|---|
thiết bị |
Cấu hình tay cần 6 trục để sử dụng. |
định hướng |
Trục quay của đầu cuối robot:
|
bằng cấp |
Số độ xoay của đầu cuối thiết bị. |
Ví dụ
khi bắt đầu
[Check if Arm1 can increment yaw.]
nếu <[Arm1 v] tăng hướng theo [yaw v] [20] độ?> thì
in [The end effector can increment yaw by 20 degrees.] trên màn hình ▶
fin
Cánh tay đã ngừng cử động chưa?#
Khối lệnh Boolean Cánh tay đã chuyển động xong chưa? trả về giá trị cho biết liệu cánh tay robot 6 trục đã chuyển động xong hay chưa.
Khối này hữu ích sau khi khối di chuyển được mở rộng thành và đừng chờ đợi.
<[Arm1 v] đã xong di chuyển?>
Tham số |
Sự miêu tả |
|---|---|
thiết bị |
Cấu hình tay cần 6 trục để sử dụng. |
Ví dụ
khi bắt đầu
[Display the current y-position while Arm1 moves.]
di chuyển [Arm1 v] đến vị trí x:(-100) y:(200) z:(100) [mm v] ◀ và không chờ
lặp lại cho đến khi <[Arm1 v] đã xong di chuyển?>
in (vị trí [Arm1 v] [y v] tính bằng [mm v]) trên màn hình ◀ và đặt con trỏ xuống hàng tiếp theo
chờ [0.25] giây
fin
Cánh tay bị hỏng?#
Khối lệnh Boolean Cánh tay bị va chạm? trả về giá trị cho biết liệu cánh tay robot 6 trục có bị va chạm trong khi di chuyển hay không.
Khi phát hiện va chạm, cánh tay robot 6 trục sẽ ngừng chuyển động của động cơ và có thể trông như bị chùng xuống. Điều này giúp giảm tải trọng và bảo vệ động cơ khỏi hư hỏng do va chạm bất ngờ.
<[Arm1 v] có bị kẹt không?>
Tham số |
Sự miêu tả |
|---|---|
thiết bị |
Cấu hình tay cần 6 trục để sử dụng. |
Ví dụ
khi bắt đầu
[Quickly move to the specified location.]
đặt tốc độ [Arm1 v] thành [100] %
di chuyển [Arm1 v] đến vị trí x:[-20] y:[240] z:[40] [mm v] ◀ và không chờ
[While moving, check for a crash.]
mãi mãi
nếu <[Arm1 v] có bị kẹt không?> thì
[Indicate a crash with the Signal Tower and Brain screen.]
in [Crash Detected] trên màn hình ▶
đặt [SignalTower2 v] thành [xanh lá v] và [tắt v]
đặt [SignalTower2 v] thành [đỏ v] và [liên tục v]
thoát vòng lặp
fin
fin
vị trí cánh tay#
Khối báo cáo vị trí cánh tay trả về vị trí hiện tại của cánh tay 6 trục dọc theo trục đã chọn.
Sử dụng khối lệnh này để đọc vị trí hiện tại của đầu cuối thiết bị dọc theo trục x, y hoặc z.
(vị trí [Arm1 v] [x v] tính bằng [mm v])
Tham số |
Sự miêu tả |
|---|---|
thiết bị |
Cấu hình tay cần 6 trục để sử dụng. |
trục |
Trục vị trí cần báo cáo:
|
đơn vị |
Đơn vị được sử dụng cho giá trị vị trí: mm (milimét) hoặc inch. |
Ví dụ
khi bắt đầu
[Display the current y-position while Arm1 moves.]
di chuyển [Arm1 v] đến vị trí x:(-100) y:(200) z:(100) [mm v] ◀ và không chờ
lặp lại cho đến khi <[Arm1 v] đã xong di chuyển?>
in (vị trí [Arm1 v] [y v] tính bằng [mm v]) trên màn hình ◀ và đặt con trỏ xuống hàng tiếp theo
chờ [0.25] giây
fin
hướng cánh tay#
Khối báo cáo hướng cánh tay trả về hướng hiện tại của bộ phận cuối cánh tay robot so với trục đã chọn tính bằng độ.
Sử dụng khối lệnh này để đọc góc nghiêng, góc xoay hoặc góc lệch hiện tại của đầu cuối bộ phận điều khiển.
(góc định hướng [Arm1 v] trục [pitch v] tính bằng độ)
Tham số |
Sự miêu tả |
|---|---|
thiết bị |
Cấu hình tay cần 6 trục để sử dụng. |
định hướng |
Trục định hướng cần báo cáo:
|
Ví dụ
khi bắt đầu
[Display the current yaw after rotating the end effector.]
di chuyển [Arm1 v] đến hướng [yaw v] [90] độ ◀ và không chờ
lặp lại cho đến khi <[Arm1 v] đã xong di chuyển?>
in (góc định hướng [Arm1 v] trục [yaw v] tính bằng độ) trên màn hình ◀ và đặt con trỏ xuống hàng tiếp theo
chờ [0.25] giây
fin
khi việc điều khiển tay dừng lại#
Khối lệnh khi dừng điều khiển cánh tay sẽ chạy ngăn xếp được gắn kèm khi chức năng dừng điều khiển của cánh tay 6 trục được kích hoạt.
khi [Arm1 v] dừng điều khiển :: hat events
Tham số |
Sự miêu tả |
|---|---|
thiết bị |
Cấu hình tay cần 6 trục để sử dụng. |
khi cánh tay bị va chạm#
Khối lệnh khi cánh tay robot bị va chạm sẽ chạy ngăn xếp lệnh được đính kèm khi cánh tay robot 6 trục bị va chạm trong quá trình di chuyển.
Khi phát hiện va chạm, cánh tay robot 6 trục sẽ ngừng chuyển động của động cơ và có thể trông như bị chùng xuống. Điều này giúp giảm tải trọng và bảo vệ động cơ khỏi hư hỏng do va chạm bất ngờ.
when [Arm1 v] crashed :: hat events
Tham số |
Sự miêu tả |
|---|---|
thiết bị |
Cấu hình tay cần 6 trục để sử dụng. |
Ví dụ
when [Arm1 v] crashed :: hat events
[Indicate a crash with the Signal Tower and Brain screen.]
in [Crash Detected] trên màn hình ▶
đặt [SignalTower2 v] thành [đỏ v] và [liên tục v]