机器人中的数值优化进阶|【三】三次样条曲线推导(下)

机器人中的数值优化进阶|【三】三次样条曲线推导(下)

接之前的内容,现在开始考虑势场函数
P ( η 1 , . . . , η n − 1 ) = 1000 ∑ i = 1 n − 1 ∑ j = 0 m max ⁡ ( r j − ∣ ∣ η i − o j ∣ ∣ , 0 ) P(\eta_1,...,\eta_{n-1}) = 1000 \sum_{i=1}^{n-1}\sum_{j=0}^{m} \max(r_j-||\eta_i-o_j||, 0) P(η1,...,ηn−1)=1000i=1∑n−1j=0∑mmax(rj−∣∣ηi−oj∣∣,0)

势场函数的计算较为容易,主要关注梯度的推导与计算
∣ ∣ η i − o j ∣ ∣ = ( ( η i , 0 − o j , 0 ) 2 + ( η i , 1 − o j , 1 ) 2 ) 1 2 ||\eta_i-o_j|| = ((\eta_{i,0}-o_{j,0})^2 + (\eta_{i,1}-o_{j,1})^2)^{\frac{1}{2}} ∣∣ηi−oj∣∣=((ηi,0−oj,0)2+(ηi,1−oj,1)2)21

当 r j − ∣ ∣ η i − o j ∣ ∣ < 0 r_j-||\eta_i-o_j||<0 rj−∣∣ηi−oj∣∣<0时,
δ P δ η = − 1000 ∑ i = 1 n − 1 ∑ j = 0 m ( ( η i , 0 − o j , 0 ) δ η i , 0 δ η + ( η i , 1 − o j , 1 ) δ η i , 1 δ η ∣ ∣ η i − o j ∣ ∣ ) \frac{\delta P}{\delta \eta} = -1000\sum_{i=1}^{n-1}\sum_{j=0}^{m}(\frac{(\eta_{i,0}-o_{j,0})\frac{\delta \eta_{i,0}}{\delta \eta}+(\eta_{i,1}-o_{j,1})\frac{\delta \eta_{i,1}}{\delta \eta}}{||\eta_i-o_j||}) δηδP=−1000i=1∑n−1j=0∑m(∣∣ηi−oj∣∣(ηi,0−oj,0)δηδηi,0+(ηi,1−oj,1)δηδηi,1)

通过该式可以组装一个矩阵计算公式,得到梯度

相关推荐
FreeIPCC16 小时前
电话机器人是什么?
大数据·人工智能·语言模型·机器人·开源·信息与通信
FreeIPCC1 天前
如何评估电话机器人的效果?
大数据·人工智能·语言模型·机器人·开源·信息与通信
FreeIPCC1 天前
开源电话机器人产品的优点是什么?
大数据·人工智能·语言模型·机器人·信息与通信
Mr.Winter`1 天前
优化求解 | 非线性最小二乘优化器Ceres安装教程与应用案例
人工智能·机器人·自动驾驶·ros·数值优化
Robot2512 天前
人形机器人赛道资本之争:“南”[智元机器人],“北”[银河通用]
人工智能·机器人
Matlab程序猿小助手2 天前
【MATLAB源码-第222期】基于matlab的改进蚁群算法三维栅格地图路径规划,加入精英蚁群策略。包括起点终点,障碍物,着火点,楼梯。
开发语言·人工智能·算法·matlab·机器人·无人机
儒雅芝士2 天前
Ros2 操作指令记录
c++·python·机器人
GAOJ_K2 天前
产业用机器人中的旋转花键若损伤有何影响?
科技·机器人·自动化·制造
视言2 天前
大模型时代的具身智能系列专题(十二)
人工智能·深度学习·计算机视觉·机器人·具身智能
FreeIPCC2 天前
部署一套开源客服系统,用户需要准备什么设备?
大数据·人工智能·语言模型·机器人·开源·信息与通信