blob: 72fa86605dbaac3cc11cbdd00051103662c9c94b (
plain) (
blame)
1
2
3
4
5
6
7
8
9
10
11
12
13
|
function [ position ] = get_position( aprox_v, prev_p, delta_t)
%GET_POSITION: Uppskattar position utifrån förra positionen och hastigheten
%{
Använder s = v*t för att beräkna skillnaden i strecka sedan förra cykeln.
v är just nu medelhastigheten för nuvarande segment förra cykeln.
dt är just nu samma tic toc som checkar att cykeln inte var mer än 0.1 s.
%}
v = aprox_v;
dt = delta_t;
dp = v*dt;
position = prev_p + dp;
end
|
