trace_dece_water.m

北京到广州铁路路线仿真

function [long,lat]=trace_dece_water(long0,lat0,theta,t0)
%减速过程
Re=6378137;
f=1/298.157;
trans=2*pi/360;
v = 10;
v0=v;
dt=10;
Tacc=1000;%600;
a=v/Tacc;
i=1;
t=t0;
while v0>0%减速进站，速度为零时停止
    Rm=Re*(1+2*f-3*f*sin(trans*lat0)^2);
    Rn=Re/((1-f)^2*sin(trans*lat0)^2+cos(trans*lat0)^2);   
    deltalong=(v0*dt-a*dt*(t-t0)-0.5*a*dt^2)*cos(theta)/(Rm*cos(trans*lat0)*trans);
    deltalat=(v0*dt-a*dt*(t-t0)-0.5*a*dt^2)*sin(theta)/(Rn*trans);
    long(i)=long0+deltalong;
    lat(i)=lat0+deltalat;
    t=t+dt;
    v0=v-a*(t-t0);
    long0=long(i);
    lat0=lat(i);
    i=i+1;
end