Based on the sick_scan drivers for ROS1, sick_scan_xd merges sick_scan, sick_scan2 and sick_scan_base repositories. The driver supports both Linux (native, ROS1, ROS2) and Windows (native and ROS2).
Apache License 2.0
100
stars
84
forks
source link
ROS_INFO: Software PLL is ready and locked now! #161
Hello, sir. I run the sick_lms_5xx.launch on sick Ims511 on Windows with no ros. But I can't receive the Complete point cloud coordinate information. but there are part coordinates.Could you help me?
Hello, sir. I run the sick_lms_5xx.launch on sick Ims511 on Windows with no ros. But I can't receive the Complete point cloud coordinate information. but there are part coordinates.Could you help me?
This is my sick_Ims_5xx.launch file.
This is my Log information.
F:\Lidar_Demo\sick_scan_ws\sick_scan_xd>.\build\Debug\sick_scan_xd_api_test.exe launch/sick_lms_5xx.launch hostname:=192.168.0.12
sick_scan_xd_api_test started [Info]: sick_scan_api V. 2.8.15 [Info]: SickScanApiInitByCli: .\build\Debug\sick_scan_xd_api_test.exe launch/sick_lms_5xx.launch hostname:=192.168.0.12 [Info]: Try loading launchfile : launch/sick_lms_5xx.launch [Info]: LaunchParser::parseFile(launch/sick_lms_5xx.launch): default_args["hostname"]="192.168.0.10" [Info]: LaunchParser::parseFile(launch/sick_lms_5xx.launch): default_args["cloud_topic"]="cloud" [Info]: LaunchParser::parseFile(launch/sick_lms_5xx.launch): default_args["frame_id"]="cloud" [Info]: LaunchParser::parseFile(launch/sick_lms_5xx.launch): default_args["sw_pll_only_publish"]="true" [Info]: LaunchParser::parseFile(launch/sick_lms_5xx.launch): default_args["nodename"]="sick_lms_5xx" [Info]: LaunchParser::parseFile(launch/sick_lms_5xx.launch): default_args["add_transform_xyz_rpy"]="0,0,0,0,0,0" [Info]: LaunchParser::parseFile(launch/sick_lms_5xx.launch): default_args["add_transform_check_dynamic_updates"]="false" [Info]: LaunchParser::parseFile(launch/sick_lms_5xx.launch): name="min_ang", type="double", value="-1.658062789" [Info]: LaunchParser::parseFile(launch/sick_lms_5xx.launch): name="max_ang", type="double", value="1.658062789" [Info]: LaunchParser::parseFile(launch/sick_lms_5xx.launch): name="cloud_topic", type="string", value="$(arg cloud_topic)" overwritten by default value "cloud" [Info]: LaunchParser::parseFile(launch/sick_lms_5xx.launch): name="cloud_topic", type="string", value="cloud" [Info]: LaunchParser::parseFile(launch/sick_lms_5xx.launch): name="frame_id", type="str", value="$(arg frame_id)" overwritten by default value "cloud" [Info]: LaunchParser::parseFile(launch/sick_lms_5xx.launch): name="frame_id", type="str", value="cloud" [Info]: LaunchParser::parseFile(launch/sick_lms_5xx.launch): name="scanner_type", type="string", value="sick_lms_5xx" [Info]: LaunchParser::parseFile(launch/sick_lms_5xx.launch): name="range_min", type="double", value="0.05" [Info]: LaunchParser::parseFile(launch/sick_lms_5xx.launch): name="range_max", type="double", value="100.0" [Info]: LaunchParser::parseFile(launch/sick_lms_5xx.launch): name="range_filter_handling", type="int", value="0" [Info]: LaunchParser::parseFile(launch/sick_lms_5xx.launch): name="intensity", type="bool", value="true" [Info]: LaunchParser::parseFile(launch/sick_lms_5xx.launch): name="intensity_resolution_16bit", type="bool", value="false" [Info]: LaunchParser::parseFile(launch/sick_lms_5xx.launch): name="hostname", type="string", value="$(arg hostname)" overwritten by default value "192.168.0.10" [Info]: LaunchParser::parseFile(launch/sick_lms_5xx.launch): name="hostname", type="string", value="192.168.0.10" [Info]: LaunchParser::parseFile(launch/sick_lms_5xx.launch): name="port", type="string", value="2112" [Info]: LaunchParser::parseFile(launch/sick_lms_5xx.launch): name="timelimit", type="int", value="5" [Info]: LaunchParser::parseFile(launch/sick_lms_5xx.launch): name="use_binary_protocol", type="bool", value="true" [Info]: LaunchParser::parseFile(launch/sick_lms_5xx.launch): name="filter_echos", type="int", value="1" [Info]: LaunchParser::parseFile(launch/sick_lms_5xx.launch): name="sw_pll_only_publish", type="bool", value="$(arg sw_pll_only_publish)" overwritten by default value "true" [Info]: LaunchParser::parseFile(launch/sick_lms_5xx.launch): name="sw_pll_only_publish", type="bool", value="true" [Info]: LaunchParser::parseFile(launch/sick_lms_5xx.launch): name="use_generation_timestamp", type="bool", value="true" [Info]: LaunchParser::parseFile(launch/sick_lms_5xx.launch): name="min_intensity", type="double", value="0.0" [Info]: LaunchParser::parseFile(launch/sick_lms_5xx.launch): name="add_transform_xyz_rpy", type="string", value="$(arg add_transform_xyz_rpy)" overwritten by default value "0,0,0,0,0,0" [Info]: LaunchParser::parseFile(launch/sick_lms_5xx.launch): name="add_transform_xyz_rpy", type="string", value="0,0,0,0,0,0" [Info]: LaunchParser::parseFile(launch/sick_lms_5xx.launch): name="add_transform_check_dynamic_updates", type="bool", value="$(arg add_transform_check_dynamic_updates)" overwritten by default value "false" [Info]: LaunchParser::parseFile(launch/sick_lms_5xx.launch): name="add_transform_check_dynamic_updates", type="bool", value="false" [Info]: LaunchParser::parseFile(launch/sick_lms_5xx.launch): name="start_services", type="bool", value="True" [Info]: LaunchParser::parseFile(launch/sick_lms_5xx.launch): name="activate_lferec", type="bool", value="True" [Info]: LaunchParser::parseFile(launch/sick_lms_5xx.launch): name="activate_lidoutputstate", type="bool", value="True" [Info]: LaunchParser::parseFile(launch/sick_lms_5xx.launch): name="activate_lidinputstate", type="bool", value="True" [Info]: LaunchParser::parseFile(launch/sick_lms_5xx.launch): name="message_monitoring_enabled", type="bool", value="True" [Info]: LaunchParser::parseFile(launch/sick_lms_5xx.launch): name="read_timeout_millisec_default", type="int", value="5000" [Info]: LaunchParser::parseFile(launch/sick_lms_5xx.launch): name="read_timeout_millisec_startup", type="int", value="120000" [Info]: LaunchParser::parseFile(launch/sick_lms_5xx.launch): name="read_timeout_millisec_kill_node", type="int", value="150000" [Info]: LaunchParser::parseFile(launch/sick_lms_5xx.launch): name="client_authorization_pw", type="string", value="F4724744" [Info]: LaunchParser::parseFile(launch/sick_lms_5xx.launch): name="ros_qos", type="int", value="-1" min_ang double -1.658062789 max_ang double 1.658062789 cloud_topic string cloud frame_id str cloud scanner_type string sick_lms_5xx range_min double 0.05 range_max double 100.0 range_filter_handling int 0 intensity bool true intensity_resolution_16bit bool false hostname string 192.168.0.10 port string 2112 timelimit int 5 use_binary_protocol bool true filter_echos int 1 sw_pll_only_publish bool true use_generation_timestamp bool true min_intensity double 0.0 add_transform_xyz_rpy string 0,0,0,0,0,0 add_transform_check_dynamic_updates bool false start_services bool True activate_lferec bool True activate_lidoutputstate bool True activate_lidinputstate bool True message_monitoring_enabled bool True read_timeout_millisec_default int 5000 read_timeout_millisec_startup int 120000 read_timeout_millisec_kill_node int 150000 client_authorization_pw string F4724744 ros_qos int -1 [Info]: Range filter configuration: range_min=0.05, range_max=100, range_filter_handling=0 ROS_INFO: Found sopas_protocol_type param overwriting default protocol: ROS_INFO: Binary protocol activated [Info]: Start initialising scanner [Ip: 192.168.0.12] [Port:2112] [Info]: Publishing on topic "/lferec", qos=10 [Info]: Publishing on topic "/lidoutputstate", qos=10 [Info]: Publishing on topic "/marker", qos=10 [Info]: SickCloudTransform: add_transform_xyz_rpy = (0,0,0,0,0,0) [Info]: SickCloudTransform: azimuth_offset = 0 [deg] [Info]: SickCloudTransform: additional 3x3 rotation matrix = { (1,0,0), (0,1,0), (0,0,1) } [Info]: SickCloudTransform: apply 3x3 rotation = false [Info]: SickCloudTransform: additional translation = (0,0,0) [Info]: SickCloudTransform: check_dynamic_updates = false [Info]: Publishing lidar pointcloud2 to cloud [Info]: Publishing on topic "/cloud", qos=10 [Info]: Publishing on topic "/imu", qos=10 [Info]: Publishing on topic "/encoder", qos=10 [Info]: Publishing on topic "/scan", qos=10 [Info]: SickCloudTransform: add_transform_xyz_rpy = (0,0,0,0,0,0) [Info]: SickCloudTransform: azimuth_offset = 0 [deg] [Info]: SickCloudTransform: additional 3x3 rotation matrix = { (1,0,0), (0,1,0), (0,0,1) } [Info]: SickCloudTransform: apply 3x3 rotation = false [Info]: SickCloudTransform: additional translation = (0,0,0) [Info]: SickCloudTransform: check_dynamic_updates = false [Info]: sick_scan_xd: Tcp::open: connecting to 192.168.0.12:2112 ... [Info]: sick_scan_xd Tcp::open: connected to 192.168.0.12:2112 [Info]: [Info]: Parameter setting for <active_echo: 0> SickThread TcpRecvThread started. [Info]: Sending :sRN SCdevicestate CRC:<0x30>
[Info]: Receiving: sRA SCdevicestate \x01
[Info]: checkColaDialect: lidar response in configured Cola-dialect Cola-B
[Info]: Sending : sMN SetAccessMode 0x03 0xf4 0x72 0x47 0x44 CRC:<0xb3>
[Info]: Receiving: sAN SetAccessMode \x01
[Info]: Sending : sWN EIHstCola 0x01 CRC:<0x09>
[Info]: Receiving: sWA EIHstCola
[Info]: Sending : sRN FirmwareVersion CRC:<0x24>
[Info]: Receiving: sRA FirmwareVersion \x00\x09\x56\x31\x2e\x38\x30\x2e\x32\x20\x20
[Info]: Sending : sRN SCdevicestate CRC:<0x30>
[Info]: Receiving: sRA SCdevicestate \x00
ROS_DEBUG: Laser is busy
[Info]: Sending : sRN ODoprh CRC:<0x41>
[Info]: Receiving: sRA ODoprh \x00\x00\x02\x36
[Info]: Sending : sRN ODpwrc CRC:<0x52>
[Info]: Receiving: sRA ODpwrc \x00\x00\x00\x29
[Info]: Sending : sRN LocationName CRC:<0x55>
[Info]: Receiving: sRA LocationName \x00\x0b\x53\x4e\x20\x31\x39\x32\x31\x30\x37\x35\x30
[Info]: Sending : sRN LMPoutputRange CRC:<0x5e>
[Info]: Receiving: sRA LMPoutputRange \x00\x01\x00\x00\x13\x88\xff\xff\x3c\xb0\x00\x1c\x3a\x90
[Info]: Angle resolution of scanner is 0.5 [deg] (in 1/10000th deg: 5000)
[Info]: [From:To] -5 [deg] to 185 [deg] (in 1/10000th deg: from -50000 to 1850000)
[Info]: MIN_ANG: -1.65806 [rad] -95 [deg]
[Info]: MAX_ANG: 1.65806 [rad] 95 [deg]
[Info]: Sending : sWN LMPoutputRange 0x00 0x01 0x00 0x00 0x13 0x88 0xff 0xff 0x3c 0xb0 0x00 0x1c 0x3a 0x90 CRC:<0xdb>
[Info]: Receiving: sWA LMPoutputRange
[Info]: Sending : sRN LMPoutputRange CRC:<0x5e>
[Info]: Receiving: sRA LMPoutputRange \x00\x01\x00\x00\x13\x88\xff\xff\x3c\xb0\x00\x1c\x3a\x90
[Info]: Angle resolution of scanner is 0.5 [deg] (in 1/10000th deg: 5000)
[Info]: MIN_ANG (after command verification): -1.65806 [rad] -95 [deg]
[Info]: MAX_ANG (after command verification): 1.65806 [rad] 95 [deg]
ROS_INFO: LMS 5xx detected overwriting output channel flag ID
ROS_INFO: LMS 5xx detected overwriting resolution flag (only 8 bit supported)
ROS_INFO: Reading safety fields
[Info]: Sending : sRN field000 CRC:<0x1d>
[Info]: Receiving: sRA field000 @\x00\x00\x00\x00\x00\x00\x00\x00\x00\x13\x88\xff\xff\x3c\xb0\x02\x00\x00\x00...
[Info]: Sending : sRN field001 CRC:<0x1c>
[Info]: Receiving: sRA field001 @\x00\x00\x00\x00\x00\x00\x00\x00\x00\x13\x88\xff\xff\x3c\xb0\x02\x00\x00\x00...
[Info]: Sending : sRN field002 CRC:<0x1f>
[Info]: Receiving: sRA field002 @\x00\x00\x00\x00\x00\x00\x00\x00\x00\x13\x88\xff\xff\x3c\xb0\x02\x00\x00\x00...
[Info]: Sending : sRN field003 CRC:<0x1e>
[Info]: Receiving: sRA field003 @\x00\x00\x00\x00\x00\x00\x00\x00\x00\x13\x88\xff\xff\x3c\xb0\x02\x00\x00\x00...
[Info]: Sending : sRN field004 CRC:<0x19>
[Info]: Receiving: sRA field004 @\x00\x00\x00\x00\x00\x00\x00\x00\x00\x13\x88\xff\xff\x3c\xb0\x02\x00\x00\x00...
[Info]: Sending : sRN field005 CRC:<0x18>
[Info]: Receiving: sRA field005 @\x00\x00\x00\x00\x00\x00\x00\x00\x00\x13\x88\xff\xff\x3c\xb0\x02\x00\x00\x00...
[Info]: Sending : sRN field006 CRC:<0x1b>
[Info]: Receiving: sRA field006 @\x00\x00\x00\x00\x00\x00\x00\x00\x00\x13\x88\xff\xff\x3c\xb0\x02\x00\x00\x00...
[Info]: Sending : sRN field007 CRC:<0x1a>
[Info]: Receiving: sRA field007 @\x00\x00\x00\x00\x00\x00\x00\x00\x00\x13\x88\xff\xff\x3c\xb0\x02\x00\x00\x00...
[Info]: Sending : sRN field008 CRC:<0x15>
[Info]: Receiving: sRA field008 @\x00\x00\x00\x00\x00\x00\x00\x00\x00\x13\x88\xff\xff\x3c\xb0\x02\x00\x00\x00...
[Info]: Sending : sRN field009 CRC:<0x14>
[Info]: Receiving: sRA field009 @\x00\x00\x00\x00\x00\x00\x00\x00\x00\x13\x88\xff\xff\x3c\xb0\x02\x00\x00\x00...
[Info]: Sending : sRN field010 CRC:<0x1c>
[Info]: Receiving: sRA field010 \x00
[Info]: Sending : sRN field011 CRC:<0x1d>
[Info]: Receiving: sRA field011 \x00
[Info]: Sending : sRN field012 CRC:<0x1e>
[Info]: Receiving: sRA field012 \x00
[Info]: Sending : sRN field013 CRC:<0x1f>
[Info]: Receiving: sRA field013 \x00
[Info]: Sending : sRN field014 CRC:<0x18>
[Info]: Receiving: sRA field014 \x00
[Info]: Sending : sRN field015 CRC:<0x19>
[Info]: Receiving: sRA field015 \x00
[Info]: Sending : sRN field016 CRC:<0x1a>
[Info]: Receiving: sRA field016 \x00
[Info]: Sending : sRN field017 CRC:<0x1b>
[Info]: Receiving: sRA field017 \x00
[Info]: Sending : sRN field018 CRC:<0x14>
[Info]: Receiving: sRA field018 \x00
[Info]: Sending : sRN field019 CRC:<0x15>
[Info]: Receiving: sRA field019 \x00
[Info]: Sending : sRN field020 CRC:<0x1f>
[Info]: Receiving: sRA field020 \x00
[Info]: Sending : sRN field021 CRC:<0x1e>
[Info]: Receiving: sRA field021 \x00
[Info]: Sending : sRN field022 CRC:<0x1d>
[Info]: Receiving: sRA field022 \x00
[Info]: Sending : sRN field023 CRC:<0x1c>
[Info]: Receiving: sRA field023 \x00
[Info]: Sending : sRN field024 CRC:<0x1b>
[Info]: Receiving: sRA field024 \x00
[Info]: Sending : sRN field025 CRC:<0x1a>
[Info]: Receiving: sRA field025 \x00
[Info]: Sending :