diff options
| author | Gustav Sörnäs <gusso230@student.liu.se> | 2019-11-12 13:41:18 +0100 |
|---|---|---|
| committer | Gustav Sörnäs <gusso230@student.liu.se> | 2019-11-12 13:41:18 +0100 |
| commit | e2172ce2d019b0e80b16d2fa9fa55436a20748a5 (patch) | |
| tree | 840b161f2a591b50e335b3e157d02e87dc60b942 /Kod/bilbana/yc4/get_aprox_v.m | |
| parent | 984296b90a2ddcb8bbf913b9ac97d1be2045bfab (diff) | |
| parent | 8dc7e738c5545d26ff0379e593a2e3980e6737bc (diff) | |
| download | tfyy51-e2172ce2d019b0e80b16d2fa9fa55436a20748a5.tar.gz | |
Merge remote-tracking branch 'origin/smart'
Diffstat (limited to 'Kod/bilbana/yc4/get_aprox_v.m')
| -rw-r--r-- | Kod/bilbana/yc4/get_aprox_v.m | 16 |
1 files changed, 13 insertions, 3 deletions
diff --git a/Kod/bilbana/yc4/get_aprox_v.m b/Kod/bilbana/yc4/get_aprox_v.m index 41a3c9e..64fa821 100644 --- a/Kod/bilbana/yc4/get_aprox_v.m +++ b/Kod/bilbana/yc4/get_aprox_v.m @@ -1,4 +1,4 @@ -function [v] = get_aprox_v(cur_seg,last_seg_times) +function [v] = get_aprox_v(cur_seg, lap, seg_times) %GET_APROX_V Tillfällig? Behövs för att testa get_position. Ger %medelhastigheten för nuvarande segment på förra varvet. %{ @@ -8,8 +8,18 @@ last_seg_times: 1x9 vektor med förra varvets segmenttider seg_len1 = [2.53 0.53 1.68 2.92 1.2 2.01 3.83 2.89 1.99]; % seg_len2 = [2.53 0.53 1.87 2.68 1.24 1.81 4.03 3.09 2.19]; -%v = last_seg_times(cur_seg)/seg_len(cur_seg); -v = seg_len1(cur_seg)/last_seg_times(cur_seg); +if cur_seg > 9 + cur_seg = cur_seg - 9; +end + +while lap > 0 + lap = lap - 1; + if seg_times(lap, cur_seg) ~= 0 + v = seg_len1(cur_seg)/seg_times(lap, cur_seg); + return + end +end +disp('bara nollor?'); % switch(track) % case 1 |