轨迹跟踪求解函数

Posted Jeossirey

tags:

篇首语:本文由小常识网(cha138.com)小编为大家整理,主要介绍了轨迹跟踪求解函数相关的知识,希望对你有一定的参考价值。

 1.Fmincon函数介绍

在matlab中,fmincon函数可以求解带约束的非线性多变量函数(Constrained nonlinear multivariable function)的最小值,即可以用来求解非线性规划问题

matlab中,非线性规划模型的写法如下


2.基本语法

[x,fval]=fmincon(fun,x0,A,b,Aeq,beq,lb,ub,nonlcon,options)

x的返回值是决策向量x的取值,fval的返回值是目标函数在x处的f(x)的取值。

fun是用M文件定义的函数f(x),代表了(非)线性目标函数;x0是x的初始值;A,b,Aeq,beq定义了线性约束 ,如果没有线性约束,则A=[ ],b=[ ],Aeq=[ ],beq=[ ]

lb和ub是变量x的下界和上界,如果下界和上界没有约束,则lb=[ ],ub=[ ],也可以写成lb的各分量都为 -inf,ub的各分量都为inf

nonlcon是用M文件定义的非线性向量函数约束;options定义了优化参数,不填写表示使用Matlab默认的参数设置


3.解题思路

如果我们要解这一道题目,我们的思维过程:

1.目标函数定义

function f=fun1(x);
f=x(1).^2+x(2).^2+x(3).^2+8;

 2.定义非线性约束条件

function [g,h]=fun2(x);
g=[-x(1).^2+x(2)-x(3).^2
    x(1)+x(2).^2+x(3).^3-20];
h=[-x(1)-x(2).^2+2
    x(2)+2*x(3).^2-3];

3.编写主程序函数

[x,y]=fmincon('fun1',rand(3,1),[],[],[],[],zeros(3,1),[],'fun2')

4.得出结果

x1=0.5522,x2=1.2033,x3=0.9478最小值y=10.651

参考:https://www.cnblogs.com/goodtwo/p/11146540.html

以上是关于轨迹跟踪求解函数的主要内容,如果未能解决你的问题,请参考以下文章

MPC算法轨迹跟踪控制资源

自动驾驶PID实现轨迹跟踪

《无人驾驶车辆模型预测控制》——路径规划及轨迹跟踪控制

opencv运动车里检测跟踪轨迹不对

基于yolov5与Deep Sort的流量统计与轨迹跟踪

高空无人机视角下的路口车辆与行人检测跟踪与轨迹刻画