无人驾驶车辆模型预测控制-2.1.2车辆动力学模型验证

验证模型:
在这里插入图片描述输入:

  1. 车速-t
    在这里插入图片描述
  2. 前轮偏角-t
    在这里插入图片描述
    输出:

1 纵向坐标-t
在这里插入图片描述
2 航向角-t
在这里插入图片描述


function [ sys,x0,str,ts ] = fun_2_1_2( t,x,u,flag )
%UNTITLED2 此处显示有关此函数的摘要
%   此处显示详细说明
switch flag,
 case 0
  [sys,x0,str,ts] = mdlInitializeSizes; % Initialization
  
 case 1
  sys = mdlDerivatives(t,x,u); % Update discrete states
  
 case 3
 sys = mdlOutputs(t,x,u); % Calculate outputs
 
%  case 4
%   sys = mdlGetTimeOfNextVarHit(t,x,u); % Get next sample time 

 case {2,4,9} % Unused flags
  sys = [];
  
 otherwise
  error(['unhandled flag = ',num2str(flag)]); % Error handling
end
% End of dsfunc.

%==============================================================
% Initialization
%==============================================================

function [sys,x0,str,ts] = mdlInitializeSizes

% Call simsizes for a sizes structure, fill it in, and convert it 
% to a sizes array.

sizes = simsizes;
sizes.NumContStates  = 3; %
sizes.NumDiscStates  = 0; %
sizes.NumOutputs     = 2;
sizes.NumInputs      = 2;
sizes.DirFeedthrough = 0; % Matrix D is non-empty.
sizes.NumSampleTimes = 0;
sys = simsizes(sizes); 
x0=[0 0 0];
str = [];             % Set str to an empty matrix.
ts  = [];       % sample time: [period, offset]
%End of mdlInitializeSizes

function sys=mdlDerivatives(t,x,u)
l=2.7;
sys=[cos(x(3));sin(x(3));tan(u(2))/l]*u(1);

function sys=mdlOutputs(t,x,u)
sys = [x(2);x(3)];




  • 7
    点赞
  • 26
    收藏
    觉得还不错? 一键收藏
  • 6
    评论
评论 6
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值