Mirrors_Framework/paparazzi
1
0
Fork 0
mirror of https://github.com/paparazzi/paparazzi.git synced 2026-06-06 16:58:48 +08:00
Code Issues Actions 25 Packages Projects Releases Wiki Activity

swing psi

Browse Source
This commit is contained in:
Antoine Drouin
2010-02-24 14:37:40 +00:00
parent a334a1b92a
commit 6fe99060af
1 changed files with 4 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files
sw/simulator/scilab/q6d/q6d_sbb.sci
+4 -1
View File
@@ -41,8 +41,11 @@ function [fo_traj] = sbb_gen_traj(time, dyn, max_speed, max_accel, b0, b1)
fo_traj = zeros(n_comp, order, length(time));
// psi
omega = rad_of_deg(45);
for i=1:length(time)
fo_traj(4,1,i) = rad_of_deg(30);
fo_traj(4,1,i) = sin(omega*time(i));
fo_traj(4,2,i) = omega*cos(omega*time(i));
fo_traj(4,3,i) = -omega^2*sin(omega*time(i));
end
// x and y