Apollo中的控制算法由一個或多個控制器組成,可以輕松更改或替換為不同的算法。 每個控制器將一個或多個控制命令輸出到CANbus。 Apollo中的默認控制算法包含橫向控制器(LatController)和縱向控制器(LonController)。 它們分別負責橫向和縱向的車輛控制。
新的控制算法不必遵循默認模式,例如,一個橫向控制器+一個縱向控制器。 它可以是單個控制器,也可以是任意數量控制器的組合。
添加新的控制算法的步驟:
▼
創建一個控制器
在文件control_config中添加新控制器的配置信息
注冊新控制器
為了更好的理解,下面對每個步驟進行詳細的闡述:
1
創建一個控制器
所有控制器都必須繼承基類Controller,它定義了一組接口。 以下是控制器實現的示例:
123456789101112131415161718 | namespace apollo {namespace control {class NewController : public Controller { public: NewController(); virtual ~NewController(); Status Init(const ControlConf* control_conf) override; Status ComputeControlCommand( const localization::LocalizationEstimate* localization, const canbus::Chassis* chassis, const planning::ADCTrajectory* trajectory, ControlCommand* cmd) override; Status Reset() override; void Stop() override; std::string Name() const override;};} // namespace control} // namespace apollo |
2添加新控制器的配置信息
按照下面的步驟在文件control_config中添加新控制器的配置信息:
1、根據算法要求為新控制器配置和參數定義proto。作為示例,可以參考以下位置的LatController的proto定義:modules/control/proto/ lat_controller_conf.proto
2、定義新的控制器proto之后,例如new_controller_conf.proto,輸入以下內容:
12345678 | syntax = "proto2";package apollo.control;message NewControllerConf { double parameter1 = 1; int32 parameter2 = 2;} |
3、參考如下內容更新modules/control/proto/control_conf.proto文件:
1 | optional apollo.control.NewControllerConf new_controller_conf = 15; |
4、參考以內容更新ControllerType(在modules/control/proto/control_conf.proto中):
12345 | enum ControllerType { LAT_CONTROLLER = 0; LON_CONTROLLER = 1; NEW_CONTROLLER = 2; }; |
protobuf定義完成后,在modules/control/conf/lincoln.pb.txt中相應更新控制配置文件。
注意:上面的"control/conf"文件是Apollo的默認文件。您的項目可能使用不同的控制配置文件。
3注冊新控制器
要激活Apollo系統中的新控制器,請在如下文件中的“ControllerAgent”中注冊新控制器:modules/control/controller/controller_agent.cc
按照如下示例添加注冊信息:
12345 | void ControllerAgent::RegisterControllers() { controller_factory_.Register( ControlConf::NEW_CONTROLLER, []() -> Controller * { return new NewController(); });} |
在完成以上步驟后,您的新控制器便可在Apollo系統中生效。
-
控制器
+關注
關注
112文章
16214瀏覽量
177479 -
控制算法
+關注
關注
4文章
166瀏覽量
21691
原文標題:技術文檔 | 如何添加新的控制算法
文章出處:【微信號:Apollo_Developers,微信公眾號:Apollo開發者社區】歡迎添加關注!文章轉載請注明出處。
發布評論請先 登錄
相關推薦
評論