一 安装python 库
前置条件需要 Python >= 3.6，使用pip 安装
pip install roboticstoolbox-python
import roboticstoolbox as rtb
print(rtb.__version__)
二 Robotics Toolbox Python样例程序
加载机器人模型
加载由URDF文件定义的Franka Emika Panda机器人模型
import roboticstoolbox as rtb
robot = rtb.models.Panda()
print(robot)
┌───────────┬───────┬──────┬────────┬─────────┬────────┐
│ θⱼ │ 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° │
└─────┴─────┴──────┴───────┴─────┴──────┴──────┘
计算正向运动学
>>> Te=Robt_post =robot.fkine(robot.qr)
>>> print(Te)
-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）姿势
>>> 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)
(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)
>>> q_pickup = sol[0]
>>> print(robot.fkine(q_pickup))
-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
动画显示
>>> qt = rtb.jtraj(robot.qr, q_pickup, 50)
>>> robot.plot(qt.q, backend='pyplot', movie='IRB140.gif')
显示示教界面
robot.teach(robot.q)
三 Robotics Toolbox Python和ABB 机器人 robot studio 的验证
原文地址:https://blog.csdn.net/hong3731/article/details/134687975
本文来自互联网用户投稿，该文观点仅代表作者本人，不代表本站立场。本站仅提供信息存储空间服务，不拥有所有权，不承担相关法律责任。
如若转载，请注明出处：http://www.7code.cn/show_38224.html
如若内容造成侵权/违法违规/事实不符，请联系代码007邮箱：suwngjj01@126.com进行投诉反馈，一经查实，立即删除！
声明：本站所有文章，如无特殊说明或标注，均为本站原创发布。任何个人或组织，在未征得本站同意时，禁止复制、盗用、采集、发布本站内容到任何网站、书籍等各类媒体平台。如若本站内容侵犯了原著者的合法权益，可联系我们进行处理。
