本文主要是介绍智能机器人系统(国防科技大学),希望对大家解决编程问题提供一定的参考价值,需要的开发者们随着小编来一起学习吧!
智能机器人系统–第三章机器人运动控制
3.1 轮式机器人构型
3.2 机器人运动规划—N个控制点的B样条曲线
这个讲解非常详细,一直困惑的三个点:多段的曲线如何保证光滑、如何过指定的点、相邻段的控制点有何关系 终于得到了解答!
s是规划的路程,0到1表示起点到终点
三阶B样条,有四个控制点,四个样条函数
C1是(0,0),C2是(1,1),C3是(2,1),C4是(3,0)
B样条是不过首尾控制点的。
两段B样条的生成:
5个控制点即可生成两段。(关键)
这里其实就是分段三次b样条曲线了,原来是这么实现的!!
下一步还需要让曲线过起点和终点
3.3 机器人运动规划—过起点和终点的B样条曲线
V1是起点的速度方向;L是正整数,一般选为小车车长的一般。
带入求解得到:
这个性质可以利用一下,可以在中间某个位置,约束一下曲线,比如过圆弧最高点,或者过直线的终点等。
3.4 机器人运动规划—B样条曲线的曲率
B样条如何约束曲率一直不明白,这里终于学到了!
Cal_P(s)模块如下:
3.5 机器人运动学模型—Car-Like小车运动学模型
用后轮中心更简单,所以后边就用后轮中心,而不用质心!!
注意,这里是用小车后轮中心建模的。因为后轮的表达式简单,一般用后轮。
3.6 机器人运动学模型—Tank-Like小车运动学模型
对于car-like,用的是小车后轮中心,对于tank-like用的是车轮中心位置。
当前向速度V为零时,也就是静止,曲率时无限大的。
清洗车应该就是这种。一般在前进速度和转向能力之间取个折中的值。
3.7 机器人动力学模型及简化
FR和FF是不知道的,所以是非完整约束问题。
Tv和Tfai可以通过实验测量。
3.8 机器人路径跟踪控制—控制误差分析
R是一个二维变量,可以在小车前向和法向上进行投影。
3.9 机器人路径跟踪控制—Car-Like小车曲线跟踪线性化模型及控制器设计
上边的方程都是非线性方程,需要线性化。
Vs代表小车沿着期望方向的前向速度,d为横向控制偏差,θp方位角偏差,fai为转向角。用这四个变量把这些方程描述清楚。
关于这四个变量的非线性方程,在工作点附近对其线性化。
最终得到两个模型:横向偏差控制模型,三阶的模型;前向速度控制模型。
算法很多,下边是一个pd控制器
由此到得到小车曲线跟踪的两个法向和前向的线性模型。
3.10 机器人路径跟踪控制—Tank-Like小车曲线跟踪线性化模型及控制器设计
用三元组描述,进行线性化
vs代表前向速度,d代表横向偏差,θp代表方位角误差。
3.11 机器人运动控制总结
这篇关于智能机器人系统(国防科技大学)的文章就介绍到这儿,希望我们推荐的文章对编程师们有所帮助!