一直在糾結(jié)是先講頭部運動，還是先講空間坐標(biāo)系，后來決定還是先講頭部運動，讓大家先感受一下機械臂在空間中是怎么定位的，然后我們下一節(jié)將詳細介紹機械臂的空間坐標(biāo)是怎么回事。空間坐標(biāo)是一項非常復(fù)雜且需要深度理解的東西，學(xué)好空間坐標(biāo)才能學(xué)好機械臂的各種運動。為了更好的體驗一下機械臂的空間定位，我們先從這個機械臂頭部運動開始，讓大家體驗一下空間坐標(biāo)及運動。

（1）send_coords([x,y,z,rx,ry,rz],speed,model)是用來控制機械臂頭部以指定姿態(tài)移動到指定點。它主要用于實現(xiàn)智能規(guī)劃機械臂頭部從一個位置到另一個指定位置。X,Y,Z 表示的是機械臂頭部在空間中的位置（該坐標(biāo)系為直角坐標(biāo)系），rx,ry,rz 表示的是機械臂頭部在該點的姿態(tài)（該坐標(biāo)系為歐拉坐標(biāo)）。

函數(shù)功能：智能規(guī)劃路線，讓機械臂頭部從原來點移動到指定點。

參數(shù)說明： x,y,z 是空間直角坐標(biāo)系，[rx,ry,rz]表示的是機械臂頭部的姿態(tài)，是歐拉坐標(biāo)系。

speed：表示機械臂運動的速度。取值范圍為 0~100，值越大速度越快。

model：取值限定 0 和 1。0 表示機械臂頭部移動隨機規(guī)劃，只要機械臂頭移動到指定點即可。

1 表示機械臂頭部讓機械臂頭部以直線的方式移動到指定點。

（2）get_coords()

函數(shù)功能：獲取此時機械臂頭部的空間坐標(biāo)以及當(dāng)前姿態(tài)。

返回值：返回的類型是包含六個 float 元素的 list 集合，前三個坐標(biāo)為 x,y,z 表示機械臂頭部的坐標(biāo)，后三個坐標(biāo) rx,ry,rz 表示機械臂頭部的姿態(tài)。

我們還是老方法，一邊實驗，一邊學(xué)習(xí)。打開一個終端窗口輸入python，先導(dǎo)入我們必須API函數(shù)。

from pymycobot.mycobot import MyCobot

from pymycobot.genre import Coord

from pymycobot import PI_PORT, PI_BAUD

import time

讓頭部以線性的方式到達[59.9,-65.8,250.7]這個坐標(biāo)，以及保持[-50.99,83.14,-52.42]這個姿態(tài)

mc = MyCobot(PI_PORT, PI_BAUD)

mc.send_coords([59.9, -65.8, 250.7, -50.99, 83.14, -52.42], 80, 1)

可能你做完這一段代碼導(dǎo)到的形狀跟我這個不一樣，也沒關(guān)系。因為只要頭部到達這個位置就可以，因為他是以頭部規(guī)劃的線路，各個關(guān)節(jié)即使有各種形狀，也沒關(guān)系。我們執(zhí)行一下get_coords獲取一下此時的坐標(biāo)數(shù)據(jù)：

coords = mc.get_coords()

print(coords)

如下圖：

這個值與我們傳遞的值不一樣，主要原因是這是機器內(nèi)部誤差，這個值接近我們傳遞的數(shù)值。

第二個例子：我們輸入：

mc.send_angles([88.68, -138.51, 155.65, -128.05, -9.93, -15.29], 50)

狀態(tài)變成這個樣子，然后我們再輸入之前的頭部坐標(biāo)：

mc.send_coords([59.9, -65.8, 250.7, -50.99, 83.14, -52.42], 80, 1)

機械臂變成了這個樣子，讓我們再取一下機械臂的坐標(biāo)：

coords = mc.get_coords()

print(coords)

我們得到的坐標(biāo)為：[59.5, -66.0, 251.1, -49.56, 83.14, -50.92]如下圖。

這說明頭部空間坐標(biāo)只要達到所在位置，各關(guān)節(jié)的狀態(tài)可能每次都不一樣。

（3）說明書中提供的測試小程序：

#!/usr/bin/python3

#-*- coding: UTF-8 -*-

from pymycobot.mycobot import MyCobot

from pymycobot.genre import Coord

from pymycobot import PI_PORT, PI_BAUD

import time

mc = MyCobot(PI_PORT, PI_BAUD)

# 獲取當(dāng)前頭部的角度以及姿態(tài)

coords = mc.get_coords()

print(coords)

# 智能規(guī)劃路線，讓頭部以線性的方式到達[59.9,-65.8,250.7]這個坐標(biāo)，以及保持[-50.99,83.14,-52.42]這個姿態(tài)

mc.send_coords([59.9, -65.8, 250.7, -50.99, 83.14, -52.42], 80, 1)

# 設(shè)置等待時間

time.sleep(1.5)

# 智能規(guī)劃路線，讓頭部以線性的方式到達[59.9,-65.8,350.7]這個坐標(biāo)，以及保持[-50.99,83.14,-52.42]這個姿態(tài)

mc.send_coords([59.9, -65.8, 350.7, -50.99, 83.14, -52.42], 80, 1)

# 設(shè)置等待時間

time.sleep(1.5)

# 僅改變頭部的x坐標(biāo)，設(shè)置頭部的x坐標(biāo)為-40。讓其智能規(guī)劃路線讓頭部移動到改變后的位置

mc.send_coord(Coord.X.value, -40, 70)

同樣，你可以將這段代碼保存成4.py，然后，你開一個新的窗口，執(zhí)行：

python 4.py

就可以連續(xù)運行這段代碼了。

本文來自于：CSDN的BBM的開源HUB分享，使用大象機器人mycobot機械臂

審核編輯 黃昊宇