已知我船此刻的经纬度，未知目标经纬度，和同一时刻目标位于我船的舷角以及声纳接收到目标的信号频率，基于多普勒频移解算目标距离，速度，航向，生成matlab代码

以下是基于多普勒频移解算目标距离、速度、航向的 Matlab 代码：

% 已知参数
lat1 = ; % 我船纬度（单位：度）
lon1 = ; % 我船经度（单位：度）
lat2 = ; % 目标纬度（单位：度），未知
lon2 = ; % 目标经度（单位：度），未知
bearing_deg = ; % 目标在我船上的舷角（单位：度）
freq = ; % 声纳接收到目标的信号频率（单位：Hz）

% 常数
c = 1500; % 声速（单位：m/s）
f0 = 10000; % 发射频率（单位：Hz）

% 将经纬度转换为直角坐标系下的坐标
[x1,y1,z1] = geodetic2ecef(lat1,lon1,0); % 我船
[x2,y2,z2] = geodetic2ecef(lat2,lon2,0); % 目标

% 计算我船与目标之间的距离
d = sqrt((x2-x1)^2 + (y2-y1)^2 + (z2-z1)^2);

% 计算我船与目标之间的方位角和仰角
azimuth_deg = atan2(y2-y1, x2-x1) * 180/pi;
elevation_deg = asin((z2-z1)/d) * 180/pi;

% 将方位角转换为以正北方向为参考的角度
if azimuth_deg < 0
    azimuth_deg = azimuth_deg + 360;
end
bearing_true_deg = azimuth_deg - bearing_deg;
if bearing_true_deg < 0
    bearing_true_deg = bearing_true_deg + 360;
end

% 计算目标的速度
v = -freq * c / (2 * f0 * cosd(elevation_deg));

% 计算目标的航向
course_deg = atan2d(sind(bearing_true_deg), cosd(bearing_true_deg) * cosd(elevation_deg));

% 打印结果
fprintf('目标距离：%f m\n', d);
fprintf('目标速度：%f m/s\n', v);
fprintf('目标航向：%f deg\n', course_deg);

需要注意的是，上述代码中用到了 `geodetic2ecef` 函数，需要先将 Matlab 的 Mapping Toolbox 安装并加载。如果没有安装，可以使用以下代码替代 `geodetic2ecef` 函数：

function [x, y, z] = geodetic2ecef(lat, lon, h)
% 将经纬度（单位：度）和高度（单位：米）转换为直角坐标系下的坐标（单位：米）
% 参考资料：https://en.wikipedia.org/wiki/Geographic_coordinate_conversion

a = 6378137; % 赤道半径（单位：米）
f = 1/298.257223563; % 扁率
b = a*(1-f); % 极半径（单位：米）
e = sqrt(1 - (b/a)^2); % 第一偏心率

lat = lat * pi/180; % 转换为弧度
lon = lon * pi/180; % 转换为弧度

N = a ./ sqrt(1 - e^2 * sin(lat).^2);
x = (N + h) .* cos(lat) .* cos(lon);
y = (N + h) .* cos(lat) .* sin(lon);
z = (N*(1-e^2) + h) .* sin(lat);
end