Nav2 Navigation Stack - jazzy
jazzy
ROS 2 Navigation Stack
nav2_amcl
include
nav2_amcl
pf
eig3.hpp
1
/*
2
* Player - One Hell of a Robot Server
3
* Copyright (C) 2000 Brian Gerkey & Kasper Stoy
4
* gerkey@usc.edu kaspers@robotics.usc.edu
5
*
6
* This library is free software; you can redistribute it and/or
7
* modify it under the terms of the GNU Lesser General Public
8
* License as published by the Free Software Foundation; either
9
* version 2.1 of the License, or (at your option) any later version.
10
*
11
* This library is distributed in the hope that it will be useful,
12
* but WITHOUT ANY WARRANTY; without even the implied warranty of
13
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
14
* Lesser General Public License for more details.
15
*
16
* You should have received a copy of the GNU Lesser General Public
17
* License along with this library; if not, write to the Free Software
18
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
19
*
20
*/
21
/* Eigen-decomposition for symmetric 3x3 real matrices.
22
Public domain, copied from the public domain Java library JAMA. */
23
24
#ifndef NAV2_AMCL__PF__EIG3_HPP_
25
#define NAV2_AMCL__PF__EIG3_HPP_
26
27
/* Symmetric matrix A => eigenvectors in columns of V, corresponding
28
eigenvalues in d. */
29
void
eigen_decomposition(
double
A
[3][3],
double
V[3][3],
double
d[3]);
30
31
#endif
// NAV2_AMCL__PF__EIG3_HPP_
A
Generated by
1.9.1