3 Star 3 Fork 3

gunterdai/GPS_Milemeter_IMU_EKFLocation

加入 Gitee
与超过 1200万 开发者一起发现、参与优秀开源项目,私有仓库也完全免费 :)
免费加入
文件
该仓库未声明开源许可证文件(LICENSE),使用请关注具体项目描述及其代码上游依赖。
克隆/下载
TrueRoute.m 1.12 KB
一键复制 编辑 原始数据 按行查看 历史
gilbertz 提交于 2016-03-14 22:05 . 添加了真值路径
function[X,Y] = TrueRoute(Ts,offtime)
%产生真实航迹[X,Y],并在真实坐标系下绘制
%Ts为gps观测周期,每隔Ts时间得到一个观测数据
%offtime为仿真的时间,车速大概为0-8m/S,微电子学院大楼的环绕距离大约400m,按车速1m/s来走,时间为400s
if nargin>2
error('输入的变量过多,请检查');
end
x=zeros(offtime,1);
y=zeros(offtime,1);
X=zeros(ceil(offtime/Ts),1);
Y=zeros(ceil(offtime/Ts),1);
% t=0:100s,速度vx,vy为沿着x轴和y轴的分量(m/s)
x0=50;
y0=50;
vx=1;%速度为1m/s,先沿着x轴
vy=0;
for t=1:100
x(t)=x0+vx*t;
y(t)=y0+vy*t;
end
% t=100:200s,速度vx,vy为沿着x轴和y轴的分量(m/s)
vx=0;%速度为1m/s,先沿着x轴
vy=1;
for t=0:100
x(t+101)=x(100)+vx*t;
y(t+101)=y(100)+vy*t;
end
% t=200:300s,速度vx,vy为沿着x轴和y轴的分量(m/s)
vx=-1;%速度为1m/s,先沿着x轴
vy=0;
for t=0:100
x(t+201)=x(201)+vx*t;
y(t+201)=y(201)+vy*t;
end
% t=300:400s,速度vx,vy为沿着x轴和y轴的分量(m/s)
vx=0;%速度为1m/s,先沿着x轴
vy=-1;
for t=0:100
x(t+301)=x(301)+vx*t;
y(t+301)=y(301)+vy*t;
end
% 得到观测数据
for n=0:Ts:offtime
X(n/Ts+1)=x(n+1);
Y(n/Ts+1)=y(n+1);
end
% %显示真实轨迹
% plot(X,Y,'LineWidth',2),axis([0 200 0 200]),grid on;
% legend('目标真实航迹');
马建仓 AI 助手
尝试更多
代码解读
代码找茬
代码优化
1
https://gitee.com/gunterdai/GPS_Milemeter_IMU_EKFLocation.git
git@gitee.com:gunterdai/GPS_Milemeter_IMU_EKFLocation.git
gunterdai
GPS_Milemeter_IMU_EKFLocation
GPS_Milemeter_IMU_EKFLocation
master

搜索帮助