diff options
| author | Albin <albwa833@student.liu.se> | 2019-11-08 11:59:19 +0100 |
|---|---|---|
| committer | Albin <albwa833@student.liu.se> | 2019-11-08 11:59:19 +0100 |
| commit | 2ad11b85f7d5d4a71477a02a1ca5ba8786652c35 (patch) | |
| tree | d788ba4c56f15437b596b2acc1198b20ee1254ba /Kod/bilbana/yc4/get_aprox_v.m | |
| parent | 84a1ee353c4d5de456254828542d4b604781db23 (diff) | |
| download | tfyy51-2ad11b85f7d5d4a71477a02a1ca5ba8786652c35.tar.gz | |
Missade givare
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 |