提交 7dd05a84 编写于 作者: J jiangyifei 提交者: Jiangtao Hu

planning: added planning pad reader.

上级 90db67ed
......@@ -58,7 +58,7 @@ class PublicRoadPlanner : public PlannerWithReferenceLine {
*/
virtual ~PublicRoadPlanner() = default;
std::string Name() override { return "EM"; }
std::string Name() override { return "PUBLIC_ROAD"; }
common::Status Init(const PlanningConfig& config) override;
......
......@@ -41,7 +41,7 @@ TEST_F(StdPlannerDispatcherTest, Simple) {
pd_.reset(new StdPlannerDispatcher());
pd_->Init();
auto planner = pd_->DispatchPlanner();
EXPECT_EQ(planner->Name(), "EM");
EXPECT_EQ(planner->Name(), "PUBLIC_ROAD");
}
} // namespace planning
......
......@@ -49,6 +49,16 @@ bool PlanningComponent::Init() {
traffic_light_.CopyFrom(*traffic_light);
});
if (FLAGS_use_navigation_mode) {
pad_message_reader_ = node_->CreateReader<PadMessage>(
planning_conf_.planning_pad_channel(),
[this](const std::shared_ptr<PadMessage>& pad_message) {
ADEBUG << "Received chassis data: run chassis callback.";
std::lock_guard<std::mutex> lock(mutex_);
pad_message_.CopyFrom(*pad_message);
});
}
writer_ = node_->CreateWriter<ADCTrajectory>("/apollo/planning");
return true;
......
......@@ -28,6 +28,7 @@
#include "modules/localization/proto/localization.pb.h"
#include "modules/perception/proto/traffic_light_detection.pb.h"
#include "modules/planning/proto/planning.pb.h"
#include "modules/planning/proto/pad_msg.pb.h"
#include "modules/planning/proto/planning_conf.pb.h"
#include "modules/prediction/proto/prediction_obstacle.pb.h"
#include "modules/routing/proto/routing.pb.h"
......@@ -59,12 +60,14 @@ class PlanningComponent final
std::shared_ptr<cybertron::Reader<perception::TrafficLightDetection>>
traffic_light_reader_;
std::shared_ptr<cybertron::Reader<routing::RoutingResponse>> routing_reader_;
std::shared_ptr<cybertron::Reader<planning::PadMessage>> pad_message_reader_;
std::shared_ptr<cybertron::Writer<ADCTrajectory>> writer_;
std::mutex mutex_;
perception::TrafficLightDetection traffic_light_;
routing::RoutingResponse routing_;
PadMessage pad_message_;
LocalView local_view_;
......
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册