机器人与3D视觉 Robotics Toolbox Python 一 安装 Robotics Toolbox Python

一 安装python 库

前置条件需要 Python >= 3.6,使用pip 安装

bash 复制代码
pip install roboticstoolbox-python

测试安装是否成功

bash 复制代码
import roboticstoolbox as rtb
print(rtb.__version__)

输出结果

二 Robotics Toolbox Python样例程序

加载机器人模型

加载由URDF文件定义的Franka Emika Panda机器人模型

python 复制代码
import roboticstoolbox as rtb
robot = rtb.models.Panda()
print(robot)
bash 复制代码
┌───────────┬───────┬──────┬────────┬─────────┬────────┐
│    θⱼ     │  dⱼ   │  aⱼ  │   ⍺ⱼ   │   q⁻    │   q⁺   │
├───────────┼───────┼──────┼────────┼─────────┼────────┤
│ q1        │ 0.352 │ 0.07 │ -90.0° │ -180.0° │ 180.0° │
│ q2 - 90°  │     0 │ 0.36 │   0.0° │ -100.0° │ 100.0° │
│ q3        │     0 │    0 │ -90.0° │ -220.0° │  60.0° │
│ q4        │  0.38 │    0 │  90.0° │ -200.0° │ 200.0° │
│ q5        │     0 │    0 │ -90.0° │ -120.0° │ 120.0° │
│ q6 + 180° │ 0.065 │    0 │   0.0° │ -400.0° │ 400.0° │
└───────────┴───────┴──────┴────────┴─────────┴────────┘

┌─┬──┐
└─┴──┘

┌─────┬─────┬──────┬───────┬─────┬──────┬──────┐
│name │ q0  │ q1   │ q2    │ q3  │ q4   │ q5   │
├─────┼─────┼──────┼───────┼─────┼──────┼──────┤
│  qr │  0° │  0°  │  0°   │  0° │  30° │  0°  │
│  qz │  0° │  0°  │  0°   │  0° │  0°  │  0°  │
│  qd │  0° │ -90° │  180° │  0° │  0°  │ -90° │
└─────┴─────┴──────┴───────┴─────┴──────┴──────┘

计算正向运动学

python 复制代码
>>> Te=Robt_post =robot.fkine(robot.qr) 
>>> print(Te) 
powershell 复制代码
  -0.5       0         0.866     0.5063    
   0         1         0         0
  -0.866     0        -0.5       0.6795    
   0         0         0         1

解逆运动学

首先选择根据位置和方向(末端执行器z轴向下(A=-z)和手指方向平行于y轴(O=+y))定义的SE(3)姿势

python 复制代码
>>> from spatialmath import SE3
>>> Tep = SE3.Trans(0.6, -0.3, 0.1) * SE3.OA([0, 1, 0], [0, 0, -1])
>>> sol = robot.ik_LM(Tep)         # 
>>> print(sol)
python 复制代码
(array([-4.63679405e-01,  1.30094095e+00, -4.61104212e-01, -4.58798962e-04,
        7.30870594e-01, -4.63099538e-01]), 1, 51, 2, 9.433557824147973e-08)
python 复制代码
>>> q_pickup = sol[0]
>>> print(robot.fkine(q_pickup)) 
python 复制代码
  -1         0.0002383 -5.733e-05  0.5998
   0.0002383  1        -0.0003137 -0.3
   5.725e-05 -0.0003138 -1         0.1001
   0         0         0         1

动画显示

python 复制代码
>>> qt = rtb.jtraj(robot.qr, q_pickup, 50)
>>> robot.plot(qt.q, backend='pyplot', movie='IRB140.gif') 

显示的效果

显示示教界面

python 复制代码
robot.teach(robot.q)

三 Robotics Toolbox Python和ABB 机器人 robot studio 的验证

在同一个点的位置

相关推荐
the局外人32 分钟前
Python 实战检索优化:BM25、向量与重排
数据库·后端·python
__underline__35 分钟前
冷门Python知识点006篇:Python 类体里的名字,能被"凭空造出来"
后端·python
用户0332126663671 小时前
使用 Python 轻松移除 Excel 文档中的重复行
python·excel
LiaoWL1231 小时前
从零搭一个 RAG 知识库(二):换上语义 Embedding——BGE 实测与阈值重校准
python·大模型·numpy·embedding·向量检索·rag
Dmz丶2 小时前
前端转 AI 100 天 Day 48:向量数据库——100 万向量的毫秒级检索
python
wechatbot8882 小时前
企业微信外部群聊自动回复机器人开发实战
微信·机器人·企业微信·企业微信scrm·企业微信二次开发·企业微信api
青少儿编程课堂2 小时前
蓝桥杯·全国青少年信息素养大赛·电子学会Python/C++考级:中国剩余定理解析
c++·python·算法·bfs·信息学竞赛
菜鸟~noob2333 小时前
[AI]间章:系列走到这里,聊聊后面的规划、造卡需要的软件平台,以及为什么我要先暂停更新
人工智能·python·fpga开发·django·pygame
TomEval12 小时前
【测AI】第26篇:线上模型监控与告警体系 — 测试不是终点
人工智能·python·功能测试·ai
prince_zxill13 小时前
PEP 751 pylock.toml 实测:pip 26.3 装 6 个包版本全钉死,但 [web] 选不中任何东西
python·pip·依赖管理·pep 751