python控制
Socket通信知識(shí)補(bǔ)充
Socket又稱"套接字"，應(yīng)用程序通常通過"套接字"向網(wǎng)絡(luò)發(fā)出請(qǐng)求或者應(yīng)答網(wǎng)絡(luò)請(qǐng)求，使主機(jī)間或者一臺(tái)計(jì)算機(jī)上的進(jìn)程間可以通訊。

建立Socket連接至少需要一對(duì)套接字，其中一個(gè)運(yùn)行于客戶端，稱為ClientSocket ，另一個(gè)運(yùn)行于服務(wù)器端，稱為ServerSocket 。

每臺(tái)電腦對(duì)應(yīng)唯一ip地址，電腦上每一個(gè)進(jìn)程對(duì)應(yīng)一個(gè)端口(一個(gè)進(jìn)程可以綁定多個(gè)端口號(hào)，但一個(gè)端口只能綁定一個(gè)進(jìn)程)。此外，0~1023為知名端口號(hào)，一般不要去設(shè)置這些，1024~65535則可以自己去設(shè)置。比如9999。

先運(yùn)行服務(wù)端，再運(yùn)行客戶端

配置流程
廠家已經(jīng)把代碼封裝好了，機(jī)器人只要啟動(dòng)，服務(wù)端默認(rèn)就打開了的(也就是roboflow打開就行，不需要上電操作)，啟動(dòng)roboflow之后，服務(wù)器端就開始運(yùn)行。

可以打開roboflow，查看配置的ip以及端口是什么，剩下的操作都很簡單，調(diào)用接口就行

實(shí)戰(zhàn)經(jīng)驗(yàn)
set_coords()在使用笛卡爾坐標(biāo)系的時(shí)候，在某些角度下有可能無法運(yùn)動(dòng)，因?yàn)闄C(jī)器人可能解算不出來。我可以先用角度移動(dòng)到笛卡爾坐標(biāo)系能解算的范圍，再去使用
可能會(huì)遇到編碼問題，因?yàn)閑lephant是python2.7寫的。我需要用encode與decode去編碼解碼，如下：
def get_angles(self):
'''獲取當(dāng)前六個(gè)關(guān)節(jié)角度(°)'''
message = "get_angles()".encode()
self.sock.sendall(message)
angles_str = self.sock.recv(1024)
# while not angles_str.startswith('get_angles'):
# self.sock.sendall(message)
# angles_str = self.sock.recv(1024)
# str to list[float]
angles = [float(p) for p in angles_str[12:-1].decode().split(',')]
return angles
代碼
#!/usr/bin/env python
# -*- coding: utf-8 -*-
# 大象機(jī)器人Socket控制工具包

import socket
import time

class elephant_command():
def __init__(self):
'''初始化，連接機(jī)械臂'''
self.sock = socket.socket(socket.AF_INET, socket.SOCK_STREAM)
self.server_address = ('192.168.2.8', 5001) # 機(jī)械臂服務(wù)器的IP地址和端口
print("start connect")
self.sock.connect(self.server_address)
print("connect success")

def get_angles(self):
'''獲取當(dāng)前六個(gè)關(guān)節(jié)角度(°)'''
message = "get_angles()"
self.sock.sendall(message)
angles_str = self.sock.recv(1024)
while not angles_str.startswith('get_angles'):
self.sock.sendall(message)
angles_str = self.sock.recv(1024)
# str to list[float]
angles = [float(p) for p in angles_str[12:-1].split(',')]
return angles

def set_angles(self, angles_array, speed):
'''設(shè)定六個(gè)關(guān)節(jié)的角度(°)和速度'''
ang_msg = "set_angles({},{})".format(','.join(['{:.3f}'.format(x) for x in angles_array]), speed)
self.sock.sendall(ang_msg)
back_msg = self.sock.recv(1024)
print(back_msg)

def set_angle(self, joint, angle, speed):
'''設(shè)定單個(gè)關(guān)節(jié)（joint,1~6）的角度(°)和速度(°/min)'''
ang_msg = "set_angle(J{},{},{})".format(joint, angle, speed)
self.sock.sendall(ang_msg)
back_msg = self.sock.recv(1024)
print(back_msg)

def get_coords(self):
'''獲取當(dāng)前末端位姿(mm)'''
message = "get_coords()".encode()
self.sock.sendall(message)
coords_str = self.sock.recv(1024)
while not coords_str.startswith(b'get_coords'):
self.sock.sendall(message)
coords_str = self.sock.recv(1024)
# str to list[float]
coords = [float(p) for p in coords_str[12:-1].split(b',')]
return coords

def set_coords(self, coords_array, speed):
'''設(shè)定機(jī)械臂目標(biāo)位姿(mm)和運(yùn)動(dòng)速度(mm/min)'''
coords_msg = "set_coords({},{})".format(','.join(['{:.3f}'.format(x) for x in coords_array]), speed)
# print(coords_msg)
self.sock.sendall(coords_msg.encode())
back_msg = self.sock.recv(1024)
print(back_msg)

def set_coord(self, axis, coord, speed):
'''設(shè)定x,y,z,rx,ry,rz某一方向的坐標(biāo)(mm)和速度(mm/min)'''
coord_msg = "set_coord({},{:.3f},{})".format(axis, coord, speed)
self.sock.sendall(coord_msg)
back_msg = self.sock.recv(1024)
print(back_msg)

def jog_coord(self, axis, dirc, speed):
'''讓機(jī)械臂沿一軸(axis, x,y,z)方向(dirc, -1負(fù)方向,0停止,1正方向)以勻速(mm/min)運(yùn)動(dòng)'''
coord_msg = "jog_coord({},{},{})".format(axis, dirc, speed)
self.sock.sendall(coord_msg.encode())
back_msg = self.sock.recv(1024)
print(back_msg)

def jog_stop(self, axis):
'''讓機(jī)械臂沿一軸(axis, x,y,z,rx,ry,rz,j1~j6)運(yùn)動(dòng)停止'''
coord_msg = "jog_stop({})".format(axis)
self.sock.sendall(coord_msg.encode())
back_msg = self.sock.recv(1024)
print(back_msg)

def jog_angle(self, joint, dirc, speed):
'''讓機(jī)械臂某一關(guān)節(jié)(joint, 1~6)勻速( / )轉(zhuǎn)動(dòng)(dirc, -1負(fù)方向,0停止,1正方向)'''
coord_msg = "jog_angle(J{},{},{})".format(joint, dirc, speed)
self.sock.sendall(coord_msg.encode())
back_msg = self.sock.recv(1024)
print(back_msg)

def task_stop(self):
'''停止當(dāng)前任務(wù)'''
message = "task_stop()"
self.sock.sendall(message.encode())
back_msg = self.sock.recv(1024)
print(back_msg)

def wait(self, seconds):
'''設(shè)定機(jī)械臂等待時(shí)間(s)'''
message = "wait({})".format(seconds)
self.sock.sendall(message)
back_msg = self.sock.recv(1024)
print(back_msg)

def power_on(self):
'''給機(jī)械臂上電?'''
message = "power_on()"
self.sock.sendall(message)
time.sleep(20)
back_msg = self.sock.recv(1024)
print(back_msg)

def power_off(self):
'''給機(jī)械臂斷電?'''
message = "power_off()"
self.sock.sendall(message)
back_msg = self.sock.recv(1024)
print(back_msg)

def get_speed(self):
'''獲取機(jī)械臂(末端)速度(mm/s)'''
message = "get_speed()"
self.sock.sendall(message)
speed = self.sock.recv(1024)
return speed

def state_check(self):
'''檢查機(jī)械臂狀態(tài)(1正常,0不正常)'''
message = b"state_check()"
self.sock.sendall(message)
state = self.sock.recv(1024)
return state

def check_running(self):
'''檢查機(jī)械臂是否運(yùn)行(1正在運(yùn)行,0不在運(yùn)行)'''
message = b"check_running()"
self.sock.sendall(message)
running_state = self.sock.recv(1024)
if running_state == 'check_running:1':
return True
else:
return False

def set_torque_limit(self, axis, torque):
'''設(shè)置機(jī)械臂在x,y,z某一方向上的力矩限制(N)'''
torque_limit = "set_torque_limit({},{})".format(axis, torque)
self.sock.sendall(torque_limit)
back_msg = self.sock.recv(1024)
print(back_msg)

def set_payload(self, payload):
'''設(shè)置機(jī)械臂負(fù)載(kg)'''
message = "set_payload({})".format(payload)
self.sock.sendall(message)
back_msg = self.sock.recv(1024)
print(back_msg)

def set_acceleration(self, acc):
'''設(shè)置機(jī)械臂(末端)加速度(整數(shù),mm/s^2)'''
message = "set_acceleration({})".format(acc)
self.sock.sendall(message)
back_msg = self.sock.recv(1024)
print(back_msg)

def get_acceleration(self):
'''獲取機(jī)械臂(末端)加速度(mm/s^2)'''
message = "get_acceleration()"
self.sock.sendall(message)
acc = self.sock.recv(1024)
return acc

def wait_command_done(self):
'''等待命令執(zhí)行完畢'''
message = "wait_command_done()"
self.sock.sendall(message)
back_msg = self.sock.recv(1024)
print(back_msg)

def pause_program(self):
'''暫停進(jìn)程'''
message = "pause_program()"
self.sock.sendall(message)
back_msg = self.sock.recv(1024)
print(back_msg)

def resume_program(self):
'''重啟已暫停的進(jìn)程'''
message = "resume_program()"
self.sock.sendall(message)
back_msg = self.sock.recv(1024)
print(back_msg)

def state_on(self):
'''機(jī)器人使能（使可控）'''
message = "state_on()"
self.sock.sendall(message)
time.sleep(5)
back_msg = self.sock.recv(1024)
print(back_msg)

def state_off(self):
'''機(jī)器人去使能（使不可控）'''
message = "state_off()"
self.sock.sendall(message)
time.sleep(5)
back_msg = self.sock.recv(1024)
print(back_msg)

def set_digital_out(self, pin_number, signal):
""" 設(shè)定數(shù)字輸出端口電平，pin_number:0~15, signal:0低1高"""
digital_signal = 'set_digital_out({},{})'.format(pin_number, signal)
self.sock.sendall(digital_signal.encode())
back_msg = self.sock.recv(1024)
print(back_msg)

簡單測(cè)試

from elephant import elephant_command
import time
import random

erobot = elephant_command()
# 笛卡爾空間
cur_pose = erobot.get_coords()
print(cur_pose)
ROS控制
盡量多看官方的github代碼，里面有最詳細(xì)的資源github

要用rviz控制機(jī)械，肯定就需要安裝大象機(jī)器人的庫

大象機(jī)器人ros庫的安裝
先安裝依賴，命令行執(zhí)行下面語句：（此外ROS以及moveit都已經(jīng)安裝）

pip install pymycobot --upgrade
git 庫并且編譯(刪除src中的mycobot320這個(gè)庫，這個(gè)文件用不到，并且有問題)

cd ~/catkin_ws/src
git clone https://github.com/elephantrobotics/mycobot_ros.git
cd ..
catkin build
source /devel/setup.bash
最后一部環(huán)境變量也可以設(shè)置為永久環(huán)境變量的更改，參考之前的博客

實(shí)現(xiàn)與真實(shí)機(jī)械臂的通信需要修改端口波特率等，在py文件中。pro600默認(rèn)使用python3（每一代機(jī)器人的版本不同，我需要看py文件去確定）

pro600的ros控制
啟動(dòng)launch，打開rviz。官方已經(jīng)給了配置以及模型文件了。拖動(dòng)劃塊可以移動(dòng)。

roslaunch mycobot_600 mycobot_600_slider.launch

如果要實(shí)現(xiàn)實(shí)時(shí)控制機(jī)械臂，那么還需要啟動(dòng)python文件，新開一個(gè)終端，用rosrun啟動(dòng)(可能會(huì)手動(dòng)把文件的權(quán)限設(shè)置為可執(zhí)行文件)

rosrun mycobot_600 slider_600.py
特別注意：不要拖動(dòng)過快以及造成碰撞??！不要拖動(dòng)過快以及造成碰撞??！不要拖動(dòng)過快以及造成碰撞！！

審核編輯：湯梓紅