高斯牛顿(非线性最小二乘优化方法)

1 原理

高斯牛顿(非线性最小二乘优化方法)_第1张图片

 高斯牛顿(非线性最小二乘优化方法)_第2张图片

 2 实例

高斯牛顿(非线性最小二乘优化方法)_第3张图片

 3 代码

#include 
#include 
#include 
#include 
#include 

using namespace std;
using namespace Eigen;


int main(int argc, char **argv) {
    double ar = 1.0, br = 2.0, cr = 1.0;    //真实参考值
    double ae = 20.0, be = -10.0, ce = 10.0; //初始值,不能太大,初始化很重要

    int N = 100;   //数据总点数

    double w_sigma = 1.0;  //噪声sigma值
    double inv_sigma = 1.0 / w_sigma;

    cv::RNG rng;   // opencv随机数产生

    vector x_data, y_data;

你可能感兴趣的:(3D点云,OpenCV,算法)