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

planningが終わらない現象について #32

Open
moritakko opened this issue Jan 23, 2023 · 5 comments
Open

planningが終わらない現象について #32

moritakko opened this issue Jan 23, 2023 · 5 comments

Comments

@moritakko
Copy link

手順通りシミュレーションを実行しようとすると、
2回に1回くらいの頻度でplanningが終わらずシミュレーションが開始しません。

https://drive.google.com/file/d/1RZkiEFu5L8dlcTmRLI_SW_Uq2nVdEoP8/view?usp=sharing

$ source install/setup.bash
$ ros2 launch aichallenge_launch aichallenge.launch.xml
@moritakko
Copy link
Author

logの一部です(ずっとplanningの際のログです)

[component_container-26] [pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
[sample-65] Planning.....
[rviz2-66] [INFO] [1674462411.025363508] [rviz2]: Message Filter dropping message: frame 'base_link' at time 9.290 for reason 'the timestamp on the message is earlier than all the data in the transform cache'
[sample-65] Planning.....
[component_container_mt-4] [ERROR] [1674462411.138859945] [system.system_monitor.hdd_monitor]: Failed to execute findmnt. /dev/sda3
[sample-65] Planning.....
[rviz2-66] [INFO] [1674462411.220045568] [rviz2]: Message Filter dropping message: frame 'base_link' at time 9.490 for reason 'the timestamp on the message is earlier than all the data in the transform cache'
[component_container_mt-47] [WARN] [1674462411.228500319] [planning.scenario_planning.lane_driving.motion_planning.obstacle_stop_planner]: waiting for perception object ...
[sample-65] Planning.....
[component_container-26] [pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
[sample-65] Planning.....
[rviz2-66] [INFO] [1674462411.431318441] [rviz2]: Message Filter dropping message: frame 'base_link' at time 9.690 for reason 'the timestamp on the message is earlier than all the data in the transform cache'
[sample-65] Planning.....
[component_container_mt-47] [WARN] [1674462411.584289937] [planning.scenario_planning.lane_driving.motion_planning.surround_obstacle_checker]: waiting for dynamic object info...
[component_container-26] [pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
[sample-65] Planning.....
[component_container_mt-47] [WARN] [1674462411.612983295] [util]: [Avoidance] MPT:  OSQP solution status: OSQP_SOLVED_INACCURATE
[sample-65] Planning.....
[component_container-26] [pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
[sample-65] Planning.....
[sample-65] Planning.....
[component_container-26] [pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
[sample-65] Planning.....
[sample-65] Planning.....
[component_container_mt-4] [ERROR] [1674462412.138134885] [system.system_monitor.hdd_monitor]: Failed to execute findmnt. /dev/sda3
[component_container-26] [pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
[sample-65] Planning.....
[component_container-50] [INFO] [1674462412.234715668] [control.trajectory_follower.lane_departure_checker_node]: waiting for reference_trajectory msg...
[sample-65] Planning.....
[sample-65] Planning.....
[sample-65] Planning.....
[component_container-26] [pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
[sample-65] Planning.....
[system_error_monitor-7] [WARN] [1674462412.633382332] [system_error_monitor /autoware/sensing/node_alive_monitoring]: [Latent Fault]: Warning
[system_error_monitor-7] [WARN] [1674462412.633424475] [system_error_monitor /autoware/sensing/node_alive_monitoring/topic_status/ad_service_state_monitor: sensing_topic_status]: [Latent Fault]: Warn
[system_error_monitor-7] [ERROR] [1674462412.633431775] [system_error_monitor /autoware/control/autonomous_driving/node_alive_monitoring]: [Single Point Fault]: Error
[system_error_monitor-7] [ERROR] [1674462412.633439530] [system_error_monitor /autoware/control/autonomous_driving/node_alive_monitoring/topic_status/ad_service_state_monitor: control_topic_status]: [Single Point Fault]: Error
[system_error_monitor-7] [ERROR] [1674462412.633444326] [system_error_monitor /autoware/perception/node_alive_monitoring]: [Single Point Fault]: Error
[system_error_monitor-7] [ERROR] [1674462412.633448991] [system_error_monitor /autoware/perception/node_alive_monitoring/topic_status/ad_service_state_monitor: perception_topic_status]: [Single Point Fault]: Error
[system_error_monitor-7] [ERROR] [1674462412.633453674] [system_error_monitor /autoware/planning/node_alive_monitoring]: [Single Point Fault]: Error
[system_error_monitor-7] [ERROR] [1674462412.633458144] [system_error_monitor /autoware/planning/node_alive_monitoring/topic_status/ad_service_state_monitor: planning_topic_status]: [Single Point Fault]: Error
[component_container_mt-47] [WARN] [1674462412.639685563] [util]: [Avoidance] MPT:  OSQP solution status: OSQP_SOLVED_INACCURATE
[sample-65] Planning.....
[component_container-50] [WARN] [1674462412.766516253] [control.operation_mode_transition_manager]: Engage unavailable: trajectory size must be > 2
[sample-65] Planning.....
[sample-65] Planning.....
[component_container-26] [pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
[sample-65] Planning.....
[sample-65] Planning.....
[component_container_mt-4] [ERROR] [1674462413.136679791] [system.system_monitor.hdd_monitor]: Failed to execute findmnt. /dev/sda3
[component_container-26] [pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
[sample-65] Planning.....
[component_container-26] [pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
[sample-65] Planning.....
[sample-65] Planning.....
[component_container-26] [pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
[sample-65] Planning.....
[component_container-26] [pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
[sample-65] Planning.....
[component_container_mt-47] [WARN] [1674462413.703153078] [util]: [Avoidance] MPT:  OSQP solution status: OSQP_ITER_REACHED
[sample-65] Planning.....
[component_container-26] [pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
[sample-65] Planning.....
[sample-65] Planning.....
[sample-65] Planning.....
[sample-65] Planning.....
[component_container_mt-4] [ERROR] [1674462414.135736769] [system.system_monitor.hdd_monitor]: Failed to execute findmnt. /dev/sda3
[sample-65] Planning.....
[sample-65] Planning.....
[sample-65] Planning.....
[component_container-26] [pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
[sample-65] Planning.....
[sample-65] Planning.....
[component_container_mt-45] [WARN] [1674462414.680156936] [planning.scenario_planning.lane_driving.behavior_planning.behavior_velocity_planner.traffic_light_module]: cannot find traffic light lamp state (TrafficSignalNotFound).
[component_container-26] [pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
[sample-65] Planning.....
[component_container_mt-47] [WARN] [1674462414.806748103] [util]: [Avoidance] MPT:  OSQP solution status: OSQP_SOLVED_INACCURATE
[sample-65] Planning.....
[sample-65] Planning.....
[component_container-26] [pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
[sample-65] Planning.....
[sample-65] Planning.....
[component_container_mt-4] [ERROR] [1674462415.136822309] [system.system_monitor.hdd_monitor]: Failed to execute findmnt. /dev/sda3
[sample-65] Planning.....
[sample-65] Planning.....
[component_container-26] [pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
[sample-65] Planning.....
[component_container-26] [pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
[sample-65] Planning.....
[sample-65] Planning.....
[component_container-26] [pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
[sample-65] Planning.....
[sample-65] Planning.....
[component_container_mt-47] [WARN] [1674462415.828185669] [util]: [Avoidance] MPT:  OSQP solution status: OSQP_SOLVED_INACCURATE
[component_container-26] [pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
[sample-65] Planning.....
[sample-65] Planning.....
[component_container-26] [pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
[sample-65] Planning.....
[component_container_mt-4] [ERROR] [1674462416.147017931] [system.system_monitor.hdd_monitor]: Failed to execute findmnt. /dev/sda3
[sample-65] Planning.....
[component_container_mt-47] [WARN] [1674462416.235811793] [planning.scenario_planning.lane_driving.motion_planning.obstacle_stop_planner]: waiting for perception object ...
[component_container-26] [pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
[sample-65] Planning.....
[sample-65] Planning.....
[sample-65] Planning.....
[component_container-26] [pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
[sample-65] Planning.....
[component_container_mt-47] [WARN] [1674462416.674230194] [planning.scenario_planning.lane_driving.motion_planning.surround_obstacle_checker]: waiting for dynamic object info...
[sample-65] Planning.....
[component_container-26] [pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
[sample-65] Planning.....
[sample-65] Planning.....
[component_container_mt-47] [WARN] [1674462416.927890815] [util]: [Avoidance] MPT:  OSQP solution status: OSQP_SOLVED_INACCURATE
[component_container-26] [pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
[sample-65] Planning.....
[component_container-26] [pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
[sample-65] Planning.....
[component_container_mt-4] [ERROR] [1674462417.137065901] [system.system_monitor.hdd_monitor]: Failed to execute findmnt. /dev/sda3
[sample-65] Planning.....
[component_container-26] [pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
[sample-65] Planning.....
[component_container-50] [INFO] [1674462417.334140868] [control.trajectory_follower.lane_departure_checker_node]: waiting for reference_trajectory msg...
[sample-65] Planning.....
[component_container-26] [pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
[sample-65] Planning.....
[component_container-26] [pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
[sample-65] Planning.....
[sample-65] Planning.....
[system_error_monitor-7] [ERROR] [1674462417.721034194] [system_error_monitor /autoware/control/autonomous_driving/node_alive_monitoring]: [Single Point Fault]: Error
[system_error_monitor-7] [ERROR] [1674462417.721069564] [system_error_monitor /autoware/control/autonomous_driving/node_alive_monitoring/topic_status/ad_service_state_monitor: control_topic_status]: [Single Point Fault]: Error
[system_error_monitor-7] [ERROR] [1674462417.721074733] [system_error_monitor /autoware/perception/node_alive_monitoring]: [Single Point Fault]: Error
[system_error_monitor-7] [ERROR] [1674462417.721079667] [system_error_monitor /autoware/perception/node_alive_monitoring/topic_status/ad_service_state_monitor: perception_topic_status]: [Single Point Fault]: Error
[system_error_monitor-7] [ERROR] [1674462417.721084223] [system_error_monitor /autoware/planning/node_alive_monitoring]: [Single Point Fault]: Error
[system_error_monitor-7] [ERROR] [1674462417.721088623] [system_error_monitor /autoware/planning/node_alive_monitoring/topic_status/ad_service_state_monitor: planning_topic_status]: [Single Point Fault]: Error
[sample-65] Planning.....
[component_container-50] [WARN] [1674462417.870855424] [control.operation_mode_transition_manager]: Engage unavailable: trajectory size must be > 2
[component_container-26] [pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
[sample-65] Planning.....
[sample-65] Planning.....
[component_container_mt-47] [WARN] [1674462418.042476963] [util]: [Avoidance] MPT:  OSQP solution status: OSQP_ITER_REACHED
[sample-65] Planning.....
[component_container_mt-4] [ERROR] [1674462418.142325674] [system.system_monitor.hdd_monitor]: Failed to execute findmnt. /dev/sda3
[sample-65] Planning.....
[sample-65] Planning.....
[sample-65] Planning.....
[component_container-26] [pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
[sample-65] Planning.....
[sample-65] Planning.....
[system_error_monitor-7] [WARN] [1674462418.635850767] [system_error_monitor /autoware/sensing/node_alive_monitoring]: [Latent Fault]: Warning
[system_error_monitor-7] [WARN] [1674462418.635933211] [system_error_monitor /autoware/sensing/node_alive_monitoring/topic_status/ad_service_state_monitor: sensing_topic_status]: [Latent Fault]: Warn
[sample-65] Planning.....
[sample-65] Planning.....
[sample-65] Planning.....
[component_container-26] [pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
[sample-65] Planning.....
[sample-65] Planning.....
[component_container_mt-47] [WARN] [1674462419.145122051] [util]: [Avoidance] MPT:  OSQP solution status: OSQP_SOLVED_INACCURATE
[component_container_mt-47] [INFO] [1674462419.146546473] [planning.scenario_planning.lane_driving.motion_planning.obstacle_avoidance_planner]: [Avoidance] Not extend trajectory
[component_container_mt-4] [ERROR] [1674462419.150635278] [system.system_monitor.hdd_monitor]: Failed to execute findmnt. /dev/sda3
[component_container-26] [pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
[sample-65] Planning.....
[sample-65] Planning.....
[sample-65] Planning.....
[sample-65] Planning.....
[component_container-26] [pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
[sample-65] Planning.....
[sample-65] Planning.....
[component_container-26] [pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
[component_container_mt-45] [WARN] [1674462419.783339118] [planning.scenario_planning.lane_driving.behavior_planning.behavior_velocity_planner.traffic_light_module]: cannot find traffic light lamp state (TrafficSignalNotFound).
[sample-65] Planning.....
[sample-65] Planning.....
[sample-65] Planning.....
[sample-65] Planning.....
[component_container_mt-4] [ERROR] [1674462420.138183440] [system.system_monitor.hdd_monitor]: Failed to execute findmnt. /dev/sda3
[component_container-26] [pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
[component_container_mt-47] [WARN] [1674462420.224491846] [util]: [Avoidance] MPT:  OSQP solution status: OSQP_SOLVED_INACCURATE
[sample-65] Planning.....
[sample-65] Planning.....
[component_container-26] [pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
[sample-65] Planning.....
[sample-65] Planning.....
[sample-65] Planning.....
[sample-65] Planning.....
[sample-65] Planning.....
[component_container-26] [pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
[sample-65] Planning.....
[sample-65] Planning.....
[component_container-26] [pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
[sample-65] Planning.....
[component_container_mt-4] [ERROR] [1674462421.138987176] [system.system_monitor.hdd_monitor]: Failed to execute findmnt. /dev/sda3
[sample-65] Planning.....
[component_container-26] [pcl::KdTreeFLANN::setInputCloud] Cannot create a KDTree with an empty input cloud!
[sample-65] Planning.....
[component_container_mt-47] [WARN] [1674462421.338144157] [util]: [Avoidance] MPT:  OSQP solution status: OSQP_SOLVED_INACCURATE
[component_container_mt-47] [WARN] [1674462421.350122101] [planning.scenario_planning.lane_driving.motion_planning.obstacle_stop_planner]: waiting for perception object ...
[sample-65] Planning.....

@Reee009876
Copy link
Collaborator

Reee009876 commented Jan 24, 2023

お世話になっております。

解決策が判明するまで、こちらの方法でご対処願えないでしょうか??#20 (comment)

※以下のissueと関連していると思われ、調査中です。
#27
#20

@moritakko
Copy link
Author

追記です。

提出前の動作確認の際に、evaluationディレクトリで

$ sh create_submit_tar.sh 
$ sh build.sh Challenge
$ sh run.sh

した際には、この現象は確認できないです。

@Reee009876
Copy link
Collaborator

申し訳ございません。

現在、事象の原因や
どのような操作を行えば発生するのかの特定もいたっていない状況です。

大変お手数ですが、
こちら
ご対応いただければ幸いです。

@kasecato
Copy link

こちらで提案されている sample_code.cpp のコンストラクタでスリープを 1 分間使用するワークアラウンドではいかがでしょうか?
#26 (comment)

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

3 participants