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

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

接之前的内容,现在开始考虑势场函数
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)

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

相关推荐
向阳逐梦1 天前
ROS2 高级组件中的webots介绍
机器人
ModestCoder_1 天前
将一个新的机器人模型导入最新版isaacLab进行训练(以unitree H1_2为例)
android·java·机器人
跳跳糖炒酸奶1 天前
第四章、Isaacsim在GUI中构建机器人(2):组装一个简单的机器人
人工智能·python·算法·ubuntu·机器人
csssnxy1 天前
网红指路机器人的主要功能有哪些?
机器人
跳跳糖炒酸奶1 天前
第四章、Isaacsim在GUI中构建机器人(1): 添加简单对象
人工智能·python·ubuntu·机器人
扫地的小何尚1 天前
NVIDIA工业设施数字孪生中的机器人模拟
android·java·c++·链表·语言模型·机器人·gpu
硅谷秋水1 天前
MoLe-VLA:通过混合层实现的动态跳层视觉-语言-动作模型实现高效机器人操作
人工智能·深度学习·机器学习·计算机视觉·语言模型·机器人
OpenLoong 开源社区1 天前
技术视界 | 从哲学到技术:人形机器人感知导航的探索(下篇)
人工智能·机器人·开源社区·人形机器人·openloong
机器人之树小风2 天前
KUKA机器人零点校正工具EMD
经验分享·科技·机器人
Wnq100722 天前
智能巡检机器人在化工企业的应用研究
运维·计算机视觉·机器人·智能硬件·deepseek