Awesome
LiDAR_Inertial_Visual_Handhold
News
27 October 2024: Add modified livox_ros_driver2 with time sync support for Mid360.11 October 2024: Add support for other pixel formats besides RGB8 (e.g., BayerRG8, BayerRG12Packed).03 October 2024: Add ARM support, fix the camera driver startup and shutdown bug, remove the SerialNumber dependency, resolve the auto-exposure mode switching issue, and add a TriggerEnable interface to allow testing the camera without the PPS signal.15 July 2024: Fix the bug related to LiDAR (IMU) timestamp compensation in thelivox_ros_driver, remove the dynamic library dependency frommvs_ros_driver, and enable this synchronization scheme to use the officiallivox_sdk.28 June 2024: Update reproduction videos and some important notes.27 May 2024: Fix a bug in the calculation of the synthetic GPRMC timestamp, which could cause timestamp rollback. Additionally, we add checksum verification for GPRMC.20 May 2024: According to Livox Avia's pin requirements, we convert PPS TTL level to RS485 level and supplement it with more detailed electronic connection and material list.
1. Introduction
This repository provides the CAD files (with suffix “*.SLDPRT and *.SLDASM”) for our handheld device, which can be opened and edited with Solidworks. All of the modules are suitable for printing with FDM (Fused Deposition Modeling). In addition, we have also open-sourced our hardware synchronization scheme, as well as the STM32 source code and hardware wiring configuration instructions.
<div align="center"> <img src="./pics/cover.jpg" width="100.0%" /> </div>2. Relevant guidance video
Thanks to the Bilibili uploader GundaSmart for making a detailed reproduction video. Everyone can follow the video to reproduce it. His sensor configuration includes a MID360 and a Hikvision pinhole camera.
FAST-LIVO Reproduction (Part 1)
FAST-LIVO Reproduction (Part 2)
FAST-LIVO Reproduction (Part 3)
FAST-LIVO Reproduction (Part 4)
FAST-LIVO Reproduction (Part 5)
3. Guide to installation
3.1 Root directory
├── handhold_cad/ - CAD source files
│ ├── ...
├── livox_ros_driver/ - Livox LiDAR ROS driver
│ ├── ...
├── mvs_ros_pkg/ - Camera driver
│ ├── ...
└── stm32_timersync-open/ - Embedded engineering folder
│ ├── USER/ - Main functionality folder
│ ├── ...
└── README.md - Project homepage document
└── ...
3.2 Assembly instruction
The assembly instructions are demonstrated in the GIFs below. Each module is clearly labeled corresponding to the name of its STL file.
<p align="center"> <img src="./pics/1.gif" alt="1" width="48%"> <img src="./pics/2.gif" alt="2" width="48%"> </p>3.3 Electronic connection
The guide for the electronic connections is presented as follows:
<table> <tr> <th>Livox AVIA LiDAR M12</th> <th>Peripheral Function</th> <th>Diagram</th> </tr> <tr> <td>PIN 1</td> <td>Power: +</td> <td rowspan="8" align="center"> <img src="./pics/12PIN.jpg" alt="Diagram" width="38%"><br> <span style="display: block; text-align: center;">AVIA 12-Pin Interface, top: female bottom: male</span> </td> </tr> <tr> <td>PIN 2</td> <td>Ground</td> </tr> <tr> <td>PIN 7</td> <td>Ethernet: RX-</td> </tr> <tr> <td>PIN 6</td> <td>Ethernet: RX+</td> </tr> <tr> <td>PIN 5</td> <td>Ethernet: TX-</td> </tr> <tr> <td>PIN 4</td> <td>Ethernet: TX+</td> </tr> <tr> <td>PIN 11 (Sync-)</td> <td>RS485_Output B-</td> </tr> <tr> <td>PIN 12 (Sync+)</td> <td>RS485_Output A+</td> </tr> </table> <table> <tr> <th>MVS Camera 6PIN</th> <th>Name</th> <th>I/O Type</th> <th>Description</th> <th>Peripheral Function</th> <th>Diagram</th> </tr> <tr> <td>PIN 1</td> <td>DC_PWR</td> <td>--</td> <td>Power Supply</td> <td></td> <td rowspan="8" style="text-align: center;"> <img src="./pics/6PIN.jpg" alt="Diagram" style="width: auto; height: auto; max-width: 100%;"><br> <span style="display: block; text-align: center;">MVS Camera 6-Pin Interface</span> </td> </tr> <tr> <td>PIN 2</td> <td>OPTO_IN</td> <td>Line 0+</td> <td>Optical Isolation Input</td> <td>STM32 PA1</td> </tr> <tr> <td>PIN 3</td> <td>GPIO</td> <td>Line 2+</td> <td>General Purpose Input/Output</td> <td></td> </tr> <tr> <td>PIN 4</td> <td>OPTO_OUT</td> <td>Line 1+</td> <td>Optical Isolation Output</td> <td></td> </tr> <tr> <td>PIN 5</td> <td>OPTO_GND</td> <td>Line 0- / 1-</td> <td>Optical Isolation Ground</td> <td>STM32 GND</td> </tr> <tr> <td>PIN 6</td> <td>GND</td> <td>Line 2-</td> <td>Ground</td> <td></td> </tr> </table> <table> <tr> <th>STM32</th> <th>Peripheral Function</th> </tr> <tr> <td>PA1</td> <td>MVS camera PIN2 (OPTO_IN)</td> </tr> <tr> <td>PB5</td> <td>RS485_Input (TXD)</td> </tr> <tr> <td>PA9</td> <td>TTL2USB (RXD)</td> </tr> <tr> <td>VCC</td> <td>RS485_Input (VCC) | TTL2USB (VCC)</td> </tr> <tr> <td>GND</td> <td>RS485_Input (GND) | TTL2USB (GND) | MVS camera PIN5 (GND)</td> </tr> </table> <table> <tr> <th>RS485</th> <th>Peripheral Function</th> </tr> <tr> <td>RS485_Output A+</td> <td>LiDAR M12 PIN12 (Sync+)</td> </tr> <tr> <td>RS485_Output B-</td> <td>LiDAR M12 PIN11 (Sync-)</td> </tr> <tr> <td>RS485_Output (GND)</td> <td>LiDAR M12 PIN2 (GND)</td> </tr> </table>🔴🔥 IMPORTANT:
- STM32 PB5 (PPS signal) is converted from TTL to RS-485, resulting in RS485_Output A+ and RS485_Output B-;
- STM32 TXD (GPRMC) is converted from TTL to USB and sent to the PC;
- If you are using the Mid360, you can directly connect STM32 PB5 to LiDAR M12 pps interface;
- Before you
roslaunch livox_ros_driver livox_lidar_msg.launch, you can usesudo chmod a+rw /dev/ttyUSB0grant permissions to the USB serial port; - The default connection method in this repository directly connects to M12 without using the Livox converter. If you use the converter, you can connect STM32 PB5 (PPS signal) to the Livox converter Sync Port without converting TTL to 485 level. Refer to Issue 19 for details.
4. How to run the driver
roslaunch mvs_ros_pkg mvs_camera_trigger.launch
roslaunch livox_ros_driver livox_lidar_msg.launch
rosbag record /livox/lidar /livox/imu left_camera/image
5. Main material lists (only for reference)
| Item | Pics | Purchasing list |
|---|---|---|
| Livox Avia LiDAR | <img src="./pics/livox_avia.png" width=20% /> | Livox Avia |
| CMOS | <img src="./pics/cmos.jpg" width=20% /> | MV-CA013-21UC |
| Camera Len | <img src="./pics/len.jpg" width=20% /> | MVL-HF0628M-6MPE |
| STM32 | <img src="./pics/stm32.jpg" width=25% /> | STM32F103C8T6 |
| Screen | <img src="./pics/screen.jpg" width=25% /> | IPS Screen 10'' |
| Battery | <img src="./pics/battery.jpg" width=30% /> | 4800mah |
| TTL to USB | <img src="./pics/usb.jpg" width=30% /> | TTL to USB |
| TTL to 485 | <img src="./pics/485.jpg" width=30% /> | TTL to 485 |
6. License
The source code is released under GPLv3 license.
If you use any code of this repo in your academic research, it will be very appreciated if you can cite any of our following papers:
[1] Zheng, Chunran, et al. "FAST-LIVO2: Fast, Direct LiDAR-Inertial-Visual Odometry."
[2] Zheng, Chunran, et al. "FAST-LIVO: Fast and Tightly-coupled Sparse-Direct LiDAR-Inertial-Visual Odometry."
[3] Hong, Sheng, et al. "Rollvox: real-time and high-quality LiDAR colorization with rolling shutter camera."