机器人姿态规划的三种常见方法:欧拉角、角轴和四元数
创始人
2024-05-29 11:43:39
0

参考文献:

1. 布鲁诺·西西里安诺等[意] 《机器人学:建模、规划与控制》

2. 四元数小总结 - 孤独の巡礼 - 博客园 (cnblogs.com)

3. 基于单位四元数的姿态插补(Matlab) - 知乎 (zhihu.com)

4. 基于四元数的工业机器人姿态规划与插补算法的研究 - 豆丁网Docin

本文总结了用于机器人姿态规划的常见三种姿态规划方法,包括:欧拉角、角轴以及四元数。三种方法各有优劣,根据使用场景自由选择。

欧拉角

通过为欧拉角欧拉角ϕ= (φθ,ψ) 指定时间律来描述指向。通常使用三次多项式或混合抛物线线性分段时间律是方便的。基于这种方法,时变坐标系的角速度将具有连续量。

例子:

已知条件:初始和目标欧拉角已知,初始速度、加速度为0,最终速度、加速度为0。插值时间为tf。使用五次多项式时间律可以满足条件,位置、速度、加速度均连续。

有插值公式:

但是欧拉角姿态规划的方法存在万向节锁死的问题。

角轴

对于定义在操作空间的误差变量(位置和方向)进行处理,其表达式由下式给出:

e_{p}=p_{s}-p_{e} 

其中, 表示末端执行器的期望值, 表示末端执行器的计算值。

对于涉及到方向误差的部分,其表达式取决于末端执行器方向的详细表示,即,欧拉角,角和轴,单位四元数。

对于初始旋转矩阵 和目标旋转矩阵 ,有:

Re= Rs* R_{e}^{s}

所以有,

R_{e}^{s}= R_{s}^{-1}*R _{e}

对于旋转变换 ,可以表示为绕空间中一固定轴的旋转矩阵。计算轴的单位向量 ,可以求得初始旋转矩阵绕该轴的角速度和角加速度。

其中,轴的单位向量

指定一个时间律,当 ,且有 。我们使用五次多项式插值为 指定时间律,其中, 为总的姿态运动时间,由人为指定。

为常量,由此得到的速度和加速度为:

\omega ^{ i}=\dot{\theta }r^{i}

\dot{\omega }^{t}=\ddot{\theta }r^{i}

最后,为了表征末端执行器关于基坐标系的指向轨迹,需要进行如下变化:

R_{e}(t) = R_{i}R^{i}(t)

\omega _{e}(t) = R_{i}\omega ^{i}(t)

\dot{\omega}(t) = R_{i}\dot{\omega ^{i}}(t)

由此我们可以获取机械臂的姿态关节的运动速度,再通过雅可比逆解到各个关节。

但是以上基于角轴表达式的姿态规划存在奇异问题,当   = 0或   = Π时,单位向量r是奇异的。我们对  = 0这种场景进行了特殊处理。当  = 0时,默认姿态无转动,强制规划各姿态关节速度为0。  = Π时尚未做处理,后续考虑进行补充优化。

四元数

1. 四元数基础公式

 

 2. 四元数球面线性插值

 2.1 四元数球面线性插值的基本概念:

2.2 四元数球面线性插值的基本公式

我们采用第二种构造方式进行姿态规划!

 

相关内容

热门资讯

北汽福田2024年报解读:净利... 北汽福田汽车股份有限公司(以下简称“北汽福田”或“公司”)近日发布2024年年度报告,各项财务数据变...
原地掉头、蟹行模式、双30英寸... 在刚刚开幕的上海车展上,领克旗下全新大型SUV首发亮相,新车将于晚些的4月28日正式上市。该车基于S...
三千年前,“重要的事情说七遍”... 转自:新华每日电讯“重要的事情说七遍”!四字铭文“实证”北京三千年建城史人们常说“重要的事情说三遍”...
240小时“遇见”广交会,广州... 中国青年报客户端讯(中青报·中青网记者 林洁)4月23至27日,第137届中国进出口商品交易会(以下...
特朗普回应泽连斯基:选择和平,... 此前,泽连斯基称,乌克兰不会在法律上承认(俄方)对克里米亚的占领,表示“在这个问题上没什么好谈”。泽...
迟来的忍者与武士:从《刺客信条... 2025年3月,以古代日本为背景的《刺客信条》系列终于推出正统续作《刺客信条:影》(以下简称《影》)...
通州运河上演时空穿越大戏 【#通州运河上演时空穿越大戏#】#运河上的通州#“通漕天下,开运大吉”,2025大运河文化推广活动于...
同济科技:六大板块业务协同发力... 上证报中国网讯(记者高志刚)4月26日,发布了2024年年报。数据显示,公司全年实现营业收入41.7...
硬派“方盒子”!AI智能四驱、... 日前,我们从上海车展展台获悉,吉利银河战舰将于2026年上市。新车在刚刚开幕的上海车展上正式发布,定...
突然就火了!不少人都买过!看似... 从几百到近万元不等,号称能护眼防近视的“大路灯”值得买吗?近期,“落地护眼灯”受到家长群体的追捧,因...
快评 | 工程院8个名额有深意... 昨天,2025年两院院士增选工作启动。中国工程院明确提出将8个名额主要用于支持民营科技领军企业候选人...
瑞斯康达2024年报解读:经营... 瑞斯康达科技发展股份有限公司于近日发布2024年年度报告,报告期内,公司面临诸多挑战,多项关键财务指...
厦门金龙汽车2025年一季度财... 厦门金龙汽车集团股份有限公司于近日发布2025年第一季度财报,各项财务数据变动引发关注。本文将对关键...
建行深圳分行又一副行长被查! 自2022年以来,建行深圳分行被查的高管干部就有九人,这一切还是由前行长王业开始。作者丨财媒汇· ·...
多地传来好消息!生育津贴直接发... 转自:国家医保局医保部门持续推进生育津贴发放至个人,今年3月份以来,在此前7个省(市)全部实现生育津...
“最好牧场为航天” 67年后她... 转自:草原云2025年4月24日17时17分,内蒙古阿拉善盟额济纳旗的东风航天城,长征二号F遥二十运...
娄底市委书记调整 转自:北京日报客户端据《湖南日报》消息,4月26日,娄底市召开全市领导干部会议,宣布省委有关人事安排...
美国上演罕见一幕:FBI冲进法... 根据美国司法部和联邦调查局通报,当地时间周五联邦特工在密尔沃基县巡回法院逮捕了一名法官,因她涉嫌帮助...
三亚一景区发生游客溺亡事件,官... “古韵崖州”微信公号4月25日,三亚市崖州区旅游工作领导小组办公室发布关于三亚市崖州区某景区游客溺亡...
网警提醒:“银狐”木马病毒再度... 转自:公安部网安局素材 | 天津网警