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)