斯坦福四足机器人运动学逆解过程
2020-07-14 06:06
1331 查看
斯坦福四足机器人运动学逆解过程
运动学逆解定义:
正解:已知各关节的运动参数,求末端执行器的相对参考坐标系的位姿。逆解:根据已给定的满足工作要求的末端执行器相对参考坐标系的位置和姿态,求各关节的运动参数。
斯坦福四足机器人运动学逆解
运动学正解:知道舵/电机转角,求足端坐标运动学逆解:知道足端坐标,求舵/电机转角
规划轨迹 ==》再通过轨迹求电机转动角度 ==》传输给电机/舵机控制模块
足端轨迹规划
摆线方程:
运动轨迹图:
结构简化
将舵机的连接点重合进行建模,可通过几何计算腿部的各个数据
计算
通过坐标(x,y)计算θ1和θ2
python求解:
1.求逆解
L1=35
L2= 80
X=30,y=100
求在此x,y条件下,求四足机器人逆解,计算
θ1和θ2是多少?
def fun(x, y, l1, l2): l = math.sqrt(x ** 2 + y ** 2) # 虚拟脚长度 psail = math.asin(x / l) # 脚角 fail = math.acos((l ** 2 + l1 ** 2 - l2 ** 2) / (2 * l * l1)) # 连杆分离角 sita1 = fail - psail # 右舵机弧度制 sita2 = fail + psail # 左舵机弧度制 sita1_1 = 180 * m1 / math.pi # 右舵机角度制 sita2_2 = 180 * m2 / math.pi # 左舵机角度制 return sita1_1, sita2_2 print("sita1: %f sita2: %f" % fun(30, 100, 35, 80))
过程结果:
相关文章推荐
- 仿斯坦福四足机器人的运动学逆解
- 斯坦福四足机器人运动学逆解(笔记4/作业4)
- 【零基础】斯坦福四足机器人DIY指引
- 为什么机器人运动学逆解最好采用双变量反正切函数atan2而不用反正/余弦函数?
- 四足机器人——3自由度机械臂正逆解(肘式+膝式)
- 机器人过程自动化RPA人力资源领域的应用
- 斯坦福提出神经任务编程NTP:让机器人从层级任务中学习
- orocod_kdl学习(二):KDL Tree与机器人运动学
- MeArm 1.6.1机器人操纵杆板记录移动过程
- 带戒指的四足机器人
- 厉害了!浙大研发出踹不倒四足机器人“绝影”,中国版波士顿动力来了
- [机械臂运动学系列]机械臂及其笛卡尔坐标正逆解算(四)
- UR机械臂运动学正逆解方法
- 从Big Dog到Spot Mini:波士顿动力「四足机器人」进化史概览
- ROS 学习系列 -- RViz 实时观测机器人建立导航2D封闭空间地图过程 (SLAM)
- Pioneer3dx机器人导航过程中转圈的解决方法
- 问答机器人,聊天类App的开发制作过程记录
- 斯坦福《编程方法学》Karel环境搭建问题一:运行时出现jpanel面板只有file选项 没有karel机器人的现象
- Matlab机器人工具箱(1)——机器人的建立、绘制与正逆运动学
- [机械臂运动学系列]机械臂及其笛卡尔坐标正逆解算(三)