armadillo库小案例

最新推荐文章于 2025-04-21 15:28:54 发布

原创

最新推荐文章于 2025-04-21 15:28:54 发布 · 793 阅读

0 ·

CC 4.0 BY-SA版权

本文介绍了Armadillo库在数值计算中的应用，通过实例展示了如何使用该库进行矩阵操作和线性代数运算，包括矩阵创建、加减乘除、求逆、特征值等，适合初学者快速上手。

#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <iostream>
#include <armadillo>
using namespace std;
using namespace arma;

typedef struct _coor_fin
{
    double x;
    double y;
}coor_fin;

typedef struct _coor_lin
{
    double x;
    double y;
}coor_lin;

typedef struct _coor_cin
{
    double x;
    double y;   
}coor_cin;

typedef struct _coor_out
{
    double xout;
    double yout;
}coor_out;

/*
 *函数功能：坐标平滑矫正
 *函数入参：coor_fin:基准坐标
 *          l_in:上一次坐标
 *          c_in：本次坐标
 *函数出参  coor_out 矫正后的坐标
 *函数返回值：成功返回 0， 失败返回 -1
*/
int correct_position(coor_fin f_in, coor_lin l_in, coor_cin c_in, coor_out *out)
{
    mat X1(1, 4), F1(4, 4), P(4, 4), Q(4, 4), H(4, 4), R(4, 4);
    double fx = f_in.x;
    double fy = f_in.y;
    double lx = l_in.x;
    double ly = l_in.y;
    double cx = c_in.x;
    double cy = c_in.y;
    for (int j = 0; j < 16; j++)
    {
      F1[j] = 0;
    }
    for (int k = 0; k < 4; k++)
    {
      F