Coder Social home page Coder Social logo

livox_horizon_loam's Introduction

中文版本使用说明

1 Introduction

Livox SDK is the software development kit designed for all Livox products. It is developed based on C/C++ following Livox SDK Communication Protocol, and provides easy-to-use C style API. With Livox SDK, users can quickly connect to Livox products and receive point cloud data.

Livox SDK consists of Livox SDK communication protocol, Livox SDK core, Livox SDK API, Linux sample, and ROS demo.

Prerequisites

  • Ubuntu 14.04/Ubuntu 16.04/Ubuntu 18.04, both x86 and ARM (Nvidia TX2)
  • Windows 7/10, Visual Studio 2015 Update3/2017/2019
  • C++11 compiler

2 Livox SDK Communication Protocol

Livox SDK communication protocol opens to all users. It is the communication protocol between user programs and Livox products. The protocol consists of control commands and data format. Please refer to the Livox SDK Communication Protocol for detailed information.

3 Livox SDK Core

Livox SDK provides the implementation of control commands and point cloud data transmission, as well as the C/C++ API. The basic structure of Livox SDK core is shown as below:

Livox SDK Architecture

User Datagram Protocol (UDP) is used for communication between Livox SDK and LiDAR sensors. Please refer to the Livox SDK Communication Protocol for further information. Point cloud data handler supports point cloud data transmission, while command handler receives and sends control commands. And the C/C++ API is based on command handler and point cloud data handler.

The Livox LiDAR sensors can be connected to host directly or through the Livox Hub. Livox SDK supports both connection methods. When LiDAR units are connected to host directly, the host will establish communication with each LiDAR unit individually. And if the LiDAR units connect to host through Hub, then the host only communicates with the Livox Hub while the Hub communicates with each LiDAR unit.

4 Livox SDK API

Livox SDK API provides a set of C style functions which can be conveniently integrated in C/C++ programs. Please refer to the Livox SDK API Reference for further information.

4.1 Installation

The installation procedures in Ubuntu 18.04/16.04/14.04 LTS and Windows 7/10 are shown here as examples. For Ubuntu 18.04/16.04/14.04 32-bit LTS and Mac, you can get it in Livox-SDK wiki.

4.1.1 Ubuntu 18.04/16.04/14.04 LTS

Dependencies

Livox SDK requires CMake 3.0.0+ as dependencies. You can install these packages using apt:

sudo apt install cmake

Compile Livox SDK

In the Livox SDK directory, run the following commands to compile the project:

git clone https://github.com/Livox-SDK/Livox-SDK.git
cd Livox-SDK
cd build && cmake ..
make
sudo make install

4.1.2 Windows 7/10

Dependencies

Livox SDK supports Visual Studio 2015 Update3/2017/2019 and requires install CMake 3.0.0+ as dependencies.

In the Livox SDK directory, run the following commands to create the Visual Studio solution file. Generate the 32-bit project:

cd Livox-SDK/build

For Viusal Studio 2015 Update3/2017:

cmake ..

For Viusal Studio 2019:

cmake .. -G "Visual Studio 16 2019" -A Win32

Generate the 64-bit project:

cd Livox-SDK/build 

For Viusal Studio 2015 Update3:

cmake .. -G "Visual Studio 14 2015 Win64"

For Viusal Studio 2017:

cmake .. -G "Visual Studio 15 2017 Win64"

For Viusal Studio 2019:

cmake .. -G "Visual Studio 16 2019" -A x64

Compile Livox SDK

You can now compile the Livox SDK in Visual Studio.

4.1.3 ARM-Linux Cross Compile

The procedure of cross compile Livox-SDK in ARM-Linux are shown below.

Dependencies

Host machine requires install cmake. You can install these packages using apt:

sudo apt install cmake

Cross Compile Toolchain

If your ARM board vendor provides a cross compile toolchain, you can skip the following step of installing the toolchain and use the vendor-supplied cross compile toolchain instead.

The following commands will install C and C++ cross compiler toolchains for 32bit and 64bit ARM board. You need to install the correct toolchain for your ARM board. For 64bit SoC ARM board, only install 64bit toolchain, and for 32bit SoC ARM board, only install 32bit toolchain.

Install ARM 32 bits cross compile toolchain

 sudo apt-get install gcc-arm-linux-gnueabi g++-arm-linux-gnueabi

Install ARM 64 bits cross compile toolchain

sudo apt-get install gcc-aarch64-linux-gnu g++-aarch64-linux-gnu

Cross Compile Livox-SDK

For ARM 32 bits toolchain,In the Livox SDK directory,run the following commands to cross compile the project:

cd Livox-SDK
cd build && \
cmake .. -DCMAKE_SYSTEM_NAME=Linux -DCMAKE_C_COMPILER=arm-linux-gnueabi-gcc -DCMAKE_CXX_COMPILER=arm-linux-gnueabi-g++
make

For ARM 64 bits toolchain,In the Livox SDK directory,run the following commands to cross compile the project:

cd Livox-SDK
cd build && \
cmake .. -DCMAKE_SYSTEM_NAME=Linux -DCMAKE_C_COMPILER=aarch64-linux-gnu-gcc -DCMAKE_CXX_COMPILER=aarch64-linux-gnu-g++
make

Note:

  • gcc cross compiler need to support C ++11 standard

4.2 Run Livox SDK Sample

Two samples are provided in Sample/Lidar and Sample/Hub, which demonstrate how to configure Livox LiDAR units and receive the point cloud data when directly connecting Livox SDK to LiDAR units or by using a Livox Hub, respectively. The sequence diagram is shown as below:

4.2.1 Ubuntu 18.04/16.04 /14.04 LTS

For Ubuntun 18.04/16.04/14.04 LTS, run the lidar_sample if connect with the LiDAR unit(s):

cd sample/lidar && ./lidar_sample

or run the hub_sample if connect with the hub unit(s):

cd sample/hub && ./hub_sample

4.2.2 Windows 7/10

After compiling the Livox SDK as shown in section 4.1.2, you can find hub_sample.exe or lidar_sample.exe in the {Livox-SDK}\build\sample\hub\Debug or {Livox-SDK}\build\sample\lidar\Debug folder, respectively, which can be run directly.

Then you can see the information as below:

4.3 Connect to the specific LiDAR units

Samples we provided will connect all the broadcast device in you LAN in default.There are two ways to connect the specific units:

  • run sample with input options

  • edit the Broadcast Code list in source code

NOTE:

Each Livox LiDAR unit owns a unique Broadcast Code . The broadcast code consists of its serial number and an additional number (1,2, or 3). The serial number can be found on the body of the LiDAR unit (below the QR code).The Broadcast Code may be used when you want to connect to the specific LiDAR unit(s). The detailed format is shown as below:

Broadcast Code

4.3.1 Program Options

We provide the following program options for connecting the specific units and saving log file:

[-c]:Register LiDAR units by Broadcast Code. Connect the registered units ONLY. 
[-l]:Save the log file(In the executable file's directory).
[-h]:Show help.

Here is the example:

./lidar_sample_cc -c "00000000000002&00000000000003&00000000000004" -l
./hub_sample_cc -c "00000000000001" -l

4.3.2 Edit Broadcast Code List

Comment the following code section:

/** Connect all the broadcast device. */
int lidar_count = 0;
char broadcast_code_list[kMaxLidarCount][kBroadcastCodeSize];

Remove the comment of the following code section, set the BROADCAST_CODE_LIST_SIZE and replace the broadcast code lists in the main.c for both LiDAR sample ({Livox-SDK}/sample/lidar/main.c) and Hub sample ({Livox-SDK}/sample/hub/main.c) with the broadcast code of your devices before building.

/** Connect the broadcast device in list, please input the broadcast code and modify the BROADCAST_CODE_LIST_SIZE. */
/*#define BROADCAST_CODE_LIST_SIZE  3
int lidar_count = BROADCAST_CODE_LIST_SIZE;
char broadcast_code_list[kMaxLidarCount][kBroadcastCodeSize] = {
  "000000000000002",
  "000000000000003",
  "000000000000004"
};*/

4.4 Generate the lvx file

We provide the C++ sample to generate the lvx file for hub and LiDAR unit(s). You can use the same way in 4.2.1 and 4.2.2 to run them.

4.4.1 Program Options

You can alse use the program options in 4.3.1 to connect specific device and generate the log file, and we provide two new options for lvx file:

[-t] Time to save point cloud to the lvx file.(unit: s)
[-p] Get the extrinsic parameter from standard extrinsic.xml file(The same as viewer) in the executable file's directory.(Especially for LiDAR unit(s) as the hub will calculate the extrinsic parameter by itself)

Here is the example:

./lidar_lvx_sample -c "00000000000002&00000000000003&00000000000004" -l -t 10 -p
./hub_lvx_sample -c "00000000000001" -l -t 10

5 Support

You can get support from Livox with the following methods:

  • Send email to [email protected] with a clear description of your problem and your setup
  • Github Issues

livox_horizon_loam's People

Contributors

livox-sdk avatar panzhichen avatar

Stargazers

 avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar

Watchers

 avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar

livox_horizon_loam's Issues

Questions about IMU data in Horizon.

When the device is stationary, the acceleration data output by IMU in horizon is about (0, 0, 0.98). Is the real acceleration divided by 9.81??
by rostopic echo /livox/imu
-0.021400 0.018352 0.994997
and Where to get IMU calibration documents? The acceleration data seems large.

The frame rate displayed on rviz drops rapidly

Hi,We use Livox loam with ubuntu 16.04 + virtualbox to run Livox-Horizon-LOAM by command 'roslaunch loam_horizon loam_livox_horizon.launch', rviz started displaying at 30fps, and then start dropped slowly to 1fps. If you click reset, the frame rate will be restored to 30fps. We use rosbag to run with 'rosbag play 2020_parking_lot.bag', the issue also reproduce too. This problem we also email to [email protected], but we don't get any information about this v _ v

How can I increase the frame rate of the display, because there is no problem when using livox_lidar_rviz.launch, but the configuration file is not suitable for Livox-Horizon-LOAM. Is there any parameter settings for loam_livox_horizon.launch? How can we resolve this issue?

livox Avia?

I am beginner of Lidar system. Can this code run on livox-Avia lidar direcly? or should I modify something. Could you advise to most stable mapping method or coding for livox Avia? Thank you.

Tele-15

Can this code run with Tele-15 Lidar with minimal modification? Thank you in advance!

[pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!

I'm running the livox horizon lidar on one PC and running the loam on a different PC.
After about 20 seconds of running LOAM, the laserOdometry module crashes with

[laserOdometry-2] process has died [pid 6983, exit code -11, cmd /home/abacus/catkin_ws/devel/lib/loam_horizon/laserOdometry __name:=laserOdometry __log:=/home/abacus/.ros/log/7a965bc2-bd63-11ea-8c9c-dca632b01010/laserOdometry-2.log].
log file: /home/abacus/.ros/log/7a965bc2-bd63-11ea-8c9c-dca632b01010/laserOdometry-2*.log

The [pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud! error is seen for a few seconds before the crash.
The logs from the console is here:


map prepare time 0.088757 ms
map corner num 2328  surf num 1720 
build tree time 0.470938 ms 
mapping data assosiation time 0.156549 ms 
mapping solver time 0.292138 ms 
Ceres Solver Report: Iterations: 8, Initial cost: 1.103842e-01, Final cost: 9.609673e-02, Termination: CONVERGENCE
mapping data assosiation time 0.148910 ms 
mapping solver time 0.166832 ms 
Ceres Solver Report: Iterations: 5, Initial cost: 8.602315e-02, Final cost: 8.225180e-02, Termination: CONVERGENCE
mapping optimization time 1.270840 
add points time 0.018058 ms
filter time 0.211446 ms 
mapping pub time 0.733810 ms 
whole mapping time 2.343390 ms +++++
[ INFO] [1593805376.805134363]: integrate rotation angle [x, y, z]: [1.94, -0.33, -3.99]
points size 22824 
prepare time 3.416602 
sort q time 4.660179 
seperate points time 8.831633 
scan registration time 18.150661 ms *************
data association time 14.873315 ms 
solver time 15.560551 ms 
data association time 6.526456 ms 
solver time 5.991541 ms 
optimization twice time 43.406445 
t_w_curr:   -6.6868   3.92787 0.0714668
[pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
publication time 5.321362 ms 
whole laserOdometry time 48.761081 ms 
 
map prepare time 0.096470 ms
map corner num 2329  surf num 1720 
build tree time 0.520440 ms 
mapping data assosiation time 0.173800 ms 
mapping solver time 0.275571 ms 
Ceres Solver Report: Iterations: 6, Initial cost: 9.436523e-02, Final cost: 6.917717e-02, Termination: CONVERGENCE
mapping data assosiation time 0.164770 ms 
mapping solver time 0.185270 ms 
Ceres Solver Report: Iterations: 5, Initial cost: 5.967188e-02, Final cost: 5.744594e-02, Termination: CONVERGENCE
mapping optimization time 1.359949 
add points time 0.010248 ms
filter time 0.241848 ms 
mapping pub time 0.814104 ms 
whole mapping time 2.547101 ms +++++
[ INFO] [1593805376.902820965]: integrate rotation angle [x, y, z]: [0.69, -0.35, -3.59]
points size 22808 
prepare time 1.079317 
sort q time 1.241579 
seperate points time 2.031818 
scan registration time 5.068313 ms *************
data association time 3.128026 ms 
solver time 4.016765 ms 
data association time 3.586069 ms 
solver time 2.727348 ms 
optimization twice time 13.746803 
t_w_curr:  -6.72343   4.02965 0.0620396
[pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
publication time 3.788966 ms 
whole laserOdometry time 17.590642 ms 
 
map prepare time 0.082609 ms
map corner num 2329  surf num 1720 
build tree time 0.447274 ms 
mapping data assosiation time 0.143510 ms 
mapping solver time 0.361919 ms 
Ceres Solver Report: Iterations: 10, Initial cost: 6.744402e-02, Final cost: 5.262286e-02, Termination: CONVERGENCE
mapping data assosiation time 0.166488 ms 
mapping solver time 0.252285 ms 
Ceres Solver Report: Iterations: 7, Initial cost: 7.095284e-02, Final cost: 6.308281e-02, Termination: CONVERGENCE
mapping optimization time 1.406501 
add points time 0.008668 ms
filter time 0.191448 ms 
mapping pub time 0.697279 ms 
whole mapping time 2.411235 ms +++++
[ INFO] [1593805377.005202862]: integrate rotation angle [x, y, z]: [1.03, -0.55, -2.57]
points size 22808 
prepare time 3.656908 
sort q time 4.538394 
seperate points time 7.492227 
scan registration time 17.865371 ms *************
data association time 10.942345 ms 
solver time 12.398976 ms 
data association time 5.115764 ms 
solver time 5.002564 ms 
optimization twice time 33.810582 
t_w_curr:   -6.7533   4.08596 0.0733854
[pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
publication time 4.012230 ms 
whole laserOdometry time 37.845957 ms 
 
map prepare time 0.089438 ms
map corner num 2329  surf num 1720 
build tree time 0.493965 ms 
mapping data assosiation time 0.170363 ms 
mapping solver time 0.287005 ms 
Ceres Solver Report: Iterations: 6, Initial cost: 1.103195e-01, Final cost: 9.095502e-02, Termination: CONVERGENCE
mapping data assosiation time 0.162013 ms 
mapping solver time 0.309968 ms 
Ceres Solver Report: Iterations: 8, Initial cost: 9.237252e-02, Final cost: 7.364207e-02, Termination: CONVERGENCE
mapping optimization time 1.463873 
add points time 0.009925 ms
filter time 0.191784 ms 
mapping pub time 0.706155 ms 
whole mapping time 2.486436 ms +++++
[ INFO] [1593805377.099829336]: integrate rotation angle [x, y, z]: [1.13, -1.35, -0.47]
points size 22818 
prepare time 1.063034 
sort q time 1.209250 
seperate points time 2.169937 
scan registration time 5.184521 ms *************
data association time 3.292609 ms 
solver time 5.115651 ms 
data association time 3.879525 ms 
solver time 4.742578 ms 
optimization twice time 17.280391 
t_w_curr: -6.74351  4.07391 0.125155
[pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
publication time 3.706409 ms 
whole laserOdometry time 21.007138 ms 
 
map prepare time 0.084263 ms
map corner num 2329  surf num 1722 
build tree time 0.460991 ms 
mapping data assosiation time 0.173934 ms 
mapping solver time 0.218561 ms 
Ceres Solver Report: Iterations: 4, Initial cost: 9.409055e-02, Final cost: 5.388147e-02, Termination: CONVERGENCE
mapping data assosiation time 0.164532 ms 
mapping solver time 0.260303 ms 
Ceres Solver Report: Iterations: 6, Initial cost: 9.407621e-02, Final cost: 8.044292e-02, Termination: CONVERGENCE
mapping optimization time 1.320564 
add points time 0.010206 ms
filter time 0.214126 ms 
mapping pub time 0.735323 ms 
whole mapping time 2.389141 ms +++++
[ INFO] [1593805377.200963836]: integrate rotation angle [x, y, z]: [1.89, -0.95, -0.86]
points size 22816 
prepare time 2.536574 
sort q time 2.959093 
seperate points time 5.291937 
scan registration time 12.669348 ms *************
data association time 8.576195 ms 
solver time 12.062718 ms 
data association time 5.610760 ms 
solver time 4.730669 ms 
optimization twice time 31.406901 
t_w_curr: -6.75109  4.11751 0.116124
[pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
publication time 4.855206 ms 
whole laserOdometry time 36.289982 ms 
 
map prepare time 0.101107 ms
map corner num 2329  surf num 1722 
build tree time 0.553227 ms 
mapping data assosiation time 0.213302 ms 
mapping solver time 0.362265 ms 
Ceres Solver Report: Iterations: 5, Initial cost: 1.234115e-01, Final cost: 9.615956e-02, Termination: CONVERGENCE
mapping data assosiation time 0.207256 ms 
mapping solver time 0.264519 ms 
Ceres Solver Report: Iterations: 4, Initial cost: 1.062634e-01, Final cost: 9.858712e-02, Termination: CONVERGENCE
mapping optimization time 1.648864 
add points time 0.012564 ms
filter time 0.232476 ms 
mapping pub time 0.780369 ms 
whole mapping time 2.800390 ms +++++
[ INFO] [1593805377.299876731]: integrate rotation angle [x, y, z]: [0.95, -0.48, -1.44]
points size 22826 
prepare time 1.144897 
sort q time 1.357394 
seperate points time 2.427705 
scan registration time 5.570066 ms *************
data association time 4.282077 ms 
solver time 5.223420 ms 
data association time 3.328017 ms 
solver time 3.041005 ms 
optimization twice time 16.151030 
t_w_curr: -6.74363  4.19327  0.14134
[pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
publication time 3.918954 ms 
whole laserOdometry time 20.094020 ms 
 
map prepare time 0.096742 ms
map corner num 2329  surf num 1724 
build tree time 0.492551 ms 
mapping data assosiation time 0.179971 ms 
mapping solver time 0.368649 ms 
Ceres Solver Report: Iterations: 6, Initial cost: 1.116300e-01, Final cost: 9.810593e-02, Termination: CONVERGENCE
mapping data assosiation time 0.169814 ms 
mapping solver time 0.318698 ms 
Ceres Solver Report: Iterations: 6, Initial cost: 9.766853e-02, Final cost: 9.215179e-02, Termination: CONVERGENCE
mapping optimization time 1.573485 
add points time 0.013255 ms
filter time 0.211427 ms 
mapping pub time 0.810813 ms 
whole mapping time 2.734256 ms +++++
[ INFO] [1593805377.402951946]: integrate rotation angle [x, y, z]: [1.62, 0.01, -1.02]
points size 22824 
prepare time 3.171328 
sort q time 3.867804 
seperate points time 6.325527 
scan registration time 15.191923 ms *************
data association time 10.961183 ms 
solver time 12.422441 ms 
data association time 6.200664 ms 
solver time 4.525675 ms 
optimization twice time 34.633405 
t_w_curr: -6.79961  4.27341 0.108851
[pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
publication time 5.083826 ms 
whole laserOdometry time 39.750050 ms 
 
map prepare time 0.102277 ms
map corner num 2329  surf num 1724 
build tree time 0.556537 ms 
mapping data assosiation time 0.212895 ms 
mapping solver time 0.614351 ms 
Ceres Solver Report: Iterations: 9, Initial cost: 1.348930e-01, Final cost: 1.292959e-01, Termination: CONVERGENCE
mapping data assosiation time 0.211618 ms 
mapping solver time 0.684078 ms 
Ceres Solver Report: Iterations: 10, Initial cost: 1.769291e-01, Final cost: 1.661005e-01, Termination: CONVERGENCE
mapping optimization time 2.342685 
add points time 0.014323 ms
filter time 0.248641 ms 
mapping pub time 0.862729 ms 
whole mapping time 3.606841 ms +++++
[ INFO] [1593805377.500935811]: integrate rotation angle [x, y, z]: [-0.24, -1.43, -0.93]
points size 22832 
prepare time 1.132153 
sort q time 1.360532 
seperate points time 2.429984 
scan registration time 5.578387 ms *************
data association time 3.826692 ms 
solver time 4.381257 ms 
data association time 3.304233 ms 
solver time 2.884787 ms 
optimization twice time 14.671099 
t_w_curr: -6.75139  4.34541 0.220668
[pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
publication time 3.971440 ms 
whole laserOdometry time 18.667702 ms 
 
map prepare time 0.093670 ms
map corner num 2329  surf num 1724 
build tree time 0.534295 ms 
mapping data assosiation time 0.201454 ms 
mapping solver time 0.537933 ms 
Ceres Solver Report: Iterations: 9, Initial cost: 1.531017e-01, Final cost: 1.354862e-01, Termination: CONVERGENCE
mapping data assosiation time 0.195855 ms 
mapping solver time 0.499711 ms 
Ceres Solver Report: Iterations: 8, Initial cost: 1.594710e-01, Final cost: 1.392649e-01, Termination: CONVERGENCE
mapping optimization time 2.015361 
add points time 0.014244 ms
filter time 0.218832 ms 
mapping pub time 0.803668 ms 
whole mapping time 3.170260 ms +++++
[ INFO] [1593805377.632161097]: integrate rotation angle [x, y, z]: [0.71, 0.11, 0.34]
points size 22831 
prepare time 3.760553 
sort q time 4.585729 
seperate points time 8.245291 
scan registration time 17.797758 ms *************
data association time 10.950101 ms 
solver time 10.612656 ms 
data association time 7.018692 ms 
solver time 6.652663 ms 
optimization twice time 35.775275 
t_w_curr: -6.75811  4.40405 0.183438
[pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
publication time 5.083671 ms 
whole laserOdometry time 40.895164 ms 
 
map prepare time 0.105533 ms
map corner num 2329  surf num 1725 
build tree time 0.584158 ms 
mapping data assosiation time 0.226090 ms 
mapping solver time 0.762258 ms 
Ceres Solver Report: Iterations: 11, Initial cost: 1.315260e-01, Final cost: 9.828710e-02, Termination: NO_CONVERGENCE
mapping data assosiation time 0.192346 ms 
mapping solver time 0.390231 ms 
Ceres Solver Report: Iterations: 6, Initial cost: 1.026048e-01, Final cost: 8.887171e-02, Termination: CONVERGENCE
mapping optimization time 2.203982 
add points time 0.014412 ms
filter time 0.231482 ms 
mapping pub time 0.821159 ms 
whole mapping time 3.405636 ms +++++
[ INFO] [1593805377.725933783]: integrate rotation angle [x, y, z]: [0.17, -0.60, 0.68]
points size 22833 
prepare time 1.157930 
sort q time 1.417476 
seperate points time 2.519418 
scan registration time 5.803754 ms *************
data association time 3.876177 ms 
solver time 4.561039 ms 
data association time 3.332907 ms 
solver time 3.031137 ms 
optimization twice time 15.087391 
t_w_curr: -6.72043  4.48226 0.228253
[pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
publication time 3.911129 ms 
whole laserOdometry time 19.027625 ms 
 
map prepare time 0.088675 ms
map corner num 2329  surf num 1726 
build tree time 0.481346 ms 
mapping data assosiation time 0.194591 ms 
mapping solver time 0.379149 ms 
Ceres Solver Report: Iterations: 6, Initial cost: 1.207326e-01, Final cost: 9.795753e-02, Termination: CONVERGENCE
mapping data assosiation time 0.174877 ms 
mapping solver time 0.239274 ms 
Ceres Solver Report: Iterations: 4, Initial cost: 7.245513e-02, Final cost: 7.063812e-02, Termination: CONVERGENCE
mapping optimization time 1.515167 
add points time 0.011146 ms
filter time 0.208111 ms 
mapping pub time 0.735666 ms 
whole mapping time 2.583027 ms +++++
[ INFO] [1593805377.833089697]: integrate rotation angle [x, y, z]: [0.34, -0.02, 0.80]
points size 22853 
prepare time 3.575094 
sort q time 4.531178 
seperate points time 9.215514 
scan registration time 17.829507 ms *************
data association time 13.082788 ms 
solver time 12.486822 ms 
data association time 6.109024 ms 
solver time 4.561595 ms 
optimization twice time 36.696251 
t_w_curr: -6.65892  4.54649 0.237407
[pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
publication time 5.118766 ms 
whole laserOdometry time 41.847843 ms 
 
map prepare time 0.106263 ms
map corner num 2329  surf num 1726 
build tree time 0.609465 ms 
mapping data assosiation time 0.234861 ms 
mapping solver time 0.272009 ms 
Ceres Solver Report: Iterations: 3, Initial cost: 6.189652e-02, Final cost: 3.960951e-02, Termination: CONVERGENCE
mapping data assosiation time 0.234639 ms 
mapping solver time 0.392530 ms 
Ceres Solver Report: Iterations: 5, Initial cost: 5.821674e-02, Final cost: 5.274262e-02, Termination: CONVERGENCE
mapping optimization time 1.800888 
add points time 0.012113 ms
filter time 0.234473 ms 
mapping pub time 0.861905 ms 
whole mapping time 3.042700 ms +++++
[ INFO] [1593805377.926858778]: integrate rotation angle [x, y, z]: [-0.02, 0.90, 0.19]
points size 22850 
prepare time 1.140007 
sort q time 1.285563 
seperate points time 2.325821 
scan registration time 5.486170 ms *************
data association time 3.441192 ms 
solver time 4.009339 ms 
data association time 3.220643 ms 
solver time 4.803665 ms 
optimization twice time 15.819844 
t_w_curr: -6.59941  4.63577 0.227091
[pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
publication time 3.708058 ms 
whole laserOdometry time 19.552237 ms 
 
map prepare time 0.083821 ms
map corner num 2329  surf num 1726 
build tree time 0.446289 ms 
mapping data assosiation time 0.153216 ms 
mapping solver time 0.236729 ms 
Ceres Solver Report: Iterations: 4, Initial cost: 5.535861e-02, Final cost: 4.752607e-02, Termination: CONVERGENCE
mapping data assosiation time 0.144866 ms 
mapping solver time 0.246720 ms 
Ceres Solver Report: Iterations: 5, Initial cost: 4.847894e-02, Final cost: 4.806095e-02, Termination: CONVERGENCE
mapping optimization time 1.267166 
add points time 0.012346 ms
filter time 0.196208 ms 
mapping pub time 0.819899 ms 
whole mapping time 2.402594 ms +++++
[ INFO] [1593805378.026869514]: integrate rotation angle [x, y, z]: [0.08, 1.29, -0.15]
points size 22849 
prepare time 1.247943 
sort q time 1.565065 
seperate points time 2.535529 
scan registration time 6.200434 ms *************
data association time 5.308622 ms 
solver time 6.232058 ms 
data association time 5.729248 ms 
solver time 4.105755 ms 
optimization twice time 21.786684 
t_w_curr: -6.60238  4.72236 0.197442
[pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
publication time 4.824624 ms 
whole laserOdometry time 26.641328 ms 
 
map prepare time 0.098666 ms
map corner num 2329  surf num 1726 
build tree time 0.541312 ms 
mapping data assosiation time 0.183770 ms 
mapping solver time 0.385849 ms 
Ceres Solver Report: Iterations: 6, Initial cost: 4.670070e-02, Final cost: 3.935936e-02, Termination: CONVERGENCE
mapping data assosiation time 0.172646 ms 
mapping solver time 0.345932 ms 
Ceres Solver Report: Iterations: 6, Initial cost: 4.167309e-02, Final cost: 4.000510e-02, Termination: CONVERGENCE
mapping optimization time 1.676911 
add points time 0.012914 ms
filter time 0.235980 ms 
mapping pub time 0.905524 ms 
whole mapping time 2.958941 ms +++++
[ INFO] [1593805378.125957537]: integrate rotation angle [x, y, z]: [0.92, -0.13, -0.16]
points size 22847 
prepare time 1.342126 
sort q time 1.730042 
seperate points time 3.435833 
scan registration time 6.534890 ms *************
data association time 4.939301 ms 
solver time 6.254333 ms 
data association time 4.733277 ms 
solver time 6.034796 ms 
optimization twice time 22.376839 
t_w_curr: -6.57527  4.74569 0.219111
[pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
publication time 5.323347 ms 
whole laserOdometry time 27.734215 ms 
 
map prepare time 0.112409 ms
map corner num 2329  surf num 1726 
build tree time 0.598354 ms 
mapping data assosiation time 0.204560 ms 
mapping solver time 0.334662 ms 
Ceres Solver Report: Iterations: 5, Initial cost: 5.246237e-02, Final cost: 5.034021e-02, Termination: CONVERGENCE
mapping data assosiation time 0.169248 ms 
mapping solver time 0.250486 ms 
Ceres Solver Report: Iterations: 4, Initial cost: 4.542964e-02, Final cost: 4.239291e-02, Termination: CONVERGENCE
mapping optimization time 1.608382 
add points time 0.011692 ms
filter time 0.228299 ms 
mapping pub time 0.867936 ms 
whole mapping time 2.854529 ms +++++
[ INFO] [1593805378.227962986]: integrate rotation angle [x, y, z]: [0.71, 0.05, -1.34]
points size 22856 
prepare time 2.312889 
sort q time 2.648988 
seperate points time 4.693064 
scan registration time 11.026229 ms *************
data association time 7.468673 ms 
solver time 11.081427 ms 
data association time 5.565643 ms 
solver time 5.867437 ms 
optimization twice time 30.406966 
t_w_curr: -6.54398  4.83944 0.218189
[pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
publication time 4.647174 ms 
whole laserOdometry time 35.079872 ms 
 
map prepare time 0.096026 ms
map corner num 2329  surf num 1726 
build tree time 0.544374 ms 
mapping data assosiation time 0.169425 ms 
mapping solver time 0.303284 ms 
Ceres Solver Report: Iterations: 5, Initial cost: 3.991868e-02, Final cost: 3.670366e-02, Termination: CONVERGENCE
mapping data assosiation time 0.159305 ms 
mapping solver time 0.271477 ms 
Ceres Solver Report: Iterations: 5, Initial cost: 4.600488e-02, Final cost: 4.144276e-02, Termination: CONVERGENCE
mapping optimization time 1.504413 
add points time 0.011919 ms
filter time 0.223549 ms 
mapping pub time 0.829539 ms 
whole mapping time 2.693445 ms +++++
[ INFO] [1593805378.325949150]: integrate rotation angle [x, y, z]: [0.29, 1.13, -1.87]
points size 22854 
prepare time 1.402200 
sort q time 1.282221 
seperate points time 2.067872 
scan registration time 5.453943 ms *************
data association time 4.390561 ms 
solver time 4.672535 ms 
data association time 3.780205 ms 
solver time 4.735403 ms 
optimization twice time 17.878244 
t_w_curr: -6.43751  4.86078 0.240408
[pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
publication time 4.797964 ms 
whole laserOdometry time 22.705667 ms 
 
map prepare time 0.098113 ms
map corner num 2329  surf num 1726 
build tree time 0.568791 ms 
mapping data assosiation time 0.170970 ms 
mapping solver time 0.261864 ms 
Ceres Solver Report: Iterations: 4, Initial cost: 3.931713e-02, Final cost: 1.512651e-02, Termination: CONVERGENCE
mapping data assosiation time 0.165434 ms 
mapping solver time 0.186625 ms 
Ceres Solver Report: Iterations: 3, Initial cost: 1.489205e-02, Final cost: 1.375470e-02, Termination: CONVERGENCE
mapping optimization time 1.404270 
add points time 0.010695 ms
filter time 0.246120 ms 
mapping pub time 1.104648 ms 
whole mapping time 2.890286 ms +++++
[ INFO] [1593805378.430227120]: integrate rotation angle [x, y, z]: [0.71, 0.85, -1.53]
points size 22831 
prepare time 3.862102 
sort q time 4.594036 
seperate points time 8.217282 
scan registration time 18.699587 ms *************
data association time 13.352813 ms 
solver time 13.675843 ms 
data association time 6.541211 ms 
solver time 6.522643 ms 
optimization twice time 40.644124 
t_w_curr: -6.40923  4.88612   0.2283
[pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
publication time 5.049758 ms 
whole laserOdometry time 45.727517 ms 
 
map prepare time 0.102514 ms
map corner num 2329  surf num 1726 
build tree time 0.582862 ms 
mapping data assosiation time 0.165033 ms 
mapping solver time 0.470774 ms 
Ceres Solver Report: Iterations: 8, Initial cost: 4.754174e-02, Final cost: 4.357610e-02, Termination: CONVERGENCE
mapping data assosiation time 0.157489 ms 
mapping solver time 0.348286 ms 
Ceres Solver Report: Iterations: 7, Initial cost: 3.186635e-02, Final cost: 2.714704e-02, Termination: CONVERGENCE
mapping optimization time 1.771675 
add points time 0.012670 ms
filter time 0.223258 ms 
mapping pub time 0.834951 ms 
whole mapping time 2.971812 ms +++++
[ INFO] [1593805378.524898041]: integrate rotation angle [x, y, z]: [0.98, 0.52, 0.08]
points size 22841 
prepare time 1.061984 
sort q time 1.283230 
seperate points time 2.082153 
scan registration time 5.040447 ms *************
data association time 3.726816 ms 
solver time 5.554912 ms 
data association time 3.198720 ms 
solver time 4.216616 ms 
optimization twice time 16.966055 
t_w_curr: -6.39575  4.89146 0.223838
[pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
publication time 3.768552 ms 
whole laserOdometry time 20.759684 ms 
 
map prepare time 0.081906 ms
map corner num 2329  surf num 1726 
build tree time 0.449121 ms 
mapping data assosiation time 0.135620 ms 
mapping solver time 0.180433 ms 
Ceres Solver Report: Iterations: 3, Initial cost: 3.103869e-02, Final cost: 8.070482e-03, Termination: CONVERGENCE
mapping data assosiation time 0.125630 ms 
mapping solver time 0.144592 ms 
Ceres Solver Report: Iterations: 3, Initial cost: 1.096879e-02, Final cost: 7.573373e-03, Termination: CONVERGENCE
mapping optimization time 1.113101 
add points time 0.011379 ms
filter time 0.206899 ms 
mapping pub time 0.822152 ms 
whole mapping time 2.270083 ms +++++
[ INFO] [1593805378.627973246]: integrate rotation angle [x, y, z]: [0.48, -0.96, 0.39]
points size 22867 
prepare time 4.426053 
sort q time 4.631833 
seperate points time 7.525564 
scan registration time 18.661327 ms *************
data association time 14.515247 ms 
solver time 12.949502 ms 
data association time 6.204463 ms 
solver time 4.455771 ms 
optimization twice time 38.649109 
t_w_curr: -6.44879  4.97855 0.232591
[pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
publication time 5.158772 ms 
whole laserOdometry time 43.842207 ms 
 
map prepare time 0.414862 ms
map corner num 2329  surf num 1726 
build tree time 0.769033 ms 
mapping data assosiation time 0.258683 ms 
mapping solver time 0.335544 ms 
Ceres Solver Report: Iterations: 3, Initial cost: 2.699684e-02, Final cost: 1.453884e-02, Termination: CONVERGENCE
mapping data assosiation time 0.246259 ms 
mapping solver time 0.305237 ms 
Ceres Solver Report: Iterations: 3, Initial cost: 9.364712e-03, Final cost: 8.184383e-03, Termination: CONVERGENCE
mapping optimization time 1.990760 
add points time 0.014457 ms
filter time 0.307814 ms 
mapping pub time 0.883728 ms 
whole mapping time 3.738834 ms +++++
[ INFO] [1593805378.725936913]: integrate rotation angle [x, y, z]: [0.74, -1.48, -0.14]
points size 22874 
prepare time 1.213879 
sort q time 1.387063 
seperate points time 2.505049 
scan registration time 5.785833 ms *************
data association time 3.995262 ms 
solver time 4.497891 ms 
data association time 3.535944 ms 
solver time 3.073202 ms 
optimization twice time 15.376267 
t_w_curr: -6.4779 5.09762 0.22664
[pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
publication time 4.017441 ms 
whole laserOdometry time 19.425688 ms 
 
map prepare time 0.085768 ms
map corner num 2329  surf num 1726 
build tree time 0.469869 ms 
mapping data assosiation time 0.140513 ms 
mapping solver time 0.182027 ms 
Ceres Solver Report: Iterations: 3, Initial cost: 1.379788e-02, Final cost: 1.049525e-02, Termination: CONVERGENCE
mapping data assosiation time 0.130110 ms 
mapping solver time 0.151130 ms 
Ceres Solver Report: Iterations: 3, Initial cost: 9.998894e-03, Final cost: 9.494781e-03, Termination: CONVERGENCE
mapping optimization time 1.114513 
add points time 0.011072 ms
filter time 0.203858 ms 
mapping pub time 0.764969 ms 
whole mapping time 2.207032 ms +++++
[ INFO] [1593805378.827982970]: integrate rotation angle [x, y, z]: [-1.14, 0.79, 0.33]
points size 22880 
prepare time 3.794936 
sort q time 4.576313 
seperate points time 8.274240 
scan registration time 18.826386 ms *************
data association time 11.038334 ms 
solver time 13.788688 ms 
data association time 5.852518 ms 
solver time 6.267750 ms 
optimization twice time 37.432094 
t_w_curr: -6.33686  5.21322 0.296428
[pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
publication time 4.708838 ms 
whole laserOdometry time 42.167911 ms 
 
map prepare time 0.094850 ms
map corner num 2329  surf num 1726 
build tree time 0.518531 ms 
mapping data assosiation time 0.150773 ms 
mapping solver time 0.356513 ms 
Ceres Solver Report: Iterations: 6, Initial cost: 5.896540e-02, Final cost: 4.612895e-02, Termination: CONVERGENCE
mapping data assosiation time 0.141674 ms 
mapping solver time 0.208464 ms 
Ceres Solver Report: Iterations: 4, Initial cost: 2.762771e-02, Final cost: 2.413328e-02, Termination: CONVERGENCE
mapping optimization time 1.419187 
add points time 0.010427 ms
filter time 0.241823 ms 
mapping pub time 1.254958 ms 
whole mapping time 3.048240 ms +++++
[ INFO] [1593805378.924936489]: integrate rotation angle [x, y, z]: [-1.98, 1.05, 0.65]
points size 22877 
prepare time 1.161601 
sort q time 1.279281 
seperate points time 2.584835 
scan registration time 5.003308 ms *************
data association time 3.408335 ms 
solver time 4.033828 ms 
data association time 3.135427 ms 
solver time 2.638143 ms 
optimization twice time 13.466009 
t_w_curr: -6.24052  5.32104  0.35305
[pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
publication time 3.833621 ms 
whole laserOdometry time 17.343417 ms 
 
map prepare time 0.092713 ms
map corner num 2329  surf num 1727 
build tree time 0.477795 ms 
mapping data assosiation time 0.121426 ms 
mapping solver time 0.194307 ms 
Ceres Solver Report: Iterations: 3, Initial cost: 1.479043e-02, Final cost: 1.106637e-02, Termination: CONVERGENCE
mapping data assosiation time 0.112534 ms 
mapping solver time 0.129390 ms 
Ceres Solver Report: Iterations: 3, Initial cost: 9.924856e-03, Final cost: 6.116298e-03, Termination: CONVERGENCE
mapping optimization time 1.074125 
add points time 0.008972 ms
filter time 0.190426 ms 
mapping pub time 0.771524 ms 
whole mapping time 2.161456 ms +++++
[ INFO] [1593805379.024883091]: integrate rotation angle [x, y, z]: [-0.60, -0.54, 0.19]
points size 22870 
prepare time 1.216397 
sort q time 1.574121 
seperate points time 2.812162 
scan registration time 6.408767 ms *************
data association time 5.883629 ms 
solver time 6.762217 ms 
data association time 4.006888 ms 
solver time 4.650395 ms 
optimization twice time 21.600766 
t_w_curr: -6.31335   5.4333 0.382705
[pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
publication time 3.852808 ms 
whole laserOdometry time 25.476275 ms 
 
map prepare time 0.085383 ms
map corner num 2329  surf num 1727 
build tree time 0.455286 ms 
mapping data assosiation time 0.129060 ms 
mapping solver time 0.254923 ms 
Ceres Solver Report: Iterations: 5, Initial cost: 5.343199e-02, Final cost: 4.251993e-02, Termination: CONVERGENCE
mapping data assosiation time 0.121764 ms 
mapping solver time 0.348481 ms 
Ceres Solver Report: Iterations: 8, Initial cost: 4.575446e-02, Final cost: 2.552180e-02, Termination: CONVERGENCE
mapping optimization time 1.348014 
add points time 0.010907 ms
filter time 0.194161 ms 
mapping pub time 0.717952 ms 
whole mapping time 2.376493 ms +++++
[ INFO] [1593805379.125901087]: integrate rotation angle [x, y, z]: [0.08, -2.86, 0.19]
points size 22895 
prepare time 1.800712 
sort q time 2.210289 
seperate points time 4.469190 
scan registration time 8.339620 ms *************
data association time 6.061861 ms 
solver time 7.000941 ms 
data association time 5.749726 ms 
solver time 6.873919 ms 
optimization twice time 26.119945 
t_w_curr: -6.48028   5.6138 0.297749
[pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
publication time 5.487003 ms 
whole laserOdometry time 31.640564 ms 
 
map prepare time 0.110515 ms
map corner num 2329  surf num 1728 
build tree time 0.633441 ms 
mapping data assosiation time 0.206237 ms 
mapping solver time 0.371601 ms 
Ceres Solver Report: Iterations: 5, Initial cost: 7.604030e-02, Final cost: 6.793756e-02, Termination: CONVERGENCE
mapping data assosiation time 0.198474 ms 
mapping solver time 0.411524 ms 
Ceres Solver Report: Iterations: 6, Initial cost: 6.371648e-02, Final cost: 6.189046e-02, Termination: CONVERGENCE
mapping optimization time 1.874185 
add points time 0.012968 ms
filter time 0.248594 ms 
mapping pub time 0.936825 ms 
whole mapping time 3.215820 ms +++++
[ INFO] [1593805379.225881920]: integrate rotation angle [x, y, z]: [1.40, -0.59, 0.05]
points size 22898 
prepare time 2.058235 
sort q time 2.021078 
seperate points time 3.291847 
scan registration time 8.231259 ms *************
data association time 8.783331 ms 
solver time 10.941363 ms 
data association time 4.933638 ms 
solver time 5.944940 ms 
optimization twice time 30.953462 
t_w_curr: -6.40043  5.67126 0.326919
[pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
publication time 4.420090 ms 
whole laserOdometry time 35.401425 ms 
 
map prepare time 0.090611 ms
map corner num 2329  surf num 1730 
build tree time 0.530004 ms 
mapping data assosiation time 0.160769 ms 
mapping solver time 0.200510 ms 
Ceres Solver Report: Iterations: 3, Initial cost: 2.137667e-02, Final cost: 1.498854e-02, Termination: CONVERGENCE
mapping data assosiation time 0.153699 ms 
mapping solver time 0.175315 ms 
Ceres Solver Report: Iterations: 3, Initial cost: 1.512319e-02, Final cost: 1.224782e-02, Termination: CONVERGENCE
mapping optimization time 1.268470 
add points time 0.012260 ms
filter time 0.229308 ms 
mapping pub time 0.752674 ms 
whole mapping time 2.376499 ms +++++
[ INFO] [1593805379.325936452]: integrate rotation angle [x, y, z]: [1.47, 1.15, -0.76]
points size 22896 
prepare time 1.259392 
sort q time 1.559066 
seperate points time 3.168401 
scan registration time 6.064475 ms *************
data association time 4.883094 ms 
solver time 5.567769 ms 
data association time 4.326554 ms 
solver time 5.385614 ms 
optimization twice time 20.503912 
t_w_curr:  -6.3012  5.70278 0.359308
[pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
publication time 4.629945 ms 
whole laserOdometry time 25.164525 ms 
 
map prepare time 0.099098 ms
map corner num 2329  surf num 1730 
build tree time 0.563610 ms 
mapping data assosiation time 0.132986 ms 
mapping solver time 0.175228 ms 
Ceres Solver Report: Iterations: 3, Initial cost: 3.045036e-02, Final cost: 1.179498e-02, Termination: CONVERGENCE
mapping data assosiation time 0.125109 ms 
mapping solver time 0.142207 ms 
Ceres Solver Report: Iterations: 3, Initial cost: 1.041429e-02, Final cost: 7.731724e-03, Termination: CONVERGENCE
mapping optimization time 1.180303 
add points time 0.009803 ms
filter time 0.212063 ms 
mapping pub time 0.873728 ms 
whole mapping time 2.401797 ms +++++
[ INFO] [1593805379.430156947]: integrate rotation angle [x, y, z]: [1.68, 1.57, -1.80]
points size 22881 
prepare time 4.453112 
sort q time 4.612000 
seperate points time 8.790375 
scan registration time 19.043195 ms *************
data association time 15.144463 ms 
solver time 11.984356 ms 
data association time 5.964526 ms 
solver time 4.269261 ms 
optimization twice time 37.835048 
t_w_curr: -6.23589  5.71349  0.43351
[pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
publication time 5.513909 ms 
whole laserOdometry time 43.382477 ms 
 
map prepare time 0.092111 ms
map corner num 2329  surf num 1730 
build tree time 0.523935 ms 
mapping data assosiation time 0.136364 ms 
mapping solver time 0.271033 ms 
Ceres Solver Report: Iterations: 5, Initial cost: 4.273462e-02, Final cost: 2.810908e-02, Termination: CONVERGENCE
mapping data assosiation time 0.127592 ms 
mapping solver time 0.147575 ms 
Ceres Solver Report: Iterations: 3, Initial cost: 1.868312e-02, Final cost: 1.270330e-02, Termination: CONVERGENCE
mapping optimization time 1.248889 
add points time 0.011401 ms
filter time 0.221854 ms 
mapping pub time 0.815063 ms 
whole mapping time 2.412113 ms +++++
[ INFO] [1593805379.525938895]: integrate rotation angle [x, y, z]: [2.32, -0.72, -3.04]
points size 22887 
prepare time 1.082467 
sort q time 1.280143 
seperate points time 2.584601 
scan registration time 4.919764 ms *************
data association time 3.588216 ms 
solver time 6.719271 ms 
data association time 3.289959 ms 
solver time 4.064641 ms 
optimization twice time 17.925645 
t_w_curr: -6.34803  5.76135 0.409058
[pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
publication time 3.724999 ms 
whole laserOdometry time 21.672831 ms 
 
map prepare time 0.084638 ms
map corner num 2329  surf num 1730 
build tree time 0.444672 ms 
mapping data assosiation time 0.188260 ms 
mapping solver time 0.202635 ms 
Ceres Solver Report: Iterations: 3, Initial cost: 3.446509e-02, Final cost: 1.069474e-02, Termination: CONVERGENCE
mapping data assosiation time 0.133647 ms 
mapping solver time 0.175375 ms 
Ceres Solver Report: Iterations: 4, Initial cost: 1.938394e-02, Final cost: 1.025734e-02, Termination: CONVERGENCE
mapping optimization time 1.211476 
add points time 0.009824 ms
filter time 0.193354 ms 
mapping pub time 0.707896 ms 
whole mapping time 2.230325 ms +++++
[ INFO] [1593805379.628979057]: integrate rotation angle [x, y, z]: [0.94, 0.28, -2.75]
points size 22882 
prepare time 2.423070 
sort q time 2.959357 
seperate points time 5.345483 
scan registration time 12.007842 ms *************
data association time 8.617573 ms 
solver time 12.352575 ms 
data association time 6.107927 ms 
solver time 6.225266 ms 
optimization twice time 33.782058 
t_w_curr:  -6.3571  5.84121 0.406827
[pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
publication time 4.808508 ms 
whole laserOdometry time 38.630019 ms 
 
map prepare time 0.098078 ms
map corner num 2329  surf num 1731 
build tree time 0.551736 ms 
mapping data assosiation time 0.150426 ms 
mapping solver time 0.245071 ms 
Ceres Solver Report: Iterations: 4, Initial cost: 2.547500e-02, Final cost: 9.305108e-03, Termination: CONVERGENCE
mapping data assosiation time 0.155198 ms 
mapping solver time 0.175925 ms 
Ceres Solver Report: Iterations: 3, Initial cost: 1.274528e-02, Final cost: 8.804482e-03, Termination: CONVERGENCE
mapping optimization time 1.325043 
add points time 0.012246 ms
filter time 0.231627 ms 
mapping pub time 0.771936 ms 
whole mapping time 2.463557 ms +++++
[ INFO] [1593805379.727879034]: integrate rotation angle [x, y, z]: [1.73, -0.07, -2.13]
points size 22871 
prepare time 1.011659 
sort q time 1.208660 
seperate points time 2.198872 
scan registration time 5.103909 ms *************
data association time 4.352570 ms 
solver time 5.737053 ms 
data association time 3.444904 ms 
solver time 4.217591 ms 
optimization twice time 18.023642 
t_w_curr: -6.41503  5.89068 0.421034
[pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
publication time 3.752658 ms 
whole laserOdometry time 21.798840 ms 
 
map prepare time 0.087792 ms
map corner num 2329  surf num 1731 
build tree time 0.479373 ms 
mapping data assosiation time 0.129364 ms 
mapping solver time 0.198215 ms 
Ceres Solver Report: Iterations: 4, Initial cost: 2.715815e-02, Final cost: 1.225214e-02, Termination: CONVERGENCE
mapping data assosiation time 0.122072 ms 
mapping solver time 0.181481 ms 
Ceres Solver Report: Iterations: 4, Initial cost: 3.128488e-02, Final cost: 2.025833e-02, Termination: CONVERGENCE
mapping optimization time 1.148991 
add points time 0.009333 ms
filter time 0.218269 ms 
mapping pub time 0.751136 ms 
whole mapping time 2.237655 ms +++++
[ INFO] [1593805379.826921441]: integrate rotation angle [x, y, z]: [2.97, -2.01, -1.45]
points size 22876 
prepare time 2.215546 
sort q time 2.924838 
seperate points time 6.401571 
scan registration time 11.338737 ms *************
data association time 8.503498 ms 
solver time 12.518502 ms 
data association time 5.364897 ms 
solver time 5.943096 ms 
optimization twice time 32.755620 
t_w_curr: -6.46075  5.91873  0.49965
[pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
publication time 4.483661 ms 
whole laserOdometry time 37.266210 ms 
 
map prepare time 0.101049 ms
map corner num 2329  surf num 1731 
build tree time 0.544459 ms 
mapping data assosiation time 0.154147 ms 
mapping solver time 0.374996 ms 
Ceres Solver Report: Iterations: 7, Initial cost: 6.429751e-02, Final cost: 3.563882e-02, Termination: CONVERGENCE
mapping data assosiation time 0.146636 ms 
mapping solver time 0.301923 ms 
Ceres Solver Report: Iterations: 6, Initial cost: 4.645270e-02, Final cost: 3.966007e-02, Termination: CONVERGENCE
mapping optimization time 1.638642 
add points time 0.012320 ms
filter time 0.226586 ms 
mapping pub time 0.825745 ms 
whole mapping time 2.833017 ms +++++
[ INFO] [1593805379.924933354]: integrate rotation angle [x, y, z]: [2.27, -2.15, -1.22]
points size 22883 
prepare time 1.320474 
sort q time 1.608771 
seperate points time 2.596042 
scan registration time 6.228436 ms *************
data association time 5.719556 ms 
solver time 8.782203 ms 
data association time 4.557944 ms 
solver time 5.405896 ms 
optimization twice time 24.796798 
t_w_curr: -6.47078  5.97215 0.557364
[pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
publication time 4.599567 ms 
whole laserOdometry time 29.428343 ms 
 
map prepare time 0.116239 ms
map corner num 2329  surf num 1731 
build tree time 0.518838 ms 
mapping data assosiation time 0.165806 ms 
mapping solver time 0.524392 ms 
Ceres Solver Report: Iterations: 9, Initial cost: 8.829268e-02, Final cost: 6.081837e-02, Termination: CONVERGENCE
mapping data assosiation time 0.155131 ms 
mapping solver time 0.175808 ms 
Ceres Solver Report: Iterations: 3, Initial cost: 7.351716e-02, Final cost: 6.798252e-02, Termination: CONVERGENCE
mapping optimization time 1.587195 
add points time 0.011777 ms
filter time 0.237575 ms 
mapping pub time 0.829700 ms 
whole mapping time 2.807568 ms +++++
[ INFO] [1593805380.029154987]: integrate rotation angle [x, y, z]: [1.43, 0.14, -2.88]
points size 22872 
prepare time 3.536831 
sort q time 3.810091 
seperate points time 6.630188 
scan registration time 15.340091 ms *************
data association time 10.493413 ms 
solver time 10.170464 ms 
data association time 4.067876 ms 
solver time 4.429225 ms 
optimization twice time 29.493351 
t_w_curr: -6.46466  6.11735 0.530495
[pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
publication time 3.742180 ms 
whole laserOdometry time 33.259953 ms 
 
map prepare time 0.084818 ms
map corner num 2329  surf num 1731 
build tree time 0.445029 ms 
mapping data assosiation time 0.124376 ms 
mapping solver time 0.197325 ms 
Ceres Solver Report: Iterations: 4, Initial cost: 8.367416e-02, Final cost: 2.450717e-02, Termination: CONVERGENCE
mapping data assosiation time 0.117292 ms 
mapping solver time 0.251776 ms 
Ceres Solver Report: Iterations: 6, Initial cost: 1.098833e-01, Final cost: 6.590176e-02, Termination: CONVERGENCE
mapping optimization time 1.172830 
add points time 0.010316 ms
filter time 0.188717 ms 
mapping pub time 0.710198 ms 
whole mapping time 2.189859 ms +++++
[ INFO] [1593805380.123894633]: integrate rotation angle [x, y, z]: [-0.19, 0.28, -2.77]
points size 22854 
prepare time 1.115033 
sort q time 1.257515 
seperate points time 2.065732 
scan registration time 5.013825 ms *************
[ INFO] [1593805380.227014582]: integrate rotation angle [x, y, z]: [1.56, -0.41, -2.39]
points size 22828 
prepare time 1.757852 
sort q time 2.081837 
seperate points time 3.383745 
scan registration time 6.786817 ms *************
[laserOdometry-2] process has died [pid 6983, exit code -11, cmd /home/abacus/catkin_ws/devel/lib/loam_horizon/laserOdometry __name:=laserOdometry __log:=/home/abacus/.ros/log/7a965bc2-bd63-11ea-8c9c-dca632b01010/laserOdometry-2.log].
log file: /home/abacus/.ros/log/7a965bc2-bd63-11ea-8c9c-dca632b01010/laserOdometry-2*.log
[ INFO] [1593805380.329220417]: integrate rotation angle [x, y, z]: [1.35, -2.93, -2.97]
points size 22829 
prepare time 3.456243 
sort q time 4.576262 
seperate points time 7.473469 
scan registration time 14.658734 ms *************
[ INFO] [1593805380.431155568]: integrate rotation angle [x, y, z]: [1.81, -0.83, -2.68]
points size 22817 
prepare time 3.448612 
sort q time 4.547931 
seperate points time 8.576823 
scan registration time 15.954256 ms *************
[ INFO] [1593805380.530178763]: integrate rotation angle [x, y, z]: [1.95, -0.31, -1.84]
points size 22834 
prepare time 2.708011 
sort q time 4.544981 
seperate points time 7.393264 
scan registration time 13.962203 ms *************
[ INFO] [1593805380.631140649]: integrate rotation angle [x, y, z]: [1.22, 0.86, -1.67]
points size 22806 
prepare time 3.454363 
sort q time 4.533307 
seperate points time 7.526310 
scan registration time 14.740485 ms *************
[ INFO] [1593805380.731343140]: integrate rotation angle [x, y, z]: [2.26, 0.28, -2.78]
points size 22786 
prepare time 3.900040 
sort q time 4.632107 
seperate points time 7.591635 
scan registration time 15.936325 ms *************
[ INFO] [1593805380.828227958]: integrate rotation angle [x, y, z]: [2.60, -1.52, -2.59]
points size 22792 
prepare time 3.573615 
sort q time 4.620064 
seperate points time 8.301274 
scan registration time 15.646307 ms *************
[ INFO] [1593805380.926230605]: integrate rotation angle [x, y, z]: [0.76, 0.70, -2.05]
points size 22786 
prepare time 4.208916 
sort q time 5.916158 
seperate points time 10.540824 
scan registration time 17.389581 ms *************
[ INFO] [1593805381.030148919]: integrate rotation angle [x, y, z]: [1.19, 2.45, -0.94]
points size 22772 
prepare time 4.071120 
sort q time 4.481183 
seperate points time 7.374838 
scan registration time 15.205018 ms *************
[ INFO] [1593805381.129251967]: integrate rotation angle [x, y, z]: [0.50, -1.42, 0.61]
points size 22799 
prepare time 3.339527 
sort q time 4.510507 
seperate points time 7.281703 
scan registration time 13.092277 ms *************
[ INFO] [1593805381.231206212]: integrate rotation angle [x, y, z]: [1.51, 0.28, 0.36]
points size 22803 
prepare time 4.910754 
sort q time 4.589096 
seperate points time 7.680346 
scan registration time 17.230554 ms *************
^C[imu_process-5] killing on exit
[rviz-6] killing on exit
[livox_repub-4] killing on exit
[ WARN] [1593805381.292699634]: catch sig 2
[ INFO] [1593805381.292836625]: b_exit=true, exit
[ INFO] [1593805381.292933963]: Wait for process loop exit
[laserMapping-3] killing on exit
[scanRegistration-1] killing on exit
terminate called without an active exception
shutting down processing monitor...
... shutting down processing monitor complete
done

Point cloud export

I have successfully run the loam processing on the sample rosbag files. How can the oriented results be exported to a point cloud file (such as .pcd?)

must install pcl-1.7?

when I compile the livox_horizon_loam, I got the errors:
CMake Error at /opt/ros/kinetic/share/pcl_ros/cmake/pcl_rosConfig.cmake:113 (message):
Project 'pcl_ros' specifies '/usr/include/pcl-1.7' as an include dir, which
is not found. It does neither exist as an absolute directory nor in
'${{prefix}}//usr/include/pcl-1.7'. Check the issue tracker
'https://github.com/ros-perception/perception_pcl/issues' and consider
creating a ticket if the problem has not been reported yet.
Could someone know how to solve?

how get a good bag file?

Could you please tell me that I cannot get the calculation effect of the official bag when I use the bag recorded by livox_lidar_msg.launch, so do I need to set it when recording the bag? I'd like some help. Thank you

Error playing my rosbag file

When I was playing my own rosbag file recorded by livox_viewer, i got an error:

[ERROR] [1599999355.900913770]: Client [/livox_scanRegistration] wants topic /livox/lidar to have datatype/md5sum [sensor_msgs/PointCloud2/1158d486dd51d683ce2f1be655c3c181], but our version has [livox_ros_driver/CustomMsg/e4d6829bdfe657cb6c21a746c86b21a6]. Dropping connection.

I do not know why it happened?
How can I solve this problem?

use imu no obvious difference

I see the mapping dont have loopclosure, and i test the mapping compare use imu(horizon built-in imu) or not. But there is no obvious difference in the results.
Anyone meet the same problem?

[ERROR] [1594718132.933929306]: clear lidar buffer, only happen at the beginning

I create a node of external IMU instead of internal IMU on horizon.
And i use launch file livox_lidar_msg.launch loam_horizon loam_livox_horizon_ext_imu.launch(include external IMU node).
But i get the following errors:

[ERROR] [1594718132.433931164]: clear lidar buffer, only happen at the beginning
[ERROR] [1594718132.533930171]: clear lidar buffer, only happen at the beginning
[ERROR] [1594718132.633928597]: clear lidar buffer, only happen at the beginning
[ERROR] [1594718132.733928756]: clear lidar buffer, only happen at the beginning
[ERROR] [1594718132.833929117]: clear lidar buffer, only happen at the beginning
[ERROR] [1594718132.933929306]: clear lidar buffer, only happen at the beginning
[ERROR] [1594718133.033931449]: clear lidar buffer, only happen at the beginning
[ERROR] [1594718133.133926509]: clear lidar buffer, only happen at the beginning
[ERROR] [1594718133.233926980]: clear lidar buffer, only happen at the beginning
[ERROR] [1594718133.333933161]: clear lidar buffer, only happen at the beginning

[laserOdometry-2] process has died [pid 26345, exit code -11]

when running ' roslaunch loam_horizon loam_livox_horizon.launch ' with Lviox Horizon on Xavier NX, it gives the information as below, could anyone give me a favor?

[laserOdometry-2] process has died [pid 26345, exit code -11, cmd /home/nvidia/workspace/drone_ws/devel/lib/loam_horizon/laserOdometry __name:=laserOdometry __log:=/home/nvidia/.ros/log/3f7580d0-3956-11eb-a88f-00e02def12ea/laserOdometry-2.log].
log file: /home/nvidia/.ros/log/3f7580d0-3956-11eb-a88f-00e02def12ea/laserOdometry-2*.log

may useful information
Xavier NX: ubuntu 18.04; ROS Melodic; ceres slover 1.14.0; pcl 1.8; Eigen 3.37

Mid-40

Can this code run with Mid-40 Lidar with minimal modification? Thank you in advance!

Uses up all the memory

Noticed that this code uses up all the memory on the Xavier I'm running it on after a period of time? What is causing this? The computer has 16gig. Does it release this memory at some point or does it continue to need more?

Playing back bagfile recored with livox ros driver

Bag Time: 1619289174.066105 Duration: 0.000000 / 359.924376 Dela[ERROR] [1619309358.510427981]: Client [/livox_repub] wants topic /livox/lidar to have datatype/md5sum [livox_ros_driver/CustomMsg/e4d6829bdfe657cb6c21a746c86b21a6], but our version has [sensor_msgs/PointCloud2/1158d486dd51d683ce2f1be655c3c181]. Dropping connection.
Using the livox ros driver I can see the point cloud in rviz. I used rosbag record to record the points. Later I tried to play the bag file in livox horizon loam and received the error above. Why would one livox software not work with other livox software?
The bag file info is below:
path: 360Livox1cart.bag
version: 2.0
duration: 5:59s (359s)
start: Apr 24 2021 11:47:58.71 (1619290078.71)
end: Apr 24 2021 11:53:58.59 (1619290438.59)
size: 1.5 GB
messages: 80350
compression: none [1799/1799 chunks]
types: rosgraph_msgs/Log [acffd30cd6b6de30f120938c17c593fb]
sensor_msgs/Imu [6a62c6daae103f4ff57a132d6f95cec2]
sensor_msgs/PointCloud2 [1158d486dd51d683ce2f1be655c3c181]
topics: /livox/imu 76745 msgs : sensor_msgs/Imu
/livox/lidar 3597 msgs : sensor_msgs/PointCloud2
/rosout 8 msgs : rosgraph_msgs/Log (3 connections)

I tried to use livox mapping but it has issues building on my Jetson AGX with Ubuntu 18.04 and Open CV4.1.1

So far the results from my tests with livox are sad compared to my velodynes.
Please advise and suggestions on how to record a proper bag file that will work in horizon loam.

thanks

How to determine "extrinsic quaternion" in External IMU rosbag?

Hello all,

I intend to use IMU data from a NovAtel receiver. Here in your README, it determines the extrinsic quaternion as (0, 1, 0, 0) and modifies the launch file to those numbers.

The confusion is, as far as I know, quaternion keeps changing during the operation of the IMU as the vehicle moves. How can we determine it as fixed numbers like that?

Thank you a lot for any help.

Question: Is the first lidar frame discarded?

Just checking my understanding the code.

The main ProcessLoop calls ImuProcess::Process at 1 second intervals.

However, the first time ImuProcess::Process is called, b_first_frame_ is true, so it assigns last_lidar_ and last_imu_ but otherwise seems to discard this first point cloud capture.

If correct, should we anticipate that we need an initialisation time of at least one second before we can start creating our map?

Can't calculate

zzzj@zzzj:~/catkin_ws$ roslaunch loam_horizon loam_livox_horizon.launch
... logging to /home/zzzj/.ros/log/fc07f920-99de-11ea-8582-c4d98799c302/roslaunch-zzzj-10137.log
Checking log directory for disk usage. This may take awhile.
Press Ctrl-C to interrupt
Done checking log file disk usage. Usage is <1GB.

started roslaunch server http://zzzj:40781/

SUMMARY

PARAMETERS

  • /mapping_line_resolution: 0.3
  • /mapping_plane_resolution: 0.6
  • /mapping_skip_frame: 2
  • /minimum_range: 0.3
  • /rosdistro: kinetic
  • /rosversion: 1.12.14
  • /scan_line: 6
  • /threshold_flat: 0.01
  • /threshold_sharp: 0.1

NODES
/
laserMapping (loam_horizon/laserMapping)
laserOdometry (loam_horizon/laserOdometry)
livox_repub (loam_horizon/livox_repub)
rviz (rviz/rviz)
scanRegistration (loam_horizon/scanRegistration)

auto-starting new master
process[master]: started with pid [10147]
ROS_MASTER_URI=http://localhost:11311

setting /run_id to fc07f920-99de-11ea-8582-c4d98799c302
process[rosout-1]: started with pid [10160]
started core service [/rosout]
process[scanRegistration-2]: started with pid [10172]
process[laserOdometry-3]: started with pid [10178]
process[laserMapping-4]: started with pid [10179]
process[livox_repub-5]: started with pid [10187]
Mapping 5 Hz
process[rviz-6]: started with pid [10193]
[ INFO] [1589899358.673880559]: start livox_repub
scan line number 6
line resolution 0.300000 plane resolution 0.600000
points size 22605
prepare time 5.818291
sort q time 1.966182
seperate points time 4.824765
scan registration time 16.504640 ms *************
Initialization finished
publication time 8.713276 ms
whole laserOdometry time 8.776731 ms

map prepare time 0.268825 ms
map corner num 0 surf num 0
[ WARN] [1589899369.000657958]: time Map corner and surf num are not enough
add points time 0.064741 ms
filter time 0.503859 ms
mapping pub time 4.369223 ms
whole mapping time 5.561359 ms +++++
points size 22693
prepare time 2.868194
sort q time 2.249739
seperate points time 4.619469
scan registration time 11.440953 ms *************
data association time 9.276748 ms
solver time 12.395173 ms
data association time 10.845608 ms
solver time 10.061607 ms
optimization twice time 43.386836
t_w_curr: 0.0818173 0.00438026 0.00992547
publication time 8.230904 ms
whole laserOdometry time 51.782643 ms

points size 22703
prepare time 3.634014
sort q time 2.274923
seperate points time 5.093734
scan registration time 12.782456 ms *************
data association time 7.990031 ms
solver time 9.597534 ms
data association time 8.046268 ms
solver time 6.374530 ms
optimization twice time 32.595536
t_w_curr: 0.173467 0.00919051 0.0106125
publication time 7.973334 ms
whole laserOdometry time 40.664500 ms

[laserMapping-4] process has died [pid 10179, exit code -11, cmd /home/zzzj/catkin_ws/devel/lib/loam_horizon/laserMapping __name:=laserMapping __log:=/home/zzzj/.ros/log/fc07f920-99de-11ea-8582-c4d98799c302/laserMapping-4.log].
log file: /home/zzzj/.ros/log/fc07f920-99de-11ea-8582-c4d98799c302/laserMapping-4*.log
points size 22634
prepare time 8.347636
sort q time 2.019777
seperate points time 4.798511
scan registration time 18.234239 ms *************
data association time 7.992015 ms
solver time 6.208782 ms
data association time 6.530049 ms
solver time 6.304133 ms
optimization twice time 27.522775
t_w_curr: 0.259279 0.0198044 0.00887386
publication time 5.349825 ms
whole laserOdometry time 32.942995 ms

Compile the prompt that appears:

[ 91%] Linking CXX executable /home/zzzj/catkin_ws/devel/lib/loam_horizon/laserMapping
[100%] Linking CXX executable /home/zzzj/catkin_ws/devel/lib/loam_horizon/imu_process
[100%] Built target laserOdometry
[100%] Built target imu_process
/usr/bin/ld: warning: libpcl_filters.so.1.9, needed by /usr/local/lib/libpcl_segmentation.so, may conflict with libpcl_filters.so.1.7
/usr/bin/ld: warning: libpcl_common.so.1.9, needed by /usr/local/lib/libpcl_segmentation.so, may conflict with libpcl_common.so.1.7
/usr/bin/ld: warning: libpcl_kdtree.so.1.9, needed by /usr/local/lib/libpcl_features.so, may conflict with libpcl_kdtree.so.1.7
[100%] Built target laserMapping

What's the reason, please

About prerequisites

When I tried to build this project, I found that it needs opencv. So, why not add opencv into the prerequisites in readme?

No file after completing by Ctrl+C

Hi, I set up the Livox-Horizon-LOAM according to the instructions posted here https://github.com/Livox-SDK/livox_horizon_loam. running commands:
roslaunch livox_ros_driver livox_lidar_msg.launch
roslaunch loam_horizon loam_livox_horizon.launch
execution and visualization via RVIZ is underway. But after the algorithm completes, the *.lvx file is not generated. Where should the file be saved by default? What could be the problem?

Question: Where to get laser line number ?

Hi,

can I ask you, where can I find the CustomPoint.line value ? I want to use custom dataset with your SLAM. I've recorded the dataset with livox SDK tool and wondering, how can i find the laser number in lidar. I tried some .lvx files from previous recordings and still cant find the laser number.

Thanks

Ceres solver nan problem

When running the parking lot rosbag and my own rosbag, I have the following ceres solver nan problem:
Screenshot from 2020-07-14 16-17-58

It happens in laserOdometry.cpp when creating LidarPlaneFactor. I checked the input points, they looked fine. No clue how the nan was calculated.
Does anyone have the same issue?

Catkin error

Hi,
I was trying to install Livox horizon loam using https://github.com/Livox-SDK/livox_horizon_loam, I installed the dependencies and everything seems to be working.
At part2, when I want to build, I received a message that it cannot find livox_ros_driverConfig.cmake, so I set (livox_ros_driver_DIR /home/user/catkin_ws1/build/livox_ros_driver/catkin_generated/installspace )

But this time I get this message:
livox_horizon_loam/CMakeFiles/laserMapping.dir/build.make:62: recipe for target 'livox_horizon_loam/CMakeFiles/laserMapping.dir/src/laserMapping.cpp.o' failed
make[2]: *** [livox_horizon_loam/CMakeFiles/laserMapping.dir/src/laserMapping.cpp.o] Error 1
CMakeFiles/Makefile2:551: recipe for target 'livox_horizon_loam/CMakeFiles/laserMapping.dir/all' failed
make[1]: *** [livox_horizon_loam/CMakeFiles/laserMapping.dir/all] Error 2
make[1]: *** Waiting for unfinished jobs....
livox_horizon_loam/CMakeFiles/laserOdometry.dir/build.make:62: recipe for target 'livox_horizon_loam/CMakeFiles/laserOdometry.dir/src/laserOdometry.cpp.o' failed
make[2]: *** [livox_horizon_loam/CMakeFiles/laserOdometry.dir/src/laserOdometry.cpp.o] Error 1
CMakeFiles/Makefile2:578: recipe for target 'livox_horizon_loam/CMakeFiles/laserOdometry.dir/all' failed
make[1]: *** [livox_horizon_loam/CMakeFiles/laserOdometry.dir/all] Error 2
[ 66%] Built target livox_repub
[ 75%] Linking CXX executable /home/user/catkin_ws/devel/lib/loam_horizon/scanRegistration
[ 75%] Built target scanRegistration
[ 83%] Linking CXX executable /home/user/catkin_ws/devel/lib/loam_horizon/imu_process
[ 83%] Built target imu_process
Makefile:140: recipe for target 'all' failed
make: *** [all] Error 2
Invoking "make -j6 -l6" failed

I really appreciate it if you help me with this issue.
Thanks

ceres problems

when i used "catkin_make" to compile the project, i got the errors as follows :

/usr/local/include/ceres/internal/integer_sequence_algorithm.h:64:16: error: ‘integer_sequence’ is not a member of ‘std’
struct SumImpl<std::integer_sequence<T, N, Ns...>> {
^
/usr/local/include/ceres/internal/integer_sequence_algorithm.h:64:16: error: ‘integer_sequence’ is not a member of ‘std’
/usr/local/include/ceres/internal/integer_sequence_algorithm.h:64:46: error: wrong number of template arguments (3, should be 1)
struct SumImpl<std::integer_sequence<T, N, Ns...>> {
^
/usr/local/include/ceres/internal/integer_sequence_algorithm.h:60:8: note: provided for ‘template struct ceres::internal::SumImpl’
struct SumImpl;
^
/usr/local/include/ceres/internal/integer_sequence_algorithm.h:64:49: error: expected unqualified-id before ‘>’ token
struct SumImpl<std::integer_sequence<T, N, Ns...>> {
^

Livox HAP LiDAR

May I ask if the Livox HAP radar can be built with this program?

Run times error

[ERROR] [1582104656.932088632]: Client [/livox_repub] wants topic /livox/lidar to have datatype/md5sum [livox_ros_driver/CustomMsg/e4d6829bdfe657cb6c21a746c86b21a6], but our version has [sensor_msgs/PointCloud2/1158d486dd51d683ce2f1be655c3c181]. Dropping connection.

What's the problem, please

catkin_make:error.请问怎么解决

CMake Error at /opt/ros/melodic/share/catkin/cmake/catkinConfig.cmake:83 (find_package):
Could not find a package configuration file provided by "livox_ros_driver"
with any of the following names:

livox_ros_driverConfig.cmake
livox_ros_driver-config.cmake

Add the installation prefix of "livox_ros_driver" to CMAKE_PREFIX_PATH or
set "livox_ros_driver_DIR" to a directory containing one of the above
files. If "livox_ros_driver" provides a separate development package or
SDK, be sure it has been installed.
Call Stack (most recent call first):
livox_horizon_loam/CMakeLists.txt:8 (find_package)

-- Configuring incomplete, errors occurred!
See also "/home/zehao/ws_horizon_slam/build/CMakeFiles/CMakeOutput.log".
See also "/home/zehao/ws_horizon_slam/build/CMakeFiles/CMakeError.log".
Invoking "cmake" failed

double free or corruption (out)

has anyone met the double free or corruption (out) issue?
I got this error log when I run the mapping program:

add points time 0.036292 ms
filter time 0.046774 ms
mapping pub time 1.388891 ms
whole mapping time 2.285440 ms +++++
double free or corruption (out)

running and generating a pointcloud (.las)

i successfully installed the loam following the guide, but now i am stuck a bit. Can you guide me how to generate a pointcloud out of that.

as far as i have understood i have to choose the ros every time i open the console:
source ~/catkin_ws/devel/setup.bash

then i run
roslaunch loam_horizon loam_livox_horizon_imu.launch
to get the data from lidar and IMU?

whilst
rosbag play YOUR_DOWNLOADED.bag - in my case rosbag play 2020_open_road.bag
will add the lidar data to the file?
i do not really get it and to be honest i did not unterstand the ros documentation.

So this is the point where i am standing, is there someone able and willing to point me into the right direction?
When looking for the points mentioned i found the line
rosrun pcl_ros pointcloud_to_pcd input:=/velodyne/pointcloud2
which looks like refering to the subscibe to /velodyne_cloud_registered and register, but i dont get it and i dont really get how the magic works. And what ist meant by registering them together?

Anyone who is able to help me with that?

Scan Accuracy

Hello. How to achieve the accuracy of the map so that the error is within 2 cm? Now the error as a result of LOAM is 10 cm. The scanner is used by LIVOX Horizont. Or is there another way to get a map with the lowest possible error?

Recommend Projects

  • React photo React

    A declarative, efficient, and flexible JavaScript library for building user interfaces.

  • Vue.js photo Vue.js

    🖖 Vue.js is a progressive, incrementally-adoptable JavaScript framework for building UI on the web.

  • Typescript photo Typescript

    TypeScript is a superset of JavaScript that compiles to clean JavaScript output.

  • TensorFlow photo TensorFlow

    An Open Source Machine Learning Framework for Everyone

  • Django photo Django

    The Web framework for perfectionists with deadlines.

  • D3 photo D3

    Bring data to life with SVG, Canvas and HTML. 📊📈🎉

Recommend Topics

  • javascript

    JavaScript (JS) is a lightweight interpreted programming language with first-class functions.

  • web

    Some thing interesting about web. New door for the world.

  • server

    A server is a program made to process requests and deliver data to clients.

  • Machine learning

    Machine learning is a way of modeling and interpreting data that allows a piece of software to respond intelligently.

  • Game

    Some thing interesting about game, make everyone happy.

Recommend Org

  • Facebook photo Facebook

    We are working to build community through open source technology. NB: members must have two-factor auth.

  • Microsoft photo Microsoft

    Open source projects and samples from Microsoft.

  • Google photo Google

    Google ❤️ Open Source for everyone.

  • D3 photo D3

    Data-Driven Documents codes.