MyCobot机械臂头部智能规划路线(四)

一直在纠结是先讲头部运动,还是先讲空间坐标系,后来决定还是先讲头部运动,让大家先感受一下机械臂在空间中是怎么定位的,然后我们下一节将详细介绍机械臂的空间坐标是怎么回事。空间坐标是一项非常复杂且需要深度理解的东西,学好空间坐标才能学好机械臂的各种运动。为了更好的体验一下机械臂的空间定位,我们先从这个机械臂头部运动开始,让大家体验一下空间坐标及运动。
(1)send_coords([x,y,z,rx,ry,rz],speed,model)是用来控制机械臂头部以指定姿态移动到指定点。它主要用于实现智能规划机械臂头部从一个位置到另一个指定位置。x,y,z 表示的是机械臂头部在空间中的位置(该坐标系为直角坐标系),rx,ry,rz 表示的是机械臂头部在该点的姿态(该坐标系为欧拉坐标)。
函数功能:智能规划路线,让机械臂头部从原来点移动到指定点。
参数说明: x,y,z 是空间直角坐标系,[rx,ry,rz]表示的是机械臂头部的姿态,是欧拉坐标系。
speed:表示机械臂运动的速度。取值范围为 0~100,值越大速度越快。
model:取值限定 0 和 1。0 表示机械臂头部移动随机规划,只要机械臂头移动到指定点即可。
1 表示机械臂头部让机械臂头部以直线的方式移动到指定点。
(2)get_coords()
函数功能:获取此时机械臂头部的空间坐标以及当前姿态。
返回值:返回的类型是包含六个 float 元素的 list 集合,前三个坐标为 x,y,z 表示机械臂头部的坐标,后三个坐标 rx,ry,rz 表示机械臂头部的姿态。
我们还是老方法,一边实验,一边学习。打开一个终端窗口输入python,先导入我们必须api函数。
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]这个坐标,以及保持[-50.99,83.14,-52.42]这个姿态
mc = mycobot(pi_port, pi_baud)
mc.send_coords([59.9, -65.8, 250.7, -50.99, 83.14, -52.42], 80, 1)
可能你做完这一段代码导到的形状跟我这个不一样,也没关系。因为只要头部到达这个位置就可以,因为他是以头部规划的线路,各个关节即使有各种形状,也没关系。我们执行一下get_coords获取一下此时的坐标数据:
coords = mc.get_coords()
print(coords)
如下图:
这个值与我们传递的值不一样,主要原因是这是机器内部误差,这个值接近我们传递的数值。
第二个例子:我们输入:
mc.send_angles([88.68, -138.51, 155.65, -128.05, -9.93, -15.29], 50)
状态变成这个样子,然后我们再输入之前的头部坐标:
mc.send_coords([59.9, -65.8, 250.7, -50.99, 83.14, -52.42], 80, 1)
机械臂变成了这个样子,让我们再取一下机械臂的坐标:
coords = mc.get_coords()
print(coords)
我们得到的坐标为:[59.5, -66.0, 251.1, -49.56, 83.14, -50.92]如下图。
这说明头部空间坐标只要达到所在位置,各关节的状态可能每次都不一样。
(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)
# 获取当前头部的角度以及姿态
coords = mc.get_coords()
print(coords)
# 智能规划路线,让头部以线性的方式到达[59.9,-65.8,250.7]这个坐标,以及保持[-50.99,83.14,-52.42]这个姿态
mc.send_coords([59.9, -65.8, 250.7, -50.99, 83.14, -52.42], 80, 1)
# 设置等待时间
time.sleep(1.5)
# 智能规划路线,让头部以线性的方式到达[59.9,-65.8,350.7]这个坐标,以及保持[-50.99,83.14,-52.42]这个姿态
mc.send_coords([59.9, -65.8, 350.7, -50.99, 83.14, -52.42], 80, 1)
# 设置等待时间
time.sleep(1.5)
# 仅改变头部的x坐标,设置头部的x坐标为-40。让其智能规划路线让头部移动到改变后的位置
mc.send_coord(coord.x.value, -40, 70)
同样,你可以将这段代码保存成4.py,然后,你开一个新的窗口,执行:
python 4.py
就可以连续运行这段代码了。
本文来自于:csdn的bbm的开源hub分享,使用大象机器人mycobot机械臂


一种六水氯化铁/乙酰胺为组分的低共熔溶剂体系
研究人员正借助AI的力量以改善对心脏异常的检查,并提高诊断的准确性
ROG冰刃3轻薄游戏笔记本主打轻薄设计机身最厚之处仅为15.75mm
兼容Pump Express的充电AC/DC控制器
2月份光伏逆变器出口总量达2.4GW,较上年同比增加64%
MyCobot机械臂头部智能规划路线(四)
超六类屏蔽网线有哪些“超”能力
使用了信号干扰器后,手机会发生什么变化?
如何用万用表去辨别电容的好坏
苹果新专利曝光将可以改善iPhone手机相机凸起
生物有机肥检测仪是什么,它有哪些用途
重定义FPGA 超低功耗 超小尺寸
维修泰克示波器MDO34进不去测试界面最新案例
百度与海尔强强联手助力AI与IoT结合改变智慧家庭新商业模式
水泵维修的几种必要常识
FET晶体管电路设计参数
传中移动自主品牌手机499元 国产手机受挤压
通信领域的发展趋势是怎样的
mac系统越来越卡怎么办?4招让你电脑焕然如新
泰克推出业内最完整的PCI Express 3.0解决方案