基于伪逆的三点法距离求位置，MATLAB源代码（MATLAB函数）

原创已于 2024-07-21 10:25:04 修改 · 495 阅读

1 ·

CC 4.0 BY-SA版权

文章标签：

#matlab #开发语言 #算法

于 2024-03-12 12:49:26 首次发布

定位与导航专栏收录该内容

157 篇文章

订阅专栏

该篇文章介绍了如何使用一个函数，通过给定多个已知点的位置和它们到未知点的距离，利用线性代数求解出未知点在三维空间中的坐标。函数通过计算和求逆矩阵实现，提供了代码示例进行测试。

程序介绍

这是一个函数，输入距离和已知点位置，输出未知点的位置。
已知点三个，未知点一个，已知点和未知点的距离也是有三个。

代码测试/运行结果

未完待续
完整的代码如下（直接复制到MATLAB里面就能运行）：

% 三点法加权最小二乘定位
% author:Evand
clear;clc;close all;
rng(0);
%% 主程序
point1 = [1,1];
baseP = [
    0,1;
    0,0;
    2,2;
    2,0];
R_calcu = sqrt(diag((point1-baseP)*(point1'-baseP')))+randn; %含噪声的距离
weight = eye(3); %权重设置，如果不用权重，这里不动即可
[p_out] = triposition_weight(R_calcu,baseP,weight);
% 剩余代码下载链接：https://mbd.pub/o/bread/ZpialZ9w
%% 绘图