46 lines
915 B
Matlab
46 lines
915 B
Matlab
clear all
|
|
close all
|
|
clc
|
|
|
|
azi = -90 : 0.1 : 90;
|
|
elv = -15 : 0.1 : 15;
|
|
|
|
% Reference point (origin)
|
|
x_rdr = 0;
|
|
y_rdr = 0;
|
|
z_rdr = 0;
|
|
|
|
vx_rdr = 0;
|
|
vy_rdr = 70/3.6;
|
|
vz_rdr = 0;
|
|
|
|
x_tgt_str = 4;
|
|
y_tgt_str = -10;
|
|
z_tgt_str = 0;
|
|
|
|
x_tgt_mov = 0;
|
|
y_tgt_mov = -10;
|
|
z_tgt_mov = 0;
|
|
|
|
vx_tgt_mov = 0;
|
|
vy_tgt_mov = 1.3905;
|
|
vz_tgt_mov = 0;
|
|
|
|
|
|
pos_rdr = [x_rdr, y_rdr, z_rdr];
|
|
vel_rdr = [vx_rdr, vy_rdr, vz_rdr];
|
|
|
|
pos_tgt_str = [x_tgt_str, y_tgt_str, z_tgt_str];
|
|
pos_tgt_mov = [x_tgt_mov, y_tgt_mov, z_tgt_mov];
|
|
vel_tgt_mov = [vx_tgt_mov, vy_tgt_mov, vz_tgt_mov];
|
|
vel_tgt_str = [0 0 0];
|
|
|
|
rel_r_vec_str = pos_tgt_str - pos_rdr
|
|
rel_r_vec_mov = pos_tgt_mov - pos_rdr
|
|
rel_v_vec_mov = vel_tgt_mov - vel_rdr
|
|
rel_v_vec_str = vel_tgt_str - vel_rdr
|
|
|
|
rng_str = norm(rel_r_vec_str)
|
|
rng_mov = norm(rel_r_vec_mov)
|
|
rel_vel_mov = rel_v_vec_mov * rel_r_vec_mov'/norm(rel_r_vec_mov)
|
|
rel_vel_str = rel_v_vec_str * rel_r_vec_str'/norm(rel_r_vec_str) |