fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-05-02 05:04:08 +08:00
Code Issues Packages Projects Releases Wiki Activity

scripts: derive conversion from polar to cartesian wind state covariance

Browse Source
This commit is contained in:
Paul Riseborough 2016-07-24 21:14:29 +10:00 committed by CarlOlsson
parent a9894d7e8c
commit eff9af549f
1 changed files with 8 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

8
matlab/scripts/Inertial Nav EKF/polar2cart_cov.m Normal file
View File

@ -0,0 +1,8 @@
clear all;
syms spd yaw real;
syms R_spd R_yaw real;
vx = spd*cos(yaw);
vy = spd*sin(yaw);
Tpc = jacobian([vx;vy],[spd;yaw]);
R_polar = [R_spd 0;0 R_yaw];
R_cartesian = Tpc*R_polar*Tpc';