LORD-MicroStrain / microstrain_inertial

ROS driver for all of MicroStrain's current G and C series products. To learn more visit
https://www.microstrain.com/inertial
100 stars 76 forks source link

3DM-GQ7 ROS message [/imu/data] is not send msg:sensor_msgs/Imu [orientation] #245

Closed Seokbok closed 1 year ago

Seokbok commented 1 year ago

Describe the bug 3DM-GQ7 ROS message [/imu/data] is not send msg:sensor_msgs/Imu [orientation] Screenshot from 2023-04-11 21-15-55

I'm test changed [use_enu_frame] parameter to False and True in params.yml file

But still not show orientation data

And then I check [microstrain_inertial_driver_common/publishers.cpp]

I realize line 671 [Publishers::handleFilterAttitudeQuaternion] callback function not run frequently

I want to know 3DM-GQ7 not support send imu orientation data

Parheps, Is this code or Firmware problem?

My launch message show this

ros@ros-ThinkBook:~/catkin_ws$ roslaunch microstrain_inertial_driver microstrain.launch ... logging to /home/ros/.ros/log/4d3b462c-d85b-11ed-8a66-1fd08a5337c1/roslaunch-ros-ThinkBook-76152.log Checking log directory for disk usage. This may take a while. Press Ctrl-C to interrupt Done checking log file disk usage. Usage is <1GB.

started roslaunch server http://ros-ThinkBook:45633/

SUMMARY

PARAMETERS

NODES / microstrain_inertial_driver (microstrain_inertial_driver/microstrain_inertial_driver_node)

ROS_MASTER_URI=http://localhost:11311

process[microstrain_inertial_driver-1]: started with pid [76181] [ INFO] [1681215432.423682851]: Running microstrain_inertial_driver version: 3.0.1-3-g527e630 [ INFO] [1681215432.424719925]: Using MIP SDK version: v1.0.0-21-gb1e6278 [ INFO] [1681215432.427061285]: Attempting to open serial port </dev/ttyACM0> at <115200> [ INFO] [1681215432.428922835]: Setting device to idle in order to configure [ INFO] [1681215434.456150201]: Main Connection Info: ####################### Model Name: 3DM-GQ7 Serial Number: 6284.117809 Firmware Version: 1.0.06 ####################### [ INFO] [1681215434.457643199]: Note: Not opening aux port because RTK dongle enable was not set to true. [ INFO] [1681215434.468002272]: Note: The device does not support publishing the topic gnss1/rf_error_detection [ INFO] [1681215434.468036145]: Note: The device does not support publishing the topic gnss1/sbas_info [ INFO] [1681215434.468056678]: Note: The device does not support publishing the topic gnss2/rf_error_detection [ INFO] [1681215434.468071415]: Note: The device does not support publishing the topic gnss2/sbas_info [ INFO] [1681215434.468087199]: Note: The device does not support publishing the topic imu/overrange_status [ INFO] [1681215434.468105846]: Note: The device does not support publishing the topic nav/heading_state [ WARN] [1681215434.516008954]: Requested data rate 1.00000 for descriptor set 0x93 is higher than the max data rate 0. Using max data rate instead [ WARN] [1681215434.516732789]: Requested data rate 1.00000 for descriptor set 0x93 is higher than the max data rate 0. Using max data rate instead [ INFO] [1681215434.585909630]: Note: Not configuring GPIO [ INFO] [1681215434.585991484]: Setting PPS source to 0x0001 [ INFO] [1681215434.587945294]: Setting hardware odometer to: mode = 0, scaling = 0.000000, uncertainty = 0.000000 [ INFO] [1681215434.593952555]: Not configuring factory streaming channels [ INFO] [1681215434.593982657]: Note: The device does not support the SBAS settings command [ INFO] [1681215434.594004168]: Note: The device does not support the nmea message format command [ INFO] [1681215434.594028053]: Setting RTK dongle enable to 0 [ INFO] [1681215434.613393163]: Setting Declination Source to 2 0.230000 [ INFO] [1681215434.617944931]: Setting GNSS1 antenna offset to [0.000000, -0.700000, -1.000000] [ INFO] [1681215434.623948420]: Setting GNSS2 antenna offset to [0.000000, 0.700000, -1.000000] [ INFO] [1681215434.629942970]: Note: The device does not support the vehicle dynamics mode command. [ INFO] [1681215434.629969300]: Note: The device does not support the heading source command. [ INFO] [1681215434.629990462]: Note: The device does not support the filter autoinitialization command. [ INFO] [1681215434.630014627]: Setting autoadaptive options to: level = 2, time_limit = 15000 [ INFO] [1681215434.641970551]: Filter aiding gnss pos/vel = 1 [ INFO] [1681215434.647939679]: Filter aiding gnss heading = 1 [ INFO] [1681215434.653929968]: Filter aiding altimeter = 0 [ INFO] [1681215434.659935343]: Filter aiding odometer = 0 [ INFO] [1681215434.665937226]: Filter aiding magnetometer = 0 [ INFO] [1681215434.671928702]: Filter aiding external heading = 0 [ INFO] [1681215434.671954544]: Note: Not configuring filter relative position [ INFO] [1681215434.671976683]: Setting speed lever arm to: [0.000000, 0.000000, 0.000000] [ INFO] [1681215434.677941271]: Setting wheeled vehicle contraint enable to 0 [ INFO] [1681215434.683947903]: Setting vertical gyro contraint enable to 0 [ INFO] [1681215434.689929672]: Setting GNSS antenna calibration control to: enable = 1, offset = 0.100000 [ INFO] [1681215434.695944335]: Setting filter initialization configuration to: [ INFO] [1681215434.695972901]: auto init = 1 [ INFO] [1681215434.695994342]: initial condition source = 0 [ INFO] [1681215434.696017669]: auto heading alignment selector = 1 [ INFO] [1681215434.696041694]: initial attitude = [0.000000, 0.000000, 0.000000] [ INFO] [1681215434.696061250]: initial position = [0.000000, 0.000000, 0.000000] [ INFO] [1681215434.696086113]: initial velocity = [0.000000, 0.000000, 0.000000] [ INFO] [1681215434.696108044]: reference frame selector = 2 [ INFO] [1681215434.701952783]: Setting sensor to vehicle transformation euler to [0.000000, 0.000000, 0.000000] [ INFO] [1681215434.707940069]: Note: The device does not support the reference point lever arm command [ INFO] [1681215434.707971079]: Note: The settings were not saved as startup settings. Power cycling will remove changes from device [ INFO] [1681215434.707993079]: Resetting the filter after the configuration is complete. [ INFO] [1681215434.733515538]: Setting spin rate to <200.000000> hz [ INFO] [1681215434.733552834]: Resuming the device data streams [ INFO] [1681215434.738049846]: Starting Data Parsing

Environment (please complete the following information):

Seokbok commented 1 year ago

never mind i just update firmware new version and orientation receive normally Screenshot from 2023-04-12 00-41-49 Screenshot from 2023-04-12 00-41-28