9. 進一步開發及編程
Jaguar Arm Plus 控制指令
機器手臂由 3 個 RoboteQ SDC2130 控制板控制。
程式將通過 192.168.0.63 及 192.168.0.62,port 10001/10002 使用 TCP 協定進行通訊。
你可以從 RoboteQ 網站找到手冊。你需要確認的事是,在驅動機器手臂時,沒有馬達會卡住,因為這種情況會造成過熱,因而燒毀馬達和/或馬達驅動板。
緊急停止的指令是 "!EX\r",而解除的指令是 "!MG\r"
關節號碼
Joint1 (Motor Driver board 1
channel 1)
編碼器 : One circle count is 19000
Angle Resolution: 19000/ (2*PI)
此關節是在 position control 位置控制模式運作(mode 3):
舉例:
Command : "!PR 1 -200\r" ,指令會驅動此關節往上。
Command : "!PR 1 200\r",指令會驅動此關節往下。
Command : "!P 1 -250\r",指令會將此馬達驅動到編碼器位置 -250(請確保你知道位置在哪裡,而不會處於卡住的狀態)
在控制板上,我們設置了該關節的電流限制。當電流超過 12A 或電流超過 7A 超過 1000ms 時,它將進入緊急停止狀態。
你可以通過類比通道 3(AI 3)讀取溫度感測器。溫度感測器是 B57164K103J,你可以從範例程式碼中,找到如何將讀數轉換為溫度。
Joint2(Motor Driver board 1
channel 2)
編碼器 : One circle count is 53706
Angle Resolution: 53706/ (2*PI)
此關節是在 position control 位置控制模式運作(mode 3):
舉例:
Command : "!PR 2 -200\r" ,指令會驅動此關節往上。
Command : "!PR 2 200\r",指令會驅動此關節往下。
Command : "!P 2 -250\r",指令會將此馬達驅動到編碼器位置 -250(請確保你知道位置在哪裡,而不會處於卡住的狀態)
在控制板上,我們設置了該關節的電流限制。當電流超過 8A 或電流超過 6A 超過 1000ms 時,它將進入緊急停止狀態。
你可以通過類比通道 4(AI 4)讀取溫度感測器。
溫度感測器是 B57164K103J,你可以從範例程式碼中,找到如何將讀數轉換為溫度。
Joint3(Motor Driver board 2 channel 1)
編碼器 : One circle count is 3724
Angle Resolution: 3724/ (2*PI)
此關節是在 position control 位置控制模式運作(mode 3):
舉例:
Command : "!PR 1 -200\r" ,指令會驅動此關節往右。
Command : "!PR 1 200\r",指令會驅動此關節往左。
Command : "!P 1 -250\r",指令會將此馬達驅動到編碼器位置 -250(請確保你知道位置在哪裡,而不會處於卡住的狀態)
在控制板上,我們設置了該關節的電流限制。當電流超過 8A 或電流超過 5A 超過 1000ms 時,它將進入緊急停止狀態。
你可以通過類比通道 3(AI 3)讀取溫度感測器。
溫度感測器是 B57164K103J,你可以從範例程式碼中,找到如何將讀數轉換為溫度。
Gripper(Motor Driver board 2 channel 2)
編碼器 : One circle count is 756
Angle Resolution: 756/ (2*PI)
此關節是在 open loop 模式運作(mode 0):
舉例:
Command : "!G 2 -200\r" ,指令會驅動此爪手合起。
Command : "!G 2 200\r",指令會驅動此爪手張開。
Command : "!G 2 0\r",指令將停止此馬達。(確保在 Gripper 爪手達到其機構限制前,就發出此命令來停止爪手)
在控制板上,我們設置了該關節的電流限制。當電流超過 2A 或電流超過 1A 超過 1000ms 時,它將進入緊急停止狀態。
你可以通過類比通道 4(AI 4)讀取溫度感測器。
溫度感測器是 B57164K103J,你可以從範例程式碼中,找到如何將讀數轉換為溫度。
Pan Unit Gripper(Motor Driver board 3 channel 1)
編碼器 : One circle count is around 14275.33(with external gear ratio 46:12)
Angle Resolution: 14275.33/ (2*PI)
此關節是在 position control 位置控制模式運作(mode 3):
舉例:
Command : "!PR 1 -200\r" ,指令會驅動此關節往右。
Command : "!PR 1 200\r",指令會驅動此關節往左。
Command : "!P 1 -250\r",指令會將此馬達驅動到編碼器位置 -250(請確保你知道位置在哪裡,而不會處於卡住的狀態)
在控制板上,我們設置了該關節的電流限制。當電流超過 8A 或電流超過 5A 超過 1000ms 時,它將進入緊急停止狀態。
你可以通過類比通道 3(AI 3)讀取溫度感測器。
溫度感測器是 B57164K103J,你可以從範例程式碼中,找到如何將讀數轉換為溫度。
旋轉角度是約 -270˚ ~ +270˚
Arm tilt(Motor Driver board 3 channel 2)
編碼器 : One circle count is around 7448
Angle Resolution: 7448/ (2*PI)
此關節是在 position control 位置控制模式運作(mode 3):
舉例:
Command : "!PR 2 -200\r" ,指令會驅動此關節往右。
Command : "!PR 2 200\r",指令會驅動此關節往左。
Command : "!P 2 -250\r",指令會將此馬達驅動到編碼器位置 -250(請確保你知道位置在哪裡,而不會處於卡住的狀態)
在控制板上,我們設置了該關節的電流限制。當電流超過 8A 或電流超過 5A 超過 1000ms 時,它將進入緊急停止狀態。
你可以通過類比通道 3(AI 3)讀取溫度感測器。
溫度感測器是 B57164K103J,你可以從範例程式碼中,找到如何將讀數轉換為溫度。
旋轉角度是約 -180˚ ~ +180˚
進階開發編程
支援和範例程式碼可用於使用 ROS。請聯繫 support(at)drrobot.com 獲取更多訊息。
Last updated