Skip to content

HealthDataInsight/ldlidar_stl_ros2

 
 

Folders and files

NameName
Last commit message
Last commit date

Latest commit

 

History

24 Commits
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 

Repository files navigation

操作指南

此SDK仅适用于深圳乐动机器人有限公司销售的激光雷达产品,产品型号为:

  • LDROBOT LiDAR LD06
  • LDROBOT LiDAR LD19
  • LDROBOT LiDAR STL-27L

0. 获取雷达的ROS2功能包

cd ~

mkdir -p ldlidar_ros2_ws/src

cd ldlidar_ros2_ws/src

git clone  https://github.com/ldrobotSensorTeam/ldlidar_stl_ros2.git

1. 系统设置

  • 第一步,通过板载串口或者USB转串口模块(例如,cp2102模块)的方式使雷达连接到你的系统主板.
  • 第二步,设置雷达在系统中挂载的串口设备-x权限(以/dev/ttyUSB0为例)
    • 实际使用时,根据雷达在你的系统中的实际挂载情况来设置,可以使用ls -l /dev命令查看.
cd ~/ldlidar_ros2_ws

sudo chmod 777 /dev/ttyUSB0
  • 第三步,修改launch/目录下雷达产品型号对应的lanuch文件中的port_name值,以ld06.launch.py/dev/ttyUSB0为例,如下所示.
#!/usr/bin/env python3
from launch import LaunchDescription
from launch_ros.actions import Node

'''
Parameter Description:
---
- Set laser scan directon: 
  1. Set counterclockwise, example: {'laser_scan_dir': True}
  2. Set clockwise,        example: {'laser_scan_dir': False}
- Angle crop setting, Mask data within the set angle range:
  1. Enable angle crop fuction:
    1.1. enable angle crop,  example: {'enable_angle_crop_func': True}
    1.2. disable angle crop, example: {'enable_angle_crop_func': False}
  2. Angle cropping interval setting:
  - The distance and intensity data within the set angle range will be set to 0.
  - angle >= 'angle_crop_min' and angle <= 'angle_crop_max' which is [angle_crop_min, angle_crop_max], unit is degress.
    example:
      {'angle_crop_min': 135.0}
      {'angle_crop_max': 225.0}
      which is [135.0, 225.0], angle unit is degress.
'''

def generate_launch_description():
  # LDROBOT LiDAR publisher node
  ldlidar_node = Node(
      package='ldlidar_stl_ros2',
      executable='ldlidar_stl_ros2_node',
      name='LD06',
      output='screen',
      parameters=[
        {'product_name': 'LDLiDAR_LD06'},
        {'topic_name': 'scan'},
        {'frame_id': 'base_laser'},
        {'port_name': '/dev/ttyUSB0'},
        {'port_baudrate': 230400},
        {'laser_scan_dir': True},
        {'enable_angle_crop_func': False},
        {'angle_crop_min': 135.0},
        {'angle_crop_max': 225.0}
      ]
  )

  # base_link to base_laser tf node
  base_link_to_laser_tf_node = Node(
    package='tf2_ros',
    executable='static_transform_publisher',
    name='base_link_to_base_laser_ld06',
    arguments=['0','0','0.18','0','0','0','base_link','base_laser']
  )


  # Define LaunchDescription variable
  ld = LaunchDescription()

  ld.add_action(ldlidar_node)
  ld.add_action(base_link_to_laser_tf_node)

  return ld

2. 编译方法

使用colcon编译.

cd ~/ldlidar_ros2_ws

colcon build

3. 运行方法

3.1. 设置功能包环境变量

  • 编译完成后需要将编译生成的相关文件加入环境变量,便于 ROS 环境可以识别, 执行命令如下所示, 该命令是临时给终端加入环境变量,意味着您如果重新打开新的终端,也需要重新执行如下命令.

    cd ~/ldlidar_ros2_ws
    
    source install/setup.bash
  • 为了重新打开终端后,永久不用执行上述添加环境变量的命令,可以进行如下操作.

    echo source ~/ldlidar_ros2_ws/install/setup.bash >> ~/.bashrc
    
    source ~/.bashrc

3.2. 启动激光雷达节点

  • 产品型号为 LDROBOT LiDAR LD06

    • 启动ld06 lidar node:
    ros2 launch ldlidar_stl_ros2 ld06.launch.py
    • 启动ld06 lidar node并显示激光数据在Rviz2上:
    ros2 launch ldlidar_stl_ros2 viewer_ld06.launch.py
  • 产品型号为 LDROBOT LiDAR LD19

    • 启动ld19 lidar node:
    ros2 launch ldlidar_stl_ros2 ld19.launch.py
    • 启动ld19 lidar node并显示激光数据在Rviz2上:
    ros2 launch ldlidar_stl_ros2 viewer_ld19.launch.py
  • 产品型号为 LDROBOT LiDAR STL-27L

    • 启动stl27l lidar node:
    ros2 launch ldlidar_stl_ros2 stl27l.launch.py
    • 启动stl27l lidar node并显示激光数据在Rviz2上:
    ros2 launch ldlidar_stl_ros2 viewer_stl27l.launch.py

4. 测试

代码支持ubuntu20.04 ROS2 foxy版本及以上测试,使用rviz2可视化。

  • 新打开一个终端 (Ctrl + Alt + T),运行命令:rviz2,并通过Rviz2工具打开readme文件所在目录的rviz2文件夹下面的ldlidar.rviz文件
rviz2

Instructions

This SDK is only applicable to the LiDAR products sold by Shenzhen LDROBOT Co., LTD. The product models are :

  • LDROBOT LiDAR LD06
  • LDROBOT LiDAR LD19
  • LDROBOT LiDAR STL-27L

step 0: get LiDAR ROS2 Package

cd ~

mkdir -p ldlidar_ros2_ws/src

cd ldlidar_ros2_ws/src

git clone  https://github.com/ldrobotSensorTeam/ldlidar_stl_ros2.git

step 1: system setup

  • Connect the LiDAR to your system motherboard via an onboard serial port or usB-to-serial module (for example, CP2102 module).

  • Set the -x permission for the serial port device mounted by the radar in the system (for example, /dev/ttyUSB0)

    • In actual use, the LiDAR can be set according to the actual mounted status of your system, you can use 'ls -l /dev' command to view.
cd ~/ldlidar_ros2_ws

sudo chmod 777 /dev/ttyUSB0
  • Modify the port_name value in the Lanuch file corresponding to the radar product model under launch/, using ld06.launch.py and /dev/ttyUSB0 as an example, as shown below.
#!/usr/bin/env python3
from launch import LaunchDescription
from launch_ros.actions import Node

'''
Parameter Description:
---
- Set laser scan directon: 
  1. Set counterclockwise, example: {'laser_scan_dir': True}
  2. Set clockwise,        example: {'laser_scan_dir': False}
- Angle crop setting, Mask data within the set angle range:
  1. Enable angle crop fuction:
    1.1. enable angle crop,  example: {'enable_angle_crop_func': True}
    1.2. disable angle crop, example: {'enable_angle_crop_func': False}
  2. Angle cropping interval setting:
  - The distance and intensity data within the set angle range will be set to 0.
  - angle >= 'angle_crop_min' and angle <= 'angle_crop_max' which is [angle_crop_min, angle_crop_max], unit is degress.
    example:
      {'angle_crop_min': 135.0}
      {'angle_crop_max': 225.0}
      which is [135.0, 225.0], angle unit is degress.
'''

def generate_launch_description():
  # LDROBOT LiDAR publisher node
  ldlidar_node = Node(
      package='ldlidar_stl_ros2',
      executable='ldlidar_stl_ros2_node',
      name='LD06',
      output='screen',
      parameters=[
        {'product_name': 'LDLiDAR_LD06'},
        {'topic_name': 'scan'},
        {'frame_id': 'base_laser'},
        {'port_name': '/dev/ttyUSB0'},
        {'port_baudrate': 230400},
        {'laser_scan_dir': True},
        {'enable_angle_crop_func': False},
        {'angle_crop_min': 135.0},
        {'angle_crop_max': 225.0}
      ]
  )

  # base_link to base_laser tf node
  base_link_to_laser_tf_node = Node(
    package='tf2_ros',
    executable='static_transform_publisher',
    name='base_link_to_base_laser_ld06',
    arguments=['0','0','0.18','0','0','0','base_link','base_laser']
  )


  # Define LaunchDescription variable
  ld = LaunchDescription()

  ld.add_action(ldlidar_node)
  ld.add_action(base_link_to_laser_tf_node)

  return ld

step 2: build

Run the following command.

cd ~/ldlidar_ros2_ws

colcon build

step 3: run

step3.1: package environment variable settings

  • After the compilation is completed, you need to add the relevant files generated by the compilation to the environment variables, so that the ROS environment can recognize them. The execution command is as follows. This command is to temporarily add environment variables to the terminal, which means that if you reopen a new terminal, you also need to re-execute it. The following command.

    cd ~/ldlidar_ros2_ws
    
    source install/setup.bash
  • In order to never need to execute the above command to add environment variables after reopening the terminal, you can do the following.

    echo source ~/ldlidar_ros2_ws/install/setup.bash >> ~/.bashrc
    
    source ~/.bashrc

step3.2: start LiDAR node

  • The product is LDROBOT LiDAR LD06

    • start ld06 lidar node:
    ros2 launch ldlidar_stl_ros2 ld06.launch.py
    • start ld06 lidar node and show on the Rviz2:
    ros2 launch ldlidar_stl_ros2 viewer_ld06.launch.py
  • The product is LDROBOT LiDAR LD19

    • start ld19 lidar node:
    ros2 launch ldlidar_stl_ros2 ld19.launch.py
    • start ld19 lidar node and show on the Rviz2:
    ros2 launch ldlidar_stl_ros2 viewer_ld19.launch.py
  • The product is LDROBOT LiDAR STL-27L

    • start stl27l lidar node:
    ros2 launch ldlidar_stl_ros2 stl27l.launch.py
    • start stl27l lidar node and show on the Rviz2:
    ros2 launch ldlidar_stl_ros2 viewer_stl27l.launch.py

step 4: test

The code supports ubuntu 20.04 ros2 foxy version and above, using rviz2 visualization.

  • new a terminal (Ctrl + Alt + T) and use Rviz2 tool(run command: rviz2) ,open the ldlidar.rviz file below the rviz2 folder of the readme file directory
rviz2

Packages

No packages published

Languages

  • C++ 88.1%
  • Python 8.7%
  • CMake 2.5%
  • Shell 0.7%