Skip to content
New issue

Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.

By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.

Already on GitHub? Sign in to your account

Issue with active camera on LoCoBot #32

Closed
bhyang opened this issue Oct 2, 2019 · 4 comments
Closed

Issue with active camera on LoCoBot #32

bhyang opened this issue Oct 2, 2019 · 4 comments

Comments

@bhyang
Copy link

bhyang commented Oct 2, 2019

Steps to reproduce

I built the LoCoBot with active camera, but I can't get the active camera working. Only hardware difference is that I'm running everything on a NVIDIA Jetson instead of a NUC.

  1. Run roslaunch locobot_control main.launch use_camera:=true use_arm:=true

Observed Results

Here's what I get when I run the above command

(pyenv_pyrobot) nvidia@tegra-ubuntu:~/low_cost_ws/src/pyrobot/robots/LoCoBot/locobot_control/launch$ roslaunch locobot_control main.launch use_arm:=true use_cam
era:=true
... logging to /home/nvidia/.ros/log/b2cd9c3a-dfe2-11e9-a017-00044bc76af9/roslaunch-tegra-ubuntu-7183.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://tegra-ubuntu:44271/

SUMMARY
========

PARAMETERS
 * /camera/realsense2_camera/accel_fps: 250
 * /camera/realsense2_camera/accel_frame_id: camera_accel_frame
 * /camera/realsense2_camera/accel_optical_frame_id: camera_accel_opti...
 * /camera/realsense2_camera/align_depth: True
 * /camera/realsense2_camera/aligned_depth_to_color_frame_id: camera_aligned_de...
 * /camera/realsense2_camera/aligned_depth_to_fisheye1_frame_id: camera_aligned_de...
 * /camera/realsense2_camera/aligned_depth_to_fisheye2_frame_id: camera_aligned_de...
 * /camera/realsense2_camera/aligned_depth_to_fisheye_frame_id: camera_aligned_de...
 * /camera/realsense2_camera/aligned_depth_to_infra1_frame_id: camera_aligned_de...
 * /camera/realsense2_camera/aligned_depth_to_infra2_frame_id: camera_aligned_de...
 * /camera/realsense2_camera/allow_no_texture_points: False
 * /camera/realsense2_camera/base_frame_id: camera_link
 * /camera/realsense2_camera/calib_odom_file: 
 * /camera/realsense2_camera/clip_distance: -1.0
 * /camera/realsense2_camera/color_fps: 30
 * /camera/realsense2_camera/color_frame_id: camera_color_frame
 * /camera/realsense2_camera/color_height: 480
 * /camera/realsense2_camera/color_optical_frame_id: camera_color_opti...
 * /camera/realsense2_camera/color_width: 640
 * /camera/realsense2_camera/depth_fps: 30
 * /camera/realsense2_camera/depth_frame_id: camera_depth_frame
 * /camera/realsense2_camera/depth_height: 480
 * /camera/realsense2_camera/depth_optical_frame_id: camera_depth_opti...
 * /camera/realsense2_camera/depth_width: 640
 * /camera/realsense2_camera/enable_accel: True
 * /camera/realsense2_camera/enable_color: True
 * /camera/realsense2_camera/enable_depth: True
 * /camera/realsense2_camera/enable_fisheye1: True
 * /camera/realsense2_camera/enable_fisheye2: True
 * /camera/realsense2_camera/enable_fisheye: True
 * /camera/realsense2_camera/enable_gyro: True
 * /camera/realsense2_camera/enable_infra1: True
 * /camera/realsense2_camera/enable_infra2: True
 * /camera/realsense2_camera/enable_pointcloud: False
 * /camera/realsense2_camera/enable_sync: True
 * /camera/realsense2_camera/filters: 
 * /camera/realsense2_camera/fisheye1_frame_id: camera_fisheye1_f...
 * /camera/realsense2_camera/fisheye1_optical_frame_id: camera_fisheye1_o...
 * /camera/realsense2_camera/fisheye2_frame_id: camera_fisheye2_f...
 * /camera/realsense2_camera/fisheye2_optical_frame_id: camera_fisheye2_o...
 * /camera/realsense2_camera/fisheye_fps: 30
 * /camera/realsense2_camera/fisheye_frame_id: camera_fisheye_frame
 * /camera/realsense2_camera/fisheye_height: 480
 * /camera/realsense2_camera/fisheye_optical_frame_id: camera_fisheye_op...
 * /camera/realsense2_camera/fisheye_width: 640
 * /camera/realsense2_camera/gyro_fps: 400
 * /camera/realsense2_camera/gyro_frame_id: camera_gyro_frame
 * /camera/realsense2_camera/gyro_optical_frame_id: camera_gyro_optic...
 * /camera/realsense2_camera/imu_optical_frame_id: camera_imu_optica...
 * /camera/realsense2_camera/infra1_frame_id: camera_infra1_frame
 * /camera/realsense2_camera/infra1_optical_frame_id: camera_infra1_opt...
 * /camera/realsense2_camera/infra2_frame_id: camera_infra2_frame
 * /camera/realsense2_camera/infra2_optical_frame_id: camera_infra2_opt...
 * /camera/realsense2_camera/infra_fps: 30
 * /camera/realsense2_camera/infra_height: 480
 * /camera/realsense2_camera/infra_width: 640
 * /camera/realsense2_camera/initial_reset: False
 * /camera/realsense2_camera/json_file_path: 
 * /camera/realsense2_camera/linear_accel_cov: 0.01
 * /camera/realsense2_camera/odom_frame_id: camera_odom_frame
 * /camera/realsense2_camera/pointcloud_texture_index: 0
 * /camera/realsense2_camera/pointcloud_texture_stream: RS2_STREAM_COLOR
 * /camera/realsense2_camera/pose_frame_id: camera_pose_frame
 * /camera/realsense2_camera/pose_optical_frame_id: camera_pose_optic...
 * /camera/realsense2_camera/publish_odom_tf: True
 * /camera/realsense2_camera/rosbag_filename: 
 * /camera/realsense2_camera/serial_no: 
 * /camera/realsense2_camera/topic_odom_in: camera/odom_in
 * /camera/realsense2_camera/unite_imu_method: none
 * /dynamixel_info: /home/nvidia/low_...
 * /locobot_controller/dxl_read_period: 0.01
 * /locobot_controller/dxl_write_period: 0.01
 * /locobot_controller/publish_period: 0.01
 * /move_group/allow_trajectory_execution: True
 * /move_group/arm/default_planner_config: ESTkConfigDefault
 * /move_group/arm/longest_valid_segment_fraction: 0.005
 * /move_group/arm/planner_configs: ['SBLkConfigDefau...
 * /move_group/arm/projection_evaluator: joints(joint_1,jo...
 * /move_group/capabilities: 
 * /move_group/controller_list: [{'default': True...
 * /move_group/disable_capabilities: 
 * /move_group/gripper/default_planner_config: ESTkConfigDefault
 * /move_group/gripper/longest_valid_segment_fraction: 0.005
 * /move_group/gripper/planner_configs: ['SBLkConfigDefau...
 * /move_group/gripper/projection_evaluator: joints(joint_6,jo...
 * /move_group/jiggle_fraction: 0.05
 * /move_group/max_range: 5.0
 * /move_group/max_safe_path_cost: 1
 * /move_group/moveit_controller_manager: moveit_simple_con...
 * /move_group/moveit_manage_controllers: True
 * /move_group/octomap_resolution: 0.025
 * /move_group/planner_configs/BFMTkConfigDefault/balanced: 0
 * /move_group/planner_configs/BFMTkConfigDefault/cache_cc: 1
 * /move_group/planner_configs/BFMTkConfigDefault/extended_fmt: 1
 * /move_group/planner_configs/BFMTkConfigDefault/heuristics: 1
 * /move_group/planner_configs/BFMTkConfigDefault/nearest_k: 1
 * /move_group/planner_configs/BFMTkConfigDefault/num_samples: 1000
 * /move_group/planner_configs/BFMTkConfigDefault/optimality: 1
 * /move_group/planner_configs/BFMTkConfigDefault/radius_multiplier: 1.0
 * /move_group/planner_configs/BFMTkConfigDefault/type: geometric::BFMT
 * /move_group/planner_configs/BKPIECEkConfigDefault/border_fraction: 0.9
 * /move_group/planner_configs/BKPIECEkConfigDefault/failed_expansion_score_factor: 0.5
 * /move_group/planner_configs/BKPIECEkConfigDefault/min_valid_path_fraction: 0.5
 * /move_group/planner_configs/BKPIECEkConfigDefault/range: 0.0
 * /move_group/planner_configs/BKPIECEkConfigDefault/type: geometric::BKPIECE
 * /move_group/planner_configs/BiESTkConfigDefault/range: 0.0
 * /move_group/planner_configs/BiESTkConfigDefault/type: geometric::BiEST
 * /move_group/planner_configs/BiTRRTkConfigDefault/cost_threshold: 1e300
 * /move_group/planner_configs/BiTRRTkConfigDefault/frountier_node_ratio: 0.1
 * /move_group/planner_configs/BiTRRTkConfigDefault/frountier_threshold: 0.0
 * /move_group/planner_configs/BiTRRTkConfigDefault/init_temperature: 100
 * /move_group/planner_configs/BiTRRTkConfigDefault/range: 0.0
 * /move_group/planner_configs/BiTRRTkConfigDefault/temp_change_factor: 0.1
 * /move_group/planner_configs/BiTRRTkConfigDefault/type: geometric::BiTRRT
 * /move_group/planner_configs/ESTkConfigDefault/goal_bias: 0.05
 * /move_group/planner_configs/ESTkConfigDefault/range: 0.0
 * /move_group/planner_configs/ESTkConfigDefault/type: geometric::EST
 * /move_group/planner_configs/FMTkConfigDefault/cache_cc: 1
 * /move_group/planner_configs/FMTkConfigDefault/extended_fmt: 1
 * /move_group/planner_configs/FMTkConfigDefault/heuristics: 0
 * /move_group/planner_configs/FMTkConfigDefault/nearest_k: 1
 * /move_group/planner_configs/FMTkConfigDefault/num_samples: 1000
 * /move_group/planner_configs/FMTkConfigDefault/radius_multiplier: 1.1
 * /move_group/planner_configs/FMTkConfigDefault/type: geometric::FMT
 * /move_group/planner_configs/KPIECEkConfigDefault/border_fraction: 0.9
 * /move_group/planner_configs/KPIECEkConfigDefault/failed_expansion_score_factor: 0.5
 * /move_group/planner_configs/KPIECEkConfigDefault/goal_bias: 0.05
 * /move_group/planner_configs/KPIECEkConfigDefault/min_valid_path_fraction: 0.5
 * /move_group/planner_configs/KPIECEkConfigDefault/range: 0.0
 * /move_group/planner_configs/KPIECEkConfigDefault/type: geometric::KPIECE
 * /move_group/planner_configs/LBKPIECEkConfigDefault/border_fraction: 0.9
 * /move_group/planner_configs/LBKPIECEkConfigDefault/min_valid_path_fraction: 0.5
 * /move_group/planner_configs/LBKPIECEkConfigDefault/range: 0.0
 * /move_group/planner_configs/LBKPIECEkConfigDefault/type: geometric::LBKPIECE
 * /move_group/planner_configs/LBTRRTkConfigDefault/epsilon: 0.4
 * /move_group/planner_configs/LBTRRTkConfigDefault/goal_bias: 0.05
 * /move_group/planner_configs/LBTRRTkConfigDefault/range: 0.0
 * /move_group/planner_configs/LBTRRTkConfigDefault/type: geometric::LBTRRT
 * /move_group/planner_configs/LazyPRMkConfigDefault/range: 0.0
 * /move_group/planner_configs/LazyPRMkConfigDefault/type: geometric::LazyPRM
 * /move_group/planner_configs/LazyPRMstarkConfigDefault/type: geometric::LazyPR...
 * /move_group/planner_configs/PDSTkConfigDefault/type: geometric::PDST
 * /move_group/planner_configs/PRMkConfigDefault/max_nearest_neighbors: 10
 * /move_group/planner_configs/PRMkConfigDefault/type: geometric::PRM
 * /move_group/planner_configs/PRMstarkConfigDefault/type: geometric::PRMstar
 * /move_group/planner_configs/ProjESTkConfigDefault/goal_bias: 0.05
 * /move_group/planner_configs/ProjESTkConfigDefault/range: 0.0
 * /move_group/planner_configs/ProjESTkConfigDefault/type: geometric::ProjEST
 * /move_group/planner_configs/RRTConnectkConfigDefault/range: 0.0
 * /move_group/planner_configs/RRTConnectkConfigDefault/type: geometric::RRTCon...
 * /move_group/planner_configs/RRTkConfigDefault/goal_bias: 0.05
 * /move_group/planner_configs/RRTkConfigDefault/range: 0.0
 * /move_group/planner_configs/RRTkConfigDefault/type: geometric::RRT
 * /move_group/planner_configs/RRTstarkConfigDefault/delay_collision_checking: 1
 * /move_group/planner_configs/RRTstarkConfigDefault/goal_bias: 0.05
 * /move_group/planner_configs/RRTstarkConfigDefault/range: 0.0
 * /move_group/planner_configs/RRTstarkConfigDefault/type: geometric::RRTstar
 * /move_group/planner_configs/SBLkConfigDefault/range: 0.0
 * /move_group/planner_configs/SBLkConfigDefault/type: geometric::SBL
 * /move_group/planner_configs/SPARSkConfigDefault/dense_delta_fraction: 0.001
 * /move_group/planner_configs/SPARSkConfigDefault/max_failures: 1000
 * /move_group/planner_configs/SPARSkConfigDefault/sparse_delta_fraction: 0.25
 * /move_group/planner_configs/SPARSkConfigDefault/stretch_factor: 3.0
 * /move_group/planner_configs/SPARSkConfigDefault/type: geometric::SPARS
 * /move_group/planner_configs/SPARStwokConfigDefault/dense_delta_fraction: 0.001
 * /move_group/planner_configs/SPARStwokConfigDefault/max_failures: 5000
 * /move_group/planner_configs/SPARStwokConfigDefault/sparse_delta_fraction: 0.25
 * /move_group/planner_configs/SPARStwokConfigDefault/stretch_factor: 3.0
 * /move_group/planner_configs/SPARStwokConfigDefault/type: geometric::SPARStwo
 * /move_group/planner_configs/STRIDEkConfigDefault/degree: 16
 * /move_group/planner_configs/STRIDEkConfigDefault/estimated_dimension: 0.0
 * /move_group/planner_configs/STRIDEkConfigDefault/goal_bias: 0.05
 * /move_group/planner_configs/STRIDEkConfigDefault/max_degree: 18
 * /move_group/planner_configs/STRIDEkConfigDefault/max_pts_per_leaf: 6
 * /move_group/planner_configs/STRIDEkConfigDefault/min_degree: 12
 * /move_group/planner_configs/STRIDEkConfigDefault/min_valid_path_fraction: 0.2
 * /move_group/planner_configs/STRIDEkConfigDefault/range: 0.0
 * /move_group/planner_configs/STRIDEkConfigDefault/type: geometric::STRIDE
 * /move_group/planner_configs/STRIDEkConfigDefault/use_projected_distance: 0
 * /move_group/planner_configs/TRRTkConfigDefault/frountierNodeRatio: 0.1
 * /move_group/planner_configs/TRRTkConfigDefault/frountier_threshold: 0.0
 * /move_group/planner_configs/TRRTkConfigDefault/goal_bias: 0.05
 * /move_group/planner_configs/TRRTkConfigDefault/init_temperature: 10e-6
 * /move_group/planner_configs/TRRTkConfigDefault/k_constant: 0.0
 * /move_group/planner_configs/TRRTkConfigDefault/max_states_failed: 10
 * /move_group/planner_configs/TRRTkConfigDefault/min_temperature: 10e-10
 * /move_group/planner_configs/TRRTkConfigDefault/range: 0.0
 * /move_group/planner_configs/TRRTkConfigDefault/temp_change_factor: 2.0
 * /move_group/planner_configs/TRRTkConfigDefault/type: geometric::TRRT
 * /move_group/planning_plugin: ompl_interface/OM...
 * /move_group/planning_scene_monitor/publish_geometry_updates: True
 * /move_group/planning_scene_monitor/publish_planning_scene: True
 * /move_group/planning_scene_monitor/publish_state_updates: True
 * /move_group/planning_scene_monitor/publish_transforms_updates: True
 * /move_group/request_adapters: default_planner_r...
 * /move_group/sensors: [{'point_subsampl...
 * /move_group/start_state_max_bounds_error: 0.1
 * /move_group/trajectory_execution/allowed_execution_duration_scaling: 1.2
 * /move_group/trajectory_execution/allowed_goal_duration_margin: 0.5
 * /move_group/trajectory_execution/allowed_start_tolerance: 0.0
 * /robot_description: <?xml version="1....
 * /robot_description_kinematics/arm/kinematics_solver: trac_ik_kinematic...
 * /robot_description_kinematics/arm/kinematics_solver_attempts: 3
 * /robot_description_kinematics/arm/kinematics_solver_search_resolution: 0.005
 * /robot_description_kinematics/arm/kinematics_solver_timeout: 0.005
 * /robot_description_planning/joint_limits/joint_1/has_acceleration_limits: False
 * /robot_description_planning/joint_limits/joint_1/has_velocity_limits: True
 * /robot_description_planning/joint_limits/joint_1/max_acceleration: 0
 * /robot_description_planning/joint_limits/joint_1/max_velocity: 1
 * /robot_description_planning/joint_limits/joint_2/has_acceleration_limits: False
 * /robot_description_planning/joint_limits/joint_2/has_velocity_limits: True
 * /robot_description_planning/joint_limits/joint_2/max_acceleration: 0
 * /robot_description_planning/joint_limits/joint_2/max_velocity: 1
 * /robot_description_planning/joint_limits/joint_3/has_acceleration_limits: False
 * /robot_description_planning/joint_limits/joint_3/has_velocity_limits: True
 * /robot_description_planning/joint_limits/joint_3/max_acceleration: 0
 * /robot_description_planning/joint_limits/joint_3/max_velocity: 1
 * /robot_description_planning/joint_limits/joint_4/has_acceleration_limits: False
 * /robot_description_planning/joint_limits/joint_4/has_velocity_limits: True
 * /robot_description_planning/joint_limits/joint_4/max_acceleration: 0
 * /robot_description_planning/joint_limits/joint_4/max_velocity: 1
 * /robot_description_planning/joint_limits/joint_5/has_acceleration_limits: False
 * /robot_description_planning/joint_limits/joint_5/has_velocity_limits: True
 * /robot_description_planning/joint_limits/joint_5/max_acceleration: 0
 * /robot_description_planning/joint_limits/joint_5/max_velocity: 1
 * /robot_description_planning/joint_limits/joint_6/has_acceleration_limits: False
 * /robot_description_planning/joint_limits/joint_6/has_velocity_limits: True
 * /robot_description_planning/joint_limits/joint_6/max_acceleration: 0
 * /robot_description_planning/joint_limits/joint_6/max_velocity: 1
 * /robot_description_planning/joint_limits/joint_7/has_acceleration_limits: False
 * /robot_description_planning/joint_limits/joint_7/has_velocity_limits: True
 * /robot_description_planning/joint_limits/joint_7/max_acceleration: 0
 * /robot_description_planning/joint_limits/joint_7/max_velocity: 1
 * /robot_description_semantic: <?xml version="1....
 * /rosdistro: kinetic
 * /rosversion: 1.12.14
 * /rviz_tegra_ubuntu_7183_8673672763949283869/arm/kinematics_solver: trac_ik_kinematic...
 * /rviz_tegra_ubuntu_7183_8673672763949283869/arm/kinematics_solver_attempts: 3
 * /rviz_tegra_ubuntu_7183_8673672763949283869/arm/kinematics_solver_search_resolution: 0.005
 * /rviz_tegra_ubuntu_7183_8673672763949283869/arm/kinematics_solver_timeout: 0.005
 * /teleop: False
 * /torque_control: False
 * /use_arm: True
 * /use_base: False
 * /use_camera: True
 * /use_sim: False
 * /use_vslam: False

NODES
  /camera/
    color_rectify_color (nodelet/nodelet)
    points_xyzrgb_hw_registered (nodelet/nodelet)
    realsense2_camera (nodelet/nodelet)
    realsense2_camera_manager (nodelet/nodelet)
  /
    calibration_tf_broadcaster (locobot_calibration/calibration_publish_transforms.py)
    locobot_controller (locobot_control/locobot_controller)
    move_group (moveit_ros_move_group/move_group)
    robot_state_publisher (robot_state_publisher/robot_state_publisher)
    rviz_tegra_ubuntu_7183_8673672763949283869 (rviz/rviz)

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

setting /run_id to b2cd9c3a-dfe2-11e9-a017-00044bc76af9
process[rosout-1]: started with pid [7254]
started core service [/rosout]
process[camera/realsense2_camera_manager-2]: started with pid [7274]
process[camera/realsense2_camera-3]: started with pid [7275]
process[camera/color_rectify_color-4]: started with pid [7276]
process[camera/points_xyzrgb_hw_registered-5]: started with pid [7282]
process[locobot_controller-6]: started with pid [7290]
process[calibration_tf_broadcaster-7]: started with pid [7303]
process[robot_state_publisher-8]: started with pid [7308]
process[move_group-9]: started with pid [7313]
process[rviz_tegra_ubuntu_7183_8673672763949283869-10]: started with pid [7332]
[ INFO] [1569450041.221104224]: Initializing nodelet with 4 worker threads.
[ INFO] [1569450041.408023968]: Loading group arm from yaml file
[ INFO] [1569450041.410513568]: Loading group camera from yaml file
[ INFO] [1569450041.413155520]: Loading group gripper from yaml file
[ INFO] [1569450041.450104800]: Name : gripperMotor, ID : 7, Model Number : 1060
[ INFO] [1569450041.485689472]: Name : head_pan_joint, ID : 8, Model Number : 1060
[ INFO] [1569450041.521691136]: Name : head_tilt_joint, ID : 9, Model Number : 1060
[ INFO] [1569450041.545686432]: Loading robot model 'locobot'...
[ INFO] [1569450041.545950592]: No root/virtual joint specified in SRDF. Assuming fixed joint
[ INFO] [1569450041.557929600]: Name : joint2Dual, ID : 3, Model Number : 1020
[ INFO] [1569450041.584188160]: RealSense ROS v2.2.8
[ INFO] [1569450041.588961312]: Running with LibRealSense v2.25.0
[ INFO] [1569450041.593822368]: Name : joint_1, ID : 1, Model Number : 1020
[ INFO] [1569450041.633947936]: Name : joint_2, ID : 2, Model Number : 1020
[ INFO] [1569450041.669691584]: Name : joint_3, ID : 4, Model Number : 1020
[ INFO] [1569450041.705200640]: Name : joint_4, ID : 5, Model Number : 1020
[ INFO] [1569450041.740668928]: Name : joint_5, ID : 6, Model Number : 1060
[ INFO] [1569450041.907295456]: rviz version 1.12.17
[ INFO] [1569450041.907853696]: compiled against Qt version 5.5.1
[ INFO] [1569450041.908491552]: compiled against OGRE version 1.9.0 (Ghadamon)
[ INFO] [1569450042.261974912]: getParameters...
[ INFO] [1569450042.538745600]: [DynamixelDriver] Succeeded to add sync write handler
[ INFO] [1569450042.538874304]: [DynamixelDriver] Succeeded to add sync write handler
[ INFO] [1569450043.195162112]: IK Using joint shoulder_link -1.57 1.57
[ INFO] [1569450043.195871872]: IK Using joint elbow_link -1.57 1.57
[ INFO] [1569450043.196275552]: IK Using joint forearm_link -1.57 1.57
[ INFO] [1569450043.196597760]: IK Using joint wrist_link -1.57 1.57
[ INFO] [1569450043.196928992]: IK Using joint gripper_link -1.57 1.57
[ INFO] [1569450043.197243168]: Looking in common namespaces for param name: arm/position_only_ik
[ERROR] [1569450043.229907232]: [TxRxResult] Incorrect status packet!
[ERROR] [1569450043.230040608]: groupSyncRead getdata failed
[ERROR] [1569450043.230078112]: groupSyncRead getdata failed
[ERROR] [1569450043.230110720]: groupSyncRead getdata failed
[ INFO] [1569450043.254802240]: Looking in common namespaces for param name: arm/solve_type
[ERROR] [1569450043.265862080]: [TxRxResult] Incorrect status packet!
[ERROR] [1569450043.265980288]: groupSyncRead getdata failed
[ERROR] [1569450043.266053024]: Motor joint_3 ID=4 has Hardware_Error_Status byte -1006254512
[ERROR] [1569450043.266100576]: Motor joint_3 ID=4 has Electrical Shock error
[ERROR] [1569450043.266158336]: Motor joint_1 ID=1 has Hardware_Error_Status byte 127
[ERROR] [1569450043.266199744]: Motor joint_1 ID=1 has Overload error
[ERROR] [1569450043.266236256]: Motor joint_1 ID=1 has Electrical Shock error
[ERROR] [1569450043.266273696]: Motor joint_1 ID=1 has Motor Encoder error
[ERROR] [1569450043.266318848]: Motor joint_1 ID=1 has Overheating error
[ERROR] [1569450043.266358784]: Motor joint_1 ID=1 has Input Volatage error
[ERROR] [1569450043.266399200]: Motor joint_2 ID=2 has Hardware_Error_Status byte -1006254512
[ERROR] [1569450043.266433248]: Motor joint_2 ID=2 has Electrical Shock error
[ERROR] [1569450043.266477792]: Motor joint2Dual ID=3 has Hardware_Error_Status byte 127
[ERROR] [1569450043.268573440]: Motor joint2Dual ID=3 has Overload error
[ERROR] [1569450043.269397440]: Motor joint2Dual ID=3 has Electrical Shock error
[ERROR] [1569450043.269856832]: Motor joint2Dual ID=3 has Motor Encoder error
[ERROR] [1569450043.270020128]: Motor joint2Dual ID=3 has Overheating error
[ERROR] [1569450043.270068768]: Motor joint2Dual ID=3 has Input Volatage error
[ERROR] [1569450043.270121632]: Motor head_pan_joint ID=8 has Hardware_Error_Status byte -1006254488
[ERROR] [1569450043.270160960]: Motor head_pan_joint ID=8 has Overload error
[ERROR] [1569450043.270194752]: Motor head_pan_joint ID=8 has Motor Encoder error
[ERROR] [1569450043.270948352]: Motor head_tilt_joint ID=9 has Hardware_Error_Status byte 127
[ERROR] [1569450043.271036224]: Motor head_tilt_joint ID=9 has Overload error
[ERROR] [1569450043.271370112]: Motor head_tilt_joint ID=9 has Electrical Shock error
[ERROR] [1569450043.271523040]: Motor head_tilt_joint ID=9 has Motor Encoder error
[ERROR] [1569450043.275550080]: Motor head_tilt_joint ID=9 has Overheating error
[ERROR] [1569450043.275596480]: Motor head_tilt_joint ID=9 has Input Volatage error
[ERROR] [1569450043.275646784]: Motor gripperMotor ID=7 has Hardware_Error_Status byte -1006254488
[ERROR] [1569450043.275691072]: Motor gripperMotor ID=7 has Overload error
[ERROR] [1569450043.275726496]: Motor gripperMotor ID=7 has Motor Encoder error
Going to rest joint... 
[ INFO] [1569450043.343118720]: Using solve type Speed
[ INFO] [1569450043.436528192]: setupDevice...
[ INFO] [1569450043.436664576]: JSON file is not provided
[ INFO] [1569450043.436998560]: ROS Node Namespace: camera
[ INFO] [1569450043.437140864]: Device Name: Intel RealSense D435
[ INFO] [1569450043.437204768]: Device Serial No: 829212071014
[ INFO] [1569450043.437255776]: Device FW version: 05.09.02.00
[ INFO] [1569450043.437301952]: Device Product ID: 0x0B07
[ INFO] [1569450043.437348832]: Enable PointCloud: Off
[ INFO] [1569450043.437391392]: Align Depth: On
[ INFO] [1569450043.437444096]: Sync Mode: On
[ INFO] [1569450043.437623744]: Device Sensors: 
[ INFO] [1569450043.437772768]: Stereo Module was found.
[ INFO] [1569450043.437930784]: RGB Camera was found.
[ INFO] [1569450043.438075680]: (Fisheye, 0) sensor isn't supported by current device! -- Skipping...
[ INFO] [1569450043.438162816]: (Fisheye, 1) sensor isn't supported by current device! -- Skipping...
[ INFO] [1569450043.438206336]: (Fisheye, 2) sensor isn't supported by current device! -- Skipping...
[ INFO] [1569450043.438244704]: (Gyro, 0) sensor isn't supported by current device! -- Skipping...
[ INFO] [1569450043.438294240]: (Accel, 0) sensor isn't supported by current device! -- Skipping...
[ INFO] [1569450043.438340256]: (Pose, 0) sensor isn't supported by current device! -- Skipping...
[ INFO] [1569450043.438422976]: num_filters: 0
[ INFO] [1569450043.438466848]: Setting Dynamic reconfig parameters.
[ INFO] [1569450043.789677376]: Stereo is NOT SUPPORTED
[ INFO] [1569450043.790236160]: OpenGl version: 4.6 (GLSL 4.6).
[ INFO] [1569450044.178717120]: Done Setting Dynamic reconfig parameters.
[ INFO] [1569450044.186997728]: depth stream is enabled - width: 640, height: 480, fps: 30
[ INFO] [1569450044.187581792]: infra1 stream is enabled - width: 640, height: 480, fps: 30
[ INFO] [1569450044.188037696]: infra2 stream is enabled - width: 640, height: 480, fps: 30
[ INFO] [1569450044.197814816]: color stream is enabled - width: 640, height: 480, fps: 30
[ INFO] [1569450044.201684096]: setupPublishers...
[ INFO] [1569450044.222812160]: Expected frequency for depth = 30.00000
[ERROR] [1569450044.255417]: Using default camera calibration
[ERROR] [1569450044.256150]: For better performance, calibrate your system.
[WARN] [1569450044.258029]: Will publish: 
[WARN] [1569450044.258647]:   head_tilt_link to camera_link
[ INFO] [1569450044.843222592]: Expected frequency for infra1 = 30.00000
[ INFO] [1569450045.035035072]: Expected frequency for aligned_depth_to_infra1 = 30.00000
[ INFO] [1569450045.287203936]: Expected frequency for infra2 = 30.00000
[ INFO] [1569450045.501397888]: Expected frequency for color = 30.00000
[ INFO] [1569450045.695081344]: Expected frequency for aligned_depth_to_color = 30.00000
[ INFO] [1569450045.807873984]: Publishing maintained planning scene on 'monitored_planning_scene'
[ INFO] [1569450045.829554720]: MoveGroup debug mode is ON
Starting context monitors...
[ INFO] [1569450045.829664256]: Starting scene monitor
[ INFO] [1569450045.854556192]: Listening to '/planning_scene'
[ INFO] [1569450045.854648608]: Starting world geometry monitor
[ INFO] [1569450045.876228864]: Listening to '/collision_object' using message notifier with target frame '/base_footprint '
[ INFO] [1569450045.901249088]: Listening to '/planning_scene_world' for planning scene world geometry
[ INFO] [1569450045.908830560]: setupStreams...
[ INFO] [1569450045.967947808]: insert Depth to Stereo Module
[ INFO] [1569450045.968138464]: insert Color to RGB Camera
[ INFO] [1569450045.968227392]: insert Infrared to Stereo Module
[ INFO] [1569450045.968298400]: insert Infrared to Stereo Module
[ INFO] [1569450046.108236192]: SELECTED BASE:Depth, 0
[ INFO] [1569450046.200474496]: RealSense Node Is Up!
 25/09 15:20:46,425 WARNING [547295695248] (types.cpp:48) Region-of-interest is not implemented for this device!
[ERROR] [1569450046.425551328]: Region-of-interest is not implemented for this device!
[ INFO] [1569450048.332653696]: Loading robot model 'locobot'...
[ INFO] [1569450048.332863904]: No root/virtual joint specified in SRDF. Assuming fixed joint
[ INFO] [1569450050.083233440]: IK Using joint shoulder_link -1.57 1.57
[ INFO] [1569450050.083374784]: IK Using joint elbow_link -1.57 1.57
[ INFO] [1569450050.083432448]: IK Using joint forearm_link -1.57 1.57
[ INFO] [1569450050.083473792]: IK Using joint wrist_link -1.57 1.57
[ INFO] [1569450050.083522976]: IK Using joint gripper_link -1.57 1.57
[ INFO] [1569450050.085008416]: Looking in common namespaces for param name: arm/position_only_ik
[ INFO] [1569450050.154725280]: Looking in common namespaces for param name: arm/solve_type
[ INFO] [1569450050.219498016]: Using solve type Speed
================================================================================REQUIRED process [locobot_controller-6] has died!
process has finished cleanly
log file: /home/nvidia/.ros/log/b2cd9c3a-dfe2-11e9-a017-00044bc76af9/locobot_controller-6*.log
Initiating shutdown!
================================================================================
[rviz_tegra_ubuntu_7183_8673672763949283869-10] killing on exit
[move_group-9] killing on exit
[robot_state_publisher-8] killing on exit
[locobot_controller-6] killing on exit
[camera/realsense2_camera_manager-2] killing on exit
[camera/realsense2_camera-3] killing on exit
[camera/points_xyzrgb_hw_registered-5] killing on exit
[calibration_tf_broadcaster-7] killing on exit
[camera/color_rectify_color-4] killing on exit
 25/09 15:20:53,856 WARNING [547348267408] (sensor.cpp:455) Frame received with streaming inactive,Depth0, Arrived,0.000000 1569450053856.381348
 25/09 15:20:53,866 WARNING [547348267408] (sensor.cpp:455) Frame received with streaming inactive,Depth0, Arrived,0.000000 1569450053866.028320
terminate called without an active exception
Context monitors started.
Loading 'move_group/ApplyPlanningSceneService'...
Loading 'move_group/ClearOctomapService'...
Loading 'move_group/MoveGroupCartesianPathService'...
Loading 'move_group/MoveGroupExecuteTrajectoryAction'...
Loading 'move_group/MoveGroupGetPlanningSceneService'...
Loading 'move_group/MoveGroupKinematicsService'...
Loading 'move_group/MoveGroupMoveAction'...
Loading 'move_group/MoveGroupPickPlaceAction'...
Loading 'move_group/MoveGroupPlanService'...
Loading 'move_group/MoveGroupQueryPlannersService'...
Loading 'move_group/MoveGroupStateValidationService'...

You can start planning now!

[rosout-1] killing on exit
[master] killing on exit
shutting down processing monitor...
... shutting down processing monitor complete
done

The same issue doesn't occur if I run roslaunch locobot_control main.launch use_arm:=true. A similar issue occurs if I run roslaunch locobot_control main.launch use_camera:=true.

Expected Results

I expected the node for the active camera to start running so I could run camera calibration.

Relevant Code

I haven't modified any of the launch scripts or source code. I've checked that the servos are all ID'd properly and have baudrate of 1000000. The fact that the arm control works in isolation tells me that it's an issue with the active camera specifically. From observation, it also seems that the servos aren't blinking red when all the errors pop up so I don't believe the servos are all actually experiencing overload/overheating/etc.

@kalyanvasudev
Copy link
Contributor

kalyanvasudev commented Oct 3, 2019

As mentioned in the installation instructions, was the realsense camera connected to the computer (via the appropirate USB3- TypeC ) cable while running the installation script? If not, please make sure you do.

Also, please consider upgrading your realsense camera firmware using the instructions provided in this link - https://www.pyrobot.org/docs/faq [Faq No: 4]

This older issue has a few camera debugging tricks - #27 (comment)

@bhyang
Copy link
Author

bhyang commented Oct 4, 2019

The camera was connected to the computer during installation. I've updated the camera firmware, but that didn't fix the issue.

To verify that the camera works, I checked the camera output in realsense-viewer. I also ran roslaunch realsense2_camera rs_camera.launch and rosrun image_view image_view image:=/camera/color/image_raw. In both cases, the camera seemed to be streaming properly.

From inspecting the logs, it also seems like the realsense node isn't causing these issues. I think it has something to do with the pan/tilt motors?

I tried operating the arm standalone, and it works fine. I also tried connecting the arm using the long cord originally for motor 8, and it still works, so I don't think there's an issue with the connecting cord.

When I try to use the pan/tilt motors using roslaunch locobot_control change_id.launch, I'm not running into any issues either. I've also tried resetting/rebooting the pan/tilt motors, but the issue remains.

Here's the newest log from running roslaunch locobot_control main.launch use_camera:=true

(pyenv_pyrobot) nvidia@tegra-ubuntu:~/low_cost_ws$ roslaunch locobot_control main.launch use_camera:=true
... logging to /home/nvidia/.ros/log/c17a5de8-dfe4-11e9-82a1-00044bc76af9/roslaunch-tegra-ubuntu-5275.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://tegra-ubuntu:36297/

SUMMARY
========

PARAMETERS
 * /camera/realsense2_camera/accel_fps: 250
 * /camera/realsense2_camera/accel_frame_id: camera_accel_frame
 * /camera/realsense2_camera/accel_optical_frame_id: camera_accel_opti...
 * /camera/realsense2_camera/align_depth: True
 * /camera/realsense2_camera/aligned_depth_to_color_frame_id: camera_aligned_de...
 * /camera/realsense2_camera/aligned_depth_to_fisheye1_frame_id: camera_aligned_de...
 * /camera/realsense2_camera/aligned_depth_to_fisheye2_frame_id: camera_aligned_de...
 * /camera/realsense2_camera/aligned_depth_to_fisheye_frame_id: camera_aligned_de...
 * /camera/realsense2_camera/aligned_depth_to_infra1_frame_id: camera_aligned_de...
 * /camera/realsense2_camera/aligned_depth_to_infra2_frame_id: camera_aligned_de...
 * /camera/realsense2_camera/allow_no_texture_points: False
 * /camera/realsense2_camera/base_frame_id: camera_link
 * /camera/realsense2_camera/calib_odom_file: 
 * /camera/realsense2_camera/clip_distance: -1.0
 * /camera/realsense2_camera/color_fps: 30
 * /camera/realsense2_camera/color_frame_id: camera_color_frame
 * /camera/realsense2_camera/color_height: 480
 * /camera/realsense2_camera/color_optical_frame_id: camera_color_opti...
 * /camera/realsense2_camera/color_width: 640
 * /camera/realsense2_camera/depth_fps: 30
 * /camera/realsense2_camera/depth_frame_id: camera_depth_frame
 * /camera/realsense2_camera/depth_height: 480
 * /camera/realsense2_camera/depth_optical_frame_id: camera_depth_opti...
 * /camera/realsense2_camera/depth_width: 640
 * /camera/realsense2_camera/enable_accel: True
 * /camera/realsense2_camera/enable_color: True
 * /camera/realsense2_camera/enable_depth: True
 * /camera/realsense2_camera/enable_fisheye1: True
 * /camera/realsense2_camera/enable_fisheye2: True
 * /camera/realsense2_camera/enable_fisheye: True
 * /camera/realsense2_camera/enable_gyro: True
 * /camera/realsense2_camera/enable_infra1: True
 * /camera/realsense2_camera/enable_infra2: True
 * /camera/realsense2_camera/enable_pointcloud: False
 * /camera/realsense2_camera/enable_sync: True
 * /camera/realsense2_camera/filters: 
 * /camera/realsense2_camera/fisheye1_frame_id: camera_fisheye1_f...
 * /camera/realsense2_camera/fisheye1_optical_frame_id: camera_fisheye1_o...
 * /camera/realsense2_camera/fisheye2_frame_id: camera_fisheye2_f...
 * /camera/realsense2_camera/fisheye2_optical_frame_id: camera_fisheye2_o...
 * /camera/realsense2_camera/fisheye_fps: 30
 * /camera/realsense2_camera/fisheye_frame_id: camera_fisheye_frame
 * /camera/realsense2_camera/fisheye_height: 480
 * /camera/realsense2_camera/fisheye_optical_frame_id: camera_fisheye_op...
 * /camera/realsense2_camera/fisheye_width: 640
 * /camera/realsense2_camera/gyro_fps: 400
 * /camera/realsense2_camera/gyro_frame_id: camera_gyro_frame
 * /camera/realsense2_camera/gyro_optical_frame_id: camera_gyro_optic...
 * /camera/realsense2_camera/imu_optical_frame_id: camera_imu_optica...
 * /camera/realsense2_camera/infra1_frame_id: camera_infra1_frame
 * /camera/realsense2_camera/infra1_optical_frame_id: camera_infra1_opt...
 * /camera/realsense2_camera/infra2_frame_id: camera_infra2_frame
 * /camera/realsense2_camera/infra2_optical_frame_id: camera_infra2_opt...
 * /camera/realsense2_camera/infra_fps: 30
 * /camera/realsense2_camera/infra_height: 480
 * /camera/realsense2_camera/infra_width: 640
 * /camera/realsense2_camera/initial_reset: False
 * /camera/realsense2_camera/json_file_path: 
 * /camera/realsense2_camera/linear_accel_cov: 0.01
 * /camera/realsense2_camera/odom_frame_id: camera_odom_frame
 * /camera/realsense2_camera/pointcloud_texture_index: 0
 * /camera/realsense2_camera/pointcloud_texture_stream: RS2_STREAM_COLOR
 * /camera/realsense2_camera/pose_frame_id: camera_pose_frame
 * /camera/realsense2_camera/pose_optical_frame_id: camera_pose_optic...
 * /camera/realsense2_camera/publish_odom_tf: True
 * /camera/realsense2_camera/rosbag_filename: 
 * /camera/realsense2_camera/serial_no: 
 * /camera/realsense2_camera/topic_odom_in: camera/odom_in
 * /camera/realsense2_camera/unite_imu_method: none
 * /dynamixel_info: /home/nvidia/low_...
 * /locobot_controller/dxl_read_period: 0.01
 * /locobot_controller/dxl_write_period: 0.01
 * /locobot_controller/publish_period: 0.01
 * /move_group/allow_trajectory_execution: True
 * /move_group/arm/default_planner_config: ESTkConfigDefault
 * /move_group/arm/longest_valid_segment_fraction: 0.005
 * /move_group/arm/planner_configs: ['SBLkConfigDefau...
 * /move_group/arm/projection_evaluator: joints(joint_1,jo...
 * /move_group/capabilities: 
 * /move_group/controller_list: [{'default': True...
 * /move_group/disable_capabilities: 
 * /move_group/gripper/default_planner_config: ESTkConfigDefault
 * /move_group/gripper/longest_valid_segment_fraction: 0.005
 * /move_group/gripper/planner_configs: ['SBLkConfigDefau...
 * /move_group/gripper/projection_evaluator: joints(joint_6,jo...
 * /move_group/jiggle_fraction: 0.05
 * /move_group/max_range: 5.0
 * /move_group/max_safe_path_cost: 1
 * /move_group/moveit_controller_manager: moveit_simple_con...
 * /move_group/moveit_manage_controllers: True
 * /move_group/octomap_resolution: 0.025
 * /move_group/planner_configs/BFMTkConfigDefault/balanced: 0
 * /move_group/planner_configs/BFMTkConfigDefault/cache_cc: 1
 * /move_group/planner_configs/BFMTkConfigDefault/extended_fmt: 1
 * /move_group/planner_configs/BFMTkConfigDefault/heuristics: 1
 * /move_group/planner_configs/BFMTkConfigDefault/nearest_k: 1
 * /move_group/planner_configs/BFMTkConfigDefault/num_samples: 1000
 * /move_group/planner_configs/BFMTkConfigDefault/optimality: 1
 * /move_group/planner_configs/BFMTkConfigDefault/radius_multiplier: 1.0
 * /move_group/planner_configs/BFMTkConfigDefault/type: geometric::BFMT
 * /move_group/planner_configs/BKPIECEkConfigDefault/border_fraction: 0.9
 * /move_group/planner_configs/BKPIECEkConfigDefault/failed_expansion_score_factor: 0.5
 * /move_group/planner_configs/BKPIECEkConfigDefault/min_valid_path_fraction: 0.5
 * /move_group/planner_configs/BKPIECEkConfigDefault/range: 0.0
 * /move_group/planner_configs/BKPIECEkConfigDefault/type: geometric::BKPIECE
 * /move_group/planner_configs/BiESTkConfigDefault/range: 0.0
 * /move_group/planner_configs/BiESTkConfigDefault/type: geometric::BiEST
 * /move_group/planner_configs/BiTRRTkConfigDefault/cost_threshold: 1e300
 * /move_group/planner_configs/BiTRRTkConfigDefault/frountier_node_ratio: 0.1
 * /move_group/planner_configs/BiTRRTkConfigDefault/frountier_threshold: 0.0
 * /move_group/planner_configs/BiTRRTkConfigDefault/init_temperature: 100
 * /move_group/planner_configs/BiTRRTkConfigDefault/range: 0.0
 * /move_group/planner_configs/BiTRRTkConfigDefault/temp_change_factor: 0.1
 * /move_group/planner_configs/BiTRRTkConfigDefault/type: geometric::BiTRRT
 * /move_group/planner_configs/ESTkConfigDefault/goal_bias: 0.05
 * /move_group/planner_configs/ESTkConfigDefault/range: 0.0
 * /move_group/planner_configs/ESTkConfigDefault/type: geometric::EST
 * /move_group/planner_configs/FMTkConfigDefault/cache_cc: 1
 * /move_group/planner_configs/FMTkConfigDefault/extended_fmt: 1
 * /move_group/planner_configs/FMTkConfigDefault/heuristics: 0
 * /move_group/planner_configs/FMTkConfigDefault/nearest_k: 1
 * /move_group/planner_configs/FMTkConfigDefault/num_samples: 1000
 * /move_group/planner_configs/FMTkConfigDefault/radius_multiplier: 1.1
 * /move_group/planner_configs/FMTkConfigDefault/type: geometric::FMT
 * /move_group/planner_configs/KPIECEkConfigDefault/border_fraction: 0.9
 * /move_group/planner_configs/KPIECEkConfigDefault/failed_expansion_score_factor: 0.5
 * /move_group/planner_configs/KPIECEkConfigDefault/goal_bias: 0.05
 * /move_group/planner_configs/KPIECEkConfigDefault/min_valid_path_fraction: 0.5
 * /move_group/planner_configs/KPIECEkConfigDefault/range: 0.0
 * /move_group/planner_configs/KPIECEkConfigDefault/type: geometric::KPIECE
 * /move_group/planner_configs/LBKPIECEkConfigDefault/border_fraction: 0.9
 * /move_group/planner_configs/LBKPIECEkConfigDefault/min_valid_path_fraction: 0.5
 * /move_group/planner_configs/LBKPIECEkConfigDefault/range: 0.0
 * /move_group/planner_configs/LBKPIECEkConfigDefault/type: geometric::LBKPIECE
 * /move_group/planner_configs/LBTRRTkConfigDefault/epsilon: 0.4
 * /move_group/planner_configs/LBTRRTkConfigDefault/goal_bias: 0.05
 * /move_group/planner_configs/LBTRRTkConfigDefault/range: 0.0
 * /move_group/planner_configs/LBTRRTkConfigDefault/type: geometric::LBTRRT
 * /move_group/planner_configs/LazyPRMkConfigDefault/range: 0.0
 * /move_group/planner_configs/LazyPRMkConfigDefault/type: geometric::LazyPRM
 * /move_group/planner_configs/LazyPRMstarkConfigDefault/type: geometric::LazyPR...
 * /move_group/planner_configs/PDSTkConfigDefault/type: geometric::PDST
 * /move_group/planner_configs/PRMkConfigDefault/max_nearest_neighbors: 10
 * /move_group/planner_configs/PRMkConfigDefault/type: geometric::PRM
 * /move_group/planner_configs/PRMstarkConfigDefault/type: geometric::PRMstar
 * /move_group/planner_configs/ProjESTkConfigDefault/goal_bias: 0.05
 * /move_group/planner_configs/ProjESTkConfigDefault/range: 0.0
 * /move_group/planner_configs/ProjESTkConfigDefault/type: geometric::ProjEST
 * /move_group/planner_configs/RRTConnectkConfigDefault/range: 0.0
 * /move_group/planner_configs/RRTConnectkConfigDefault/type: geometric::RRTCon...
 * /move_group/planner_configs/RRTkConfigDefault/goal_bias: 0.05
 * /move_group/planner_configs/RRTkConfigDefault/range: 0.0
 * /move_group/planner_configs/RRTkConfigDefault/type: geometric::RRT
 * /move_group/planner_configs/RRTstarkConfigDefault/delay_collision_checking: 1
 * /move_group/planner_configs/RRTstarkConfigDefault/goal_bias: 0.05
 * /move_group/planner_configs/RRTstarkConfigDefault/range: 0.0
 * /move_group/planner_configs/RRTstarkConfigDefault/type: geometric::RRTstar
 * /move_group/planner_configs/SBLkConfigDefault/range: 0.0
 * /move_group/planner_configs/SBLkConfigDefault/type: geometric::SBL
 * /move_group/planner_configs/SPARSkConfigDefault/dense_delta_fraction: 0.001
 * /move_group/planner_configs/SPARSkConfigDefault/max_failures: 1000
 * /move_group/planner_configs/SPARSkConfigDefault/sparse_delta_fraction: 0.25
 * /move_group/planner_configs/SPARSkConfigDefault/stretch_factor: 3.0
 * /move_group/planner_configs/SPARSkConfigDefault/type: geometric::SPARS
 * /move_group/planner_configs/SPARStwokConfigDefault/dense_delta_fraction: 0.001
 * /move_group/planner_configs/SPARStwokConfigDefault/max_failures: 5000
 * /move_group/planner_configs/SPARStwokConfigDefault/sparse_delta_fraction: 0.25
 * /move_group/planner_configs/SPARStwokConfigDefault/stretch_factor: 3.0
 * /move_group/planner_configs/SPARStwokConfigDefault/type: geometric::SPARStwo
 * /move_group/planner_configs/STRIDEkConfigDefault/degree: 16
 * /move_group/planner_configs/STRIDEkConfigDefault/estimated_dimension: 0.0
 * /move_group/planner_configs/STRIDEkConfigDefault/goal_bias: 0.05
 * /move_group/planner_configs/STRIDEkConfigDefault/max_degree: 18
 * /move_group/planner_configs/STRIDEkConfigDefault/max_pts_per_leaf: 6
 * /move_group/planner_configs/STRIDEkConfigDefault/min_degree: 12
 * /move_group/planner_configs/STRIDEkConfigDefault/min_valid_path_fraction: 0.2
 * /move_group/planner_configs/STRIDEkConfigDefault/range: 0.0
 * /move_group/planner_configs/STRIDEkConfigDefault/type: geometric::STRIDE
 * /move_group/planner_configs/STRIDEkConfigDefault/use_projected_distance: 0
 * /move_group/planner_configs/TRRTkConfigDefault/frountierNodeRatio: 0.1
 * /move_group/planner_configs/TRRTkConfigDefault/frountier_threshold: 0.0
 * /move_group/planner_configs/TRRTkConfigDefault/goal_bias: 0.05
 * /move_group/planner_configs/TRRTkConfigDefault/init_temperature: 10e-6
 * /move_group/planner_configs/TRRTkConfigDefault/k_constant: 0.0
 * /move_group/planner_configs/TRRTkConfigDefault/max_states_failed: 10
 * /move_group/planner_configs/TRRTkConfigDefault/min_temperature: 10e-10
 * /move_group/planner_configs/TRRTkConfigDefault/range: 0.0
 * /move_group/planner_configs/TRRTkConfigDefault/temp_change_factor: 2.0
 * /move_group/planner_configs/TRRTkConfigDefault/type: geometric::TRRT
 * /move_group/planning_plugin: ompl_interface/OM...
 * /move_group/planning_scene_monitor/publish_geometry_updates: True
 * /move_group/planning_scene_monitor/publish_planning_scene: True
 * /move_group/planning_scene_monitor/publish_state_updates: True
 * /move_group/planning_scene_monitor/publish_transforms_updates: True
 * /move_group/request_adapters: default_planner_r...
 * /move_group/sensors: [{'point_subsampl...
 * /move_group/start_state_max_bounds_error: 0.1
 * /move_group/trajectory_execution/allowed_execution_duration_scaling: 1.2
 * /move_group/trajectory_execution/allowed_goal_duration_margin: 0.5
 * /move_group/trajectory_execution/allowed_start_tolerance: 0.0
 * /robot_description: <?xml version="1....
 * /robot_description_kinematics/arm/kinematics_solver: trac_ik_kinematic...
 * /robot_description_kinematics/arm/kinematics_solver_attempts: 3
 * /robot_description_kinematics/arm/kinematics_solver_search_resolution: 0.005
 * /robot_description_kinematics/arm/kinematics_solver_timeout: 0.005
 * /robot_description_planning/joint_limits/joint_1/has_acceleration_limits: False
 * /robot_description_planning/joint_limits/joint_1/has_velocity_limits: True
 * /robot_description_planning/joint_limits/joint_1/max_acceleration: 0
 * /robot_description_planning/joint_limits/joint_1/max_velocity: 1
 * /robot_description_planning/joint_limits/joint_2/has_acceleration_limits: False
 * /robot_description_planning/joint_limits/joint_2/has_velocity_limits: True
 * /robot_description_planning/joint_limits/joint_2/max_acceleration: 0
 * /robot_description_planning/joint_limits/joint_2/max_velocity: 1
 * /robot_description_planning/joint_limits/joint_3/has_acceleration_limits: False
 * /robot_description_planning/joint_limits/joint_3/has_velocity_limits: True
 * /robot_description_planning/joint_limits/joint_3/max_acceleration: 0
 * /robot_description_planning/joint_limits/joint_3/max_velocity: 1
 * /robot_description_planning/joint_limits/joint_4/has_acceleration_limits: False
 * /robot_description_planning/joint_limits/joint_4/has_velocity_limits: True
 * /robot_description_planning/joint_limits/joint_4/max_acceleration: 0
 * /robot_description_planning/joint_limits/joint_4/max_velocity: 1
 * /robot_description_planning/joint_limits/joint_5/has_acceleration_limits: False
 * /robot_description_planning/joint_limits/joint_5/has_velocity_limits: True
 * /robot_description_planning/joint_limits/joint_5/max_acceleration: 0
 * /robot_description_planning/joint_limits/joint_5/max_velocity: 1
 * /robot_description_planning/joint_limits/joint_6/has_acceleration_limits: False
 * /robot_description_planning/joint_limits/joint_6/has_velocity_limits: True
 * /robot_description_planning/joint_limits/joint_6/max_acceleration: 0
 * /robot_description_planning/joint_limits/joint_6/max_velocity: 1
 * /robot_description_planning/joint_limits/joint_7/has_acceleration_limits: False
 * /robot_description_planning/joint_limits/joint_7/has_velocity_limits: True
 * /robot_description_planning/joint_limits/joint_7/max_acceleration: 0
 * /robot_description_planning/joint_limits/joint_7/max_velocity: 1
 * /robot_description_semantic: <?xml version="1....
 * /rosdistro: kinetic
 * /rosversion: 1.12.14
 * /rviz_tegra_ubuntu_5275_3969611114618816863/arm/kinematics_solver: trac_ik_kinematic...
 * /rviz_tegra_ubuntu_5275_3969611114618816863/arm/kinematics_solver_attempts: 3
 * /rviz_tegra_ubuntu_5275_3969611114618816863/arm/kinematics_solver_search_resolution: 0.005
 * /rviz_tegra_ubuntu_5275_3969611114618816863/arm/kinematics_solver_timeout: 0.005
 * /teleop: False
 * /torque_control: False
 * /use_arm: False
 * /use_base: False
 * /use_camera: True
 * /use_sim: False
 * /use_vslam: False

NODES
  /camera/
    color_rectify_color (nodelet/nodelet)
    points_xyzrgb_hw_registered (nodelet/nodelet)
    realsense2_camera (nodelet/nodelet)
    realsense2_camera_manager (nodelet/nodelet)
  /
    calibration_tf_broadcaster (locobot_calibration/calibration_publish_transforms.py)
    locobot_controller (locobot_control/locobot_controller)
    move_group (moveit_ros_move_group/move_group)
    robot_state_publisher (robot_state_publisher/robot_state_publisher)
    rviz_tegra_ubuntu_5275_3969611114618816863 (rviz/rviz)

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

setting /run_id to c17a5de8-dfe4-11e9-82a1-00044bc76af9
process[rosout-1]: started with pid [5298]
started core service [/rosout]
process[camera/realsense2_camera_manager-2]: started with pid [5315]
process[camera/realsense2_camera-3]: started with pid [5316]
process[camera/color_rectify_color-4]: started with pid [5317]
process[camera/points_xyzrgb_hw_registered-5]: started with pid [5318]
process[locobot_controller-6]: started with pid [5326]
process[calibration_tf_broadcaster-7]: started with pid [5335]
process[robot_state_publisher-8]: started with pid [5344]
process[move_group-9]: started with pid [5355]
process[rviz_tegra_ubuntu_5275_3969611114618816863-10]: started with pid [5364]
[ INFO] [1569450924.149449824]: Initializing nodelet with 4 worker threads.
[ INFO] [1569450924.215174304]: NOT loading group arm from yaml file
[ INFO] [1569450924.218040736]: Loading group camera from yaml file
[ INFO] [1569450924.218447200]: NOT loading group gripper from yaml file
[ INFO] [1569450924.254154208]: Name : head_pan_joint, ID : 8, Model Number : 1060
[ INFO] [1569450924.288448672]: Loading robot model 'locobot'...
[ INFO] [1569450924.288682656]: No root/virtual joint specified in SRDF. Assuming fixed joint
[ INFO] [1569450924.289090176]: Name : head_tilt_joint, ID : 9, Model Number : 1060
[ INFO] [1569450924.369357888]: RealSense ROS v2.2.8
[ INFO] [1569450924.369713344]: Running with LibRealSense v2.25.0
[ INFO] [1569450924.475204640]: [DynamixelDriver] Succeeded to add sync write handler
[ INFO] [1569450924.475335936]: [DynamixelDriver] Succeeded to add sync write handler
[ INFO] [1569450924.552634560]: rviz version 1.12.17
[ INFO] [1569450924.552771072]: compiled against Qt version 5.5.1
[ INFO] [1569450924.552804032]: compiled against OGRE version 1.9.0 (Ghadamon)
[ INFO] [1569450924.958119616]: getParameters...
[ INFO] [1569450925.528601120]: setupDevice...
[ INFO] [1569450925.528946304]: JSON file is not provided
[ INFO] [1569450925.529572576]: ROS Node Namespace: camera
[ INFO] [1569450925.529967904]: Device Name: Intel RealSense D435
[ INFO] [1569450925.530267136]: Device Serial No: 829212071014
[ INFO] [1569450925.530632128]: Device FW version: 05.11.06.250
[ INFO] [1569450925.530995392]: Device Product ID: 0x0B07
[ INFO] [1569450925.531300320]: Enable PointCloud: Off
[ INFO] [1569450925.531549600]: Align Depth: On
[ INFO] [1569450925.531799520]: Sync Mode: On
[ INFO] [1569450925.532230368]: Device Sensors: 
[ INFO] [1569450925.533103104]: Stereo Module was found.
[ INFO] [1569450925.533372480]: RGB Camera was found.
[ INFO] [1569450925.533771776]: (Fisheye, 0) sensor isn't supported by current device! -- Skipping...
[ INFO] [1569450925.534106240]: (Fisheye, 1) sensor isn't supported by current device! -- Skipping...
[ INFO] [1569450925.534376256]: (Fisheye, 2) sensor isn't supported by current device! -- Skipping...
[ INFO] [1569450925.534628096]: (Gyro, 0) sensor isn't supported by current device! -- Skipping...
[ INFO] [1569450925.534938784]: (Accel, 0) sensor isn't supported by current device! -- Skipping...
[ INFO] [1569450925.535210720]: (Pose, 0) sensor isn't supported by current device! -- Skipping...
[ INFO] [1569450925.535563680]: num_filters: 0
[ INFO] [1569450925.535758208]: Setting Dynamic reconfig parameters.
[ INFO] [1569450925.574414208]: IK Using joint shoulder_link -1.57 1.57
[ INFO] [1569450925.574668064]: IK Using joint elbow_link -1.57 1.57
[ INFO] [1569450925.574810592]: IK Using joint forearm_link -1.57 1.57
[ INFO] [1569450925.574981408]: IK Using joint wrist_link -1.57 1.57
[ INFO] [1569450925.575114080]: IK Using joint gripper_link -1.57 1.57
[ INFO] [1569450925.575332640]: Looking in common namespaces for param name: arm/position_only_ik
[ INFO] [1569450925.589269952]: Looking in common namespaces for param name: arm/solve_type
[ INFO] [1569450925.608428096]: Using solve type Speed
[ INFO] [1569450925.961590528]: Done Setting Dynamic reconfig parameters.
[ INFO] [1569450926.147952512]: depth stream is enabled - width: 640, height: 480, fps: 30
[ INFO] [1569450926.148391232]: infra1 stream is enabled - width: 640, height: 480, fps: 30
[ INFO] [1569450926.149390560]: infra2 stream is enabled - width: 640, height: 480, fps: 30
[ INFO] [1569450926.157172640]: color stream is enabled - width: 640, height: 480, fps: 30
[ INFO] [1569450926.160544928]: setupPublishers...
[ INFO] [1569450926.184647808]: Expected frequency for depth = 30.00000
[ INFO] [1569450926.228596768]: Stereo is NOT SUPPORTED
[ INFO] [1569450926.228858688]: OpenGl version: 4.6 (GLSL 4.6).
[ERROR] [1569450926.249578]: Using default camera calibration
[ERROR] [1569450926.250487]: For better performance, calibrate your system.
[WARN] [1569450926.251847]: Will publish: 
[WARN] [1569450926.252608]:   head_tilt_link to camera_link
[ INFO] [1569450926.339610944]: Expected frequency for infra1 = 30.00000
[ INFO] [1569450926.494553856]: Expected frequency for aligned_depth_to_infra1 = 30.00000
[ INFO] [1569450926.609976896]: Expected frequency for infra2 = 30.00000
[ INFO] [1569450926.716036640]: Expected frequency for color = 30.00000
[ INFO] [1569450926.826298848]: Expected frequency for aligned_depth_to_color = 30.00000
[ INFO] [1569450926.983821952]: setupStreams...
[ INFO] [1569450926.985496672]: insert Depth to Stereo Module
[ INFO] [1569450926.985684384]: insert Color to RGB Camera
[ INFO] [1569450926.985765856]: insert Infrared to Stereo Module
[ INFO] [1569450926.985835136]: insert Infrared to Stereo Module
[ INFO] [1569450927.119599872]: SELECTED BASE:Depth, 0
[ INFO] [1569450927.163955072]: RealSense Node Is Up!
[ERROR] [1569450927.294525600]: [TxRxResult] Incorrect status packet!
[ERROR] [1569450927.294720064]: groupSyncRead getdata failed
[ERROR] [1569450927.294810688]: groupSyncRead getdata failed
[ERROR] [1569450927.294898176]: groupSyncRead getdata failed
[ERROR] [1569450927.365619904]: [TxRxResult] Incorrect status packet!
[ERROR] [1569450927.365759616]: groupSyncRead getdata failed
[ERROR] [1569450927.365814720]: groupSyncRead getdata failed
[ERROR] [1569450927.365869952]: groupSyncRead getdata failed
[ERROR] [1569450927.427847264]: [TxRxResult] Incorrect status packet!
[ERROR] [1569450927.427949536]: groupSyncRead getdata failed
[ERROR] [1569450927.428011360]: Motor head_pan_joint ID=8 has Hardware_Error_Status byte -996263256
[ERROR] [1569450927.428047360]: Motor head_pan_joint ID=8 has Overload error
[ERROR] [1569450927.428081280]: Motor head_pan_joint ID=8 has Motor Encoder error
[ERROR] [1569450927.428119040]: Motor head_tilt_joint ID=9 has Hardware_Error_Status byte 127
[ERROR] [1569450927.428152096]: Motor head_tilt_joint ID=9 has Overload error
[ERROR] [1569450927.428187264]: Motor head_tilt_joint ID=9 has Electrical Shock error
[ERROR] [1569450927.428218112]: Motor head_tilt_joint ID=9 has Motor Encoder error
[ERROR] [1569450927.428251360]: Motor head_tilt_joint ID=9 has Overheating error
[ERROR] [1569450927.428290016]: Motor head_tilt_joint ID=9 has Input Volatage error
================================================================================REQUIRED process [locobot_controller-6] has died!
process has finished cleanly
log file: /home/nvidia/.ros/log/c17a5de8-dfe4-11e9-82a1-00044bc76af9/locobot_controller-6*.log
Initiating shutdown!
================================================================================
[rviz_tegra_ubuntu_5275_3969611114618816863-10] killing on exit
[move_group-9] killing on exit
[robot_state_publisher-8] killing on exit
[calibration_tf_broadcaster-7] killing on exit
[locobot_controller-6] killing on exit
[camera/color_rectify_color-4] killing on exit
[camera/points_xyzrgb_hw_registered-5] killing on exit
[camera/realsense2_camera_manager-2] killing on exit
[camera/realsense2_camera-3] killing on exit
Starting context monitors...
 25/09 15:35:30,194 WARNING [546450694544] (sensor.cpp:455) Frame received with streaming inactive,Depth0, Arrived,0.000000 1569450930193.958252
terminate called without an active exception
Context monitors started.
Loading 'move_group/ApplyPlanningSceneService'...
Loading 'move_group/ClearOctomapService'...
Loading 'move_group/MoveGroupCartesianPathService'...
Loading 'move_group/MoveGroupExecuteTrajectoryAction'...
Loading 'move_group/MoveGroupGetPlanningSceneService'...
Loading 'move_group/MoveGroupKinematicsService'...
Loading 'move_group/MoveGroupMoveAction'...
Loading 'move_group/MoveGroupPickPlaceAction'...
Loading 'move_group/MoveGroupPlanService'...
Loading 'move_group/MoveGroupQueryPlannersService'...
Loading 'move_group/MoveGroupStateValidationService'...

You can start planning now!

[rosout-1] killing on exit
[master] killing on exit
shutting down processing monitor...
... shutting down processing monitor complete
done

Any help would be appreciated. Thanks!

@kalyanvasudev
Copy link
Contributor

kalyanvasudev commented Oct 7, 2019

Hi, Just to make sure camera is truly not the source of the error, similar to your earlier camera experiment can you do the following and confirm everything is fine?

Run, roslaunch realsense2_camera rs_camera.launch and then in a new terminal do rosrun image_view image_view image:=/camera/depth/image_rect_raw

Are you able to see the depth image?

@bhyang
Copy link
Author

bhyang commented Oct 7, 2019

Okay with some help I've fixed the issue. I was using these since I didn't get the long 3-pin cable from Trossen, but this was responsible for the issue. Not using the extenders seems to resolve the errors. I don't believe the camera played a role here (I could see the depth images).
Thanks!

Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
None yet
Projects
None yet
Development

No branches or pull requests

2 participants