本发明公开基于高斯‑马尔科夫的机载雷达安置误差插值校正方法，属于激光雷达测量技术领域，用于对机载雷达的安置误差进行校正，包括：建立与求解具有抗差性的平面方程，去除点云面中的异常点和粗差点；进行基于平面约束的安置误差平差解算，将安置角误差作为未知参数，将激光扫描坐标系转换到惯性平台参考坐标系，结合机载激光雷达系统几何定位模型中的观测值，建立标定模型，利用附有参数的条件平差进行参数解算，然后将安置偏心距误差作为参数，进行同样的解算，即可求得安置误差，最后进行分步平差解算。
1.基于高斯‑马尔科夫的机载雷达安置误差插值校正方法，其特征在于，包括：S1.建立与求解具有抗差性的平面方程，去除点云面中的异常点和粗差点；
将安置角误差作为未知参数，将激光扫描坐标系转换到惯性平台参考坐标系，结合机载激光雷达系统几何定位模型中的观测值，建立标定模型，利用附有参数的条件平差进行参数解算，然后将安置偏心距误差作为参数，进行同样的解算，即可求得安置误差；
建立与求解具有抗差性的平面方程包括：S1.1.设需要拟合的平面方程为：（1）；
式中，a、b、c、d是方程参数，x、y、z表示点的坐标；
认定平面方程构成的法向量为单位法向量，即：（2）；
求特征值方程的系数矩阵的最小特征值及其对应的特征向量，即为所求得a、b、c，将所求得a、b、c带入式（3）中，即可求得d；
去除点云面中的异常点和粗差点包括：B1.1.根据S1求得的a、b、c、d，计算所有点到拟合平面的距离；
B1.4.利用剔除后的点云重新计算平面参数a、b、c、d；
B1.5.重复S2.1‑ S2.4，直到所有点都满足 ；
B1.5.将S2.5所求得a、b、c带入，式（3）中，即可求得d，此时获得最佳的平面拟合方程；
将安置角作为参数，平移量作为已知值，列出方程进行求解，使用全域最小二乘法应用高斯‑马尔柯夫模型，其解算原理包括：全域最小二乘法应用高斯‑马尔柯夫模型为：；
式中为安置误差， 为需测算的n行m列系数矩阵， 为存在于A中的误差矩阵，Y为需测算的误差向量，B为误差估计参数；
S3.1.建立全域最小二乘法应用高斯‑马尔柯夫模型；
其中 ， ， 、 、 、 、 、 皆为由矩阵的奇异值分解后的到的分解子矩阵；
S3.3.如果 非奇异,则可得 ，是一个记号线性回归，即给定若干个点做出一条直线与这若干个点的误差最小值；
S3.4.精度评定 ， 即安置误差的标准差， 在0.03‑0.1范围内，则安置误差精度可靠。
2.根据权利要求1所述的基于高斯‑马尔科夫的机载雷达安置误差插值校正方法，其特征在于，将激光扫描坐标系转换到惯性平台参考坐标系包括：S2.1.误差方程的观测值符号化表示为 ： ；
其中：为扫描极径；为扫描角；为横滚角；为俯仰角；为航偏角； 为参考中心在WGS84坐标系下的坐标；
S2.2.将激光扫描坐标系转换到惯性平台参考坐标系，包括：激光扫描坐标系到载体坐标系到惯性平台参考坐标系，定义俯仰角逆 旋转为正，侧滚角逆 旋转为正，航向角逆 旋转为正， 为激光扫描坐标系原点在惯性平台参考坐标系的坐标，假设安置角均为正， 为激光扫描坐标系的坐标轴， 为惯性平台参考坐标系的坐标轴；
S2.2.1.先绕 旋转△roll，△roll为横滚角， 变为 ：（11）；
S2.2.2.绕 旋转△pitch，△pitch为俯仰角， 变为 ：（12）；
S2.2.3.绕 旋转△yaw，△yaw为航偏角， 变为 ：（13）；
S3.2.4.综上式（11）、（12）、（13）可得：（14）；
3.根据权利要求2所述的基于高斯‑马尔科夫的机载雷达安置误差插值校正方法，其特征在于，将激光扫描坐标系转换到惯性平台参考坐标系后，执行以下步骤：S2.3.标定面点云对应标准面的平面方程 如下：；
为标准面参考靶点的坐标矩阵， 为平面方程安置旋转误差矫正转换矩阵，为平面方程安置偏心距误差矫正转换矩阵， 为标准面参考中心在WGS84坐标系下的坐标矩阵；
基于高斯‑马尔科夫的机载雷达安置误差插值校正方法
技术领域
[0001] 本发明公开基于高斯‑马尔科夫的机载雷达安置误差插值校正方法，属于激光雷达测量技术领域。
背景技术
[0002] 安置误差是国产机载激光雷达系统误差中最大的误差源，其中安置角误差定位精度的影响随航高的增加而增加，即INS 坐标参考框架和激光扫描参考系统之间的安置角误差是机载激光雷达中最大的系统误差源。根据经验，这些安置角误差通常为0.1 0.3°，安置~角误差对地面激光脚点坐标的影响还取决于飞行的高度和扫描角的大小。
[0003] 相比航空摄影测量，国产机载激光雷达的数据成果是点云，具有不规则性和离散性，不能保证在特征点处恰好存在测量数据，其同名点的概念真正意义上是不存在的，往往需要对连接关系进行转换。通过特征点、线进行匹配，将安置误差当做未知参数采用平差和最小二乘的方法进行标定，建立一定的模型进行拟合与内插，点云的密度越大得到的特征点的精度越高。
发明内容
[0004] 本发明的目的在于提供高斯‑马尔科夫的机载雷达安置误差插值校正方法，以解决现有技术中，机载雷达安置误差校正困难的问题。
[0005] 基于高斯‑马尔科夫的机载雷达安置误差插值校正方法，包括：
[0006] S1.建立与求解具有抗差性的平面方程，去除点云面中的异常点和粗差点；
[0007] S2.进行基于平面约束的安置误差平差解算；
[0008] 将安置角误差作为未知参数，将激光扫描坐标系转换到惯性平台参考坐标系，结合机载激光雷达系统几何定位模型中的观测值，建立标定模型，利用附有参数的条件平差进行参数解算，然后将安置偏心距误差作为参数，进行同样的解算，即可求得安置误差；
[0009] S3.分步平差解算。
[0010] 建立与求解具有抗差性的平面方程包括：
[0011] S1.1.设需要拟合的平面方程为：
[0012] （1）；
[0013] 式中，a、b、c、d是方程参数，x、y、z表示点的坐标；
[0014] 认定平面方程构成的法向量为单位法向量，即：
[0015] （2）；
[0016] 则空间内任意一点到平面的距离 表示为：
[0017] （3）；
[0018] 式中，xi、yi、zi表示任意一点的坐标；
[0019] S1.2.设最佳拟合平面约束条件 为：
[0020] （4）；
[0021] 构建拉格朗日辅助函数 ：
[0022] （5）；
[0023] 式中，是拉格朗日辅助函数的参数；
[0024] 对d求偏导，并令导数为0，求得：
[0025] （6）；
[0026] S1.3.将式（6）改写成：
[0027] （7）；
[0028] 其中，、、分别为xi、yi、zi的均值， ；
[0029] 对a、b、c求导并令导数为0，得：
[0030] （8）；
[0031] 式中， 为标准面各个参考靶点的安置偏心距误差；
[0032] S1.4.构建特征值方程：
[0033] （9）；
[0034] 求特征值方程的系数矩阵的最小特征值及其对应的特征向量，即为所求得a、b、c，将所求得a、b、c带入式（3）中，即可求得d。
[0035] 去除点云面中的异常点和粗差点包括：
[0036] B1.1.根据S1求得的a、b、c、d，计算所有点到拟合平面的距离；
[0037] B1.2.按照式（10）计算误差 ：
[0038] （10）；
[0039] 其中，n为点个数，为d的平均值， ；
[0040] B1.3.当满足 时，对应的点保留，否则剔除；
[0041] B1.4.利用剔除后的点云重新计算平面参数a、b、c、d；
[0042] B1.5.重复S2.1‑ S2.4，直到所有点都满足 ；
[0043] B1.5.将S2.5所求得a、b、c带入，式（3）中，即可求得d，此时获得最佳的平面拟合方程。
[0044] 将激光扫描坐标系转换到惯性平台参考坐标系包括：
[0045] S2.1.误差方程的观测值符号化表示为 ： ；
[0046] 其中：为扫描极径；为扫描角；为横滚角；为俯仰角；为航偏角； 为参考中心在WGS84坐标系下的坐标；
[0047] 误差方程的未知参数符号化表示为 ： ；
[0048] 其中： 为安置角误差， 为安置偏心距误差；
[0049] S2.2.将激光扫描坐标系转换到惯性平台参考坐标系，包括：
[0050] 激光扫描坐标系到载体坐标系到惯性平台参考坐标系，定义俯仰角逆 旋转为正，侧滚角逆 旋转为正，航向角逆 旋转为正， 为激光扫描坐标系原点在惯性平台参考坐标系的坐标，假设安置角均为正， 为激光扫描坐标系的坐标轴，为惯性平台参考坐标系的坐标轴；
[0051] S2.2.1.先绕 旋转△roll，△roll为横滚角， 变为 ：
[0052] （11）；
[0053] 式中， 为经过横滚角旋转后的 ；
[0054] S2.2.2.绕 旋转△pitch，△pitch为俯仰角， 变为 ：
[0055] （12）；
[0056] 式中， 为经过俯仰角旋转后的 ；
[0057] S2.2.3.绕 旋转△yaw，△yaw为航偏角， 变为 ：
[0058] （13）；
[0059] 式中， 为经过航偏角旋转后的 ；
[0060] S3.2.4.综上式（11）、（12）、（13）可得：
[0061] （14）；
[0062] 式中， 为简化矩阵， 。
[0063] 将激光扫描坐标系转换到惯性平台参考坐标系后，执行以下步骤：
[0064] S2.3.标定面点云对应标准面的平面方程 如下：
[0065] ；
[0066] 其中， ；
[0067] 为标准面参考靶点的坐标矩阵， 为平面方程安置旋转误差矫正转换矩阵，为平面方程安置偏心距误差矫正转换矩阵， 为标准面参考中心在WGS84坐标系下的坐标矩阵；
[0068] 。
[0069] S3中：
[0070] 将安置角作为参数，平移量作为已知值，列出方程进行求解，使用全域最小二乘法应用高斯‑马尔柯夫模型，其解算原理包括：
[0071] 全域最小二乘法应用高斯‑马尔柯夫模型为：
[0072] ；
[0073] 式中 为安置误差， 为需测算的n行m列系数矩阵， 为存在于A中的误差矩阵，Y为需测算的误差向量，B为误差估计参数。
[0074] 分步平差解算步骤包括：
[0075] S3.1.建立全域最小二乘法应用高斯‑马尔柯夫模型；
[0076] S3.2.对增广矩阵 进行奇异值分解：；
[0077] 其中 ， ， 、 、 、 、 、 皆为由矩阵的奇异值分解后的到的分解子矩阵；
[0078] S3.3.如果 非奇异,则可得 ，是一个记号线性回归，即给定若干个点做出一条直线与这若干个点的误差最小值；
[0079] S3.4.精度评定 ， 即安置误差的标准差， 在0.03‑0.1范围内，则安置误差精度可靠。
[0080] 相对比现有技术，本发明具有以下有益效果：为了得到激光脚点的精确坐标，安置误差的标定必不可少。相比航空摄影测量，机载激光雷达的数据成果是点云，具有不规则性和离散性，不能保证在特征点处恰好存在测量数据，同名点的概念真正意义上是不存在的，需要对连接关系进行坐标转换。通过特征点、线进行匹配，将安置误差当做未知参数采用全域最小二乘的方法进行测算，建立模型并进行插值计算，从而精确的反演出安置误差。点云数据有粗差点，这就要求拟合平面模型具有很强的抗差性，并进行具有抗差性的平面方程求解，高斯一马尔柯夫模型很好的解决这一问题，因其使用的标准面参考靶点抗差性强，故得到的安置角误差也更为精准。
附图说明
[0081] 图1是本发明的技术流程图。
具体实施方式
[0082] 为使本发明的目的、技术方案和优点更加清楚，下面对本发明中的技术方案进行清楚、完整地描述，显然，所描述的实施例是本发明的一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。
[0083] 基于高斯‑马尔科夫的机载雷达安置误差插值校正方法，如图1，包括：
[0084] S1.建立与求解具有抗差性的平面方程，去除点云面中的异常点和粗差点；
[0085] S2.进行基于平面约束的安置误差平差解算；
[0086] 将安置角误差作为未知参数，将激光扫描坐标系转换到惯性平台参考坐标系，结合机载激光雷达系统几何定位模型中的观测值，建立标定模型，利用附有参数的条件平差进行参数解算，然后将安置偏心距误差作为参数，进行同样的解算，即可求得安置误差；
[0087] S3.分步平差解算。
[0088] 建立与求解具有抗差性的平面方程包括：
[0089] S1.1.设需要拟合的平面方程为：
[0090] （1）；
[0091] 式中，a、b、c、d是方程参数，x、y、z表示点的坐标；
[0092] 认定平面方程构成的法向量为单位法向量，即：
[0093] （2）；
[0094] 则空间内任意一点到平面的距离 表示为：
[0095] （3）；
[0096] 式中，xi、yi、zi表示任意一点的坐标；
[0097] S1.2.设最佳拟合平面约束条件 为：
[0098] （4）；
[0099] 构建拉格朗日辅助函数 ：
[0100] （5）；
[0101] 式中，是拉格朗日辅助函数的参数；
[0102] 对d求偏导，并令导数为0，求得：
[0103] （6）；
[0104] S1.3.将式（6）改写成：
[0105] （7）；
[0106] 其中，、、分别为xi、yi、zi的均值， ；
[0107] 对a、b、c求导并令导数为0，得：
[0108] （8）；
[0109] 式中， 为标准面各个参考靶点的安置偏心距误差；
[0110] S1.4.构建特征值方程：
[0111] （9）；
[0112] 求特征值方程的系数矩阵的最小特征值及其对应的特征向量，即为所求得a、b、c，将所求得a、b、c带入式（3）中，即可求得d。
[0113] 去除点云面中的异常点和粗差点包括：
[0114] B1.1.根据S1求得的a、b、c、d，计算所有点到拟合平面的距离；
[0115] B1.2.按照式（10）计算误差 ：
[0116] （10）；
[0117] 其中，n为点个数，为d的平均值， ；
[0118] B1.3.当满足 时，对应的点保留，否则剔除；
[0119] B1.4.利用剔除后的点云重新计算平面参数a、b、c、d；
[0120] B1.5.重复S2.1‑ S2.4，直到所有点都满足 ；
[0121] B1.5.将S2.5所求得a、b、c带入，式（3）中，即可求得d，此时获得最佳的平面拟合方程。
[0122] 将激光扫描坐标系转换到惯性平台参考坐标系包括：
[0123] S2.1.误差方程的观测值符号化表示为 ： ；
[0124] 其中：为扫描极径；为扫描角；为横滚角；为俯仰角；为航偏角； 为参考中心在WGS84坐标系下的坐标；
[0125] 误差方程的未知参数符号化表示为 ： ；
[0126] 其中： 为安置角误差， 为安置偏心距误差；
[0127] S2.2.将激光扫描坐标系转换到惯性平台参考坐标系，包括：
[0128] 激光扫描坐标系到载体坐标系到惯性平台参考坐标系，定义俯仰角逆 旋转为正，侧滚角逆 旋转为正，航向角逆 旋转为正， 为激光扫描坐标系原点在惯性平台参考坐标系的坐标，假设安置角均为正， 为激光扫描坐标系的坐标轴，为惯性平台参考坐标系的坐标轴；
[0129] S2.2.1.先绕 旋转△roll，△roll为横滚角， 变为 ：
[0130] （11）；
[0131] 式中， 为经过横滚角旋转后的 ；
[0132] S2.2.2.绕 旋转△pitch，△pitch为俯仰角， 变为 ：
[0133] （12）；
[0134] 式中， 为经过俯仰角旋转后的 ；
[0135] S2.2.3.绕 旋转△yaw，△yaw为航偏角， 变为 ：
[0136] （13）；
[0137] 式中， 为经过航偏角旋转后的 ；
[0138] S3.2.4.综上式（11）、（12）、（13）可得：
[0139] （14）；
[0140] 式中， 为简化矩阵， 。
[0141] 将激光扫描坐标系转换到惯性平台参考坐标系后，执行以下步骤：
[0142] S2.3.标定面点云对应标准面的平面方程 如下：
[0143] ；
[0144] 其中， ；
[0145] 为标准面参考靶点的坐标矩阵， 为平面方程安置旋转误差矫正转换矩阵，为平面方程安置偏心距误差矫正转换矩阵， 为标准面参考中心在WGS84坐标系下的坐标矩阵；
[0146] 。
[0147] S3中：
[0148] 将安置角作为参数，平移量作为已知值，列出方程进行求解，使用全域最小二乘法应用高斯‑马尔柯夫模型，其解算原理包括：
[0149] 全域最小二乘法应用高斯‑马尔柯夫模型为：
[0150] ；
[0151] 式中 为安置误差， 为需测算的n行m列系数矩阵， 为存在于A中的误差矩阵，Y为需测算的误差向量，B为误差估计参数。
[0152] 分步平差解算步骤包括：
[0153] S3.1.建立全域最小二乘法应用高斯‑马尔柯夫模型；
[0154] S3.2.对增广矩阵 进行奇异值分解：；
[0155] 其中 ， ， 、 、 、 、 、 皆为由矩阵的奇异值分解后的到的分解子矩阵；
[0156] S3.3.如果 非奇异,则可得 ，是一个记号线性回归，即给定若干个点做出一条直线与这若干个点的误差最小值；
[0157] S3.4.精度评定 ， 即安置误差的标准差， 在0.03‑0.1范围内，则安置误差精度可靠。
[0158] 以上实施例仅用于说明本发明的技术方案，而非对其限制，尽管参照前述实施例对本发明进行了详细的说明，本领域的普通技术人员应当理解：其依然可以对前述各实施例所记载的技术方案进行修改，或者对其中部分或者全部技术特征进行等同替换，而这些修改或者替换，并不使相应技术方案的本质脱离本发明各实施例技术方案的范围。
