system_executor.cpp 23 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609
  1. //
  2. // Created by huli on 2020/7/2.
  3. //
  4. #include "system_executor.h"
  5. System_executor::System_executor()
  6. {
  7. }
  8. System_executor::~System_executor()
  9. {
  10. system_executor_uninit();
  11. }
  12. //初始化
  13. Error_manager System_executor::system_executor_init(int threads_size)
  14. {
  15. m_thread_pool.thread_pool_init(threads_size);
  16. m_system_executor_status = SYSTEM_EXECUTOR_READY;
  17. return Error_code::SUCCESS;
  18. }
  19. //反初始化
  20. Error_manager System_executor::system_executor_uninit()
  21. {
  22. m_thread_pool.thread_pool_uninit();
  23. m_system_executor_status = SYSTEM_EXECUTOR_UNKNOW;
  24. return Error_code::SUCCESS;
  25. }
  26. //检查消息是否有效, 主要检查消息类型和接受者, 判断这条消息是不是给我的.
  27. Error_manager System_executor::check_msg(Communication_message* p_msg)
  28. {
  29. if ( p_msg == NULL )
  30. {
  31. return Error_manager(Error_code::POINTER_IS_NULL, Error_level::MINOR_ERROR,
  32. " POINTER IS NULL ");
  33. }
  34. //检查接受人
  35. if ( p_msg->get_receiver() == Communication_message::Communicator::eDispatch_mamager )
  36. {
  37. //检查消息类型
  38. switch ( p_msg->get_message_type() )
  39. {
  40. case Communication_message::Message_type::eDispatch_request_msg:
  41. {
  42. message::Dispatch_request_msg t_dispatch_request_msg;
  43. //针对消息类型, 对消息进行二次解析
  44. if (t_dispatch_request_msg.ParseFromString(p_msg->get_message_buf()))
  45. {
  46. if ( t_dispatch_request_msg.dispatch_motion_direction() == message::Dispatch_motion_direction::E_STORE_CAR )
  47. {
  48. if ( t_dispatch_request_msg.mutable_id_struct()->terminal_id() == Dispatch_manager::get_instance_references().get_dispatch_manager_id()*2 ||
  49. t_dispatch_request_msg.mutable_id_struct()->terminal_id() == Dispatch_manager::get_instance_references().get_dispatch_manager_id()*2+1)
  50. {
  51. return Error_code::SUCCESS;
  52. }
  53. }
  54. else if ( t_dispatch_request_msg.dispatch_motion_direction() == message::Dispatch_motion_direction::E_PICKUP_CAR )
  55. {
  56. if ( t_dispatch_request_msg.mutable_id_struct()->unit_id() == Dispatch_manager::get_instance_references().get_dispatch_manager_id() )
  57. {
  58. return Error_code::SUCCESS;
  59. }
  60. }
  61. }
  62. else
  63. {
  64. return Error_manager(Error_code::SYSTEM_EXECUTOR_PARSE_ERROR, Error_level::MINOR_ERROR,
  65. " message::Dispatch_request_msg ParseFromString error ");
  66. }
  67. break;
  68. }
  69. case Communication_message::Message_type::eDispatch_plan_response_msg:
  70. {
  71. return Error_code::SUCCESS;
  72. break;
  73. }
  74. case Communication_message::Message_type::eDispatch_control_request_msg:
  75. {
  76. return Error_code::SUCCESS;
  77. break;
  78. }
  79. default :
  80. ;
  81. break;
  82. }
  83. }
  84. //检查接受人
  85. if ( p_msg->get_receiver() == Communication_message::Communicator::eEmpty )
  86. {
  87. //检查消息类型
  88. switch ( p_msg->get_message_type() )
  89. {
  90. case Communication_message::Message_type::eGround_status_msg:
  91. {
  92. message::Ground_status_msg t_ground_status_msg;
  93. //针对消息类型, 对消息进行二次解析
  94. if (t_ground_status_msg.ParseFromString(p_msg->get_message_buf()))
  95. {
  96. if ( t_ground_status_msg.terminal_id() == Dispatch_manager::get_instance_references().get_dispatch_manager_id()*2 ||
  97. t_ground_status_msg.terminal_id() == Dispatch_manager::get_instance_references().get_dispatch_manager_id()*2+1)
  98. {
  99. return Error_code::SUCCESS;
  100. }
  101. }
  102. else
  103. {
  104. return Error_manager(Error_code::SYSTEM_EXECUTOR_PARSE_ERROR, Error_level::MINOR_ERROR,
  105. " message::Dispatch_request_msg ParseFromString error ");
  106. }
  107. break;
  108. }
  109. case Communication_message::Message_type::eTerminal_status_msg:
  110. {
  111. message::Terminal_status_msg t_terminal_status_msg;
  112. //针对消息类型, 对消息进行二次解析
  113. if (t_terminal_status_msg.ParseFromString(p_msg->get_message_buf()))
  114. {
  115. if ( t_terminal_status_msg.terminal_id() == Dispatch_manager::get_instance_references().get_dispatch_manager_id()*2 ||
  116. t_terminal_status_msg.terminal_id() == Dispatch_manager::get_instance_references().get_dispatch_manager_id()*2+1)
  117. {
  118. return Error_code::SUCCESS;
  119. }
  120. }
  121. else
  122. {
  123. return Error_manager(Error_code::SYSTEM_EXECUTOR_PARSE_ERROR, Error_level::MINOR_ERROR,
  124. " message::Dispatch_request_msg ParseFromString error ");
  125. }
  126. break;
  127. }
  128. case Communication_message::Message_type::eNotify_status_msg:
  129. {
  130. message::Notify_status_msg t_notify_status_msg;
  131. //针对消息类型, 对消息进行二次解析
  132. if (t_notify_status_msg.ParseFromString(p_msg->get_message_buf()))
  133. {
  134. if ( t_notify_status_msg.terminal_id() == Dispatch_manager::get_instance_references().get_dispatch_manager_id()*2 ||
  135. t_notify_status_msg.terminal_id() == Dispatch_manager::get_instance_references().get_dispatch_manager_id()*2+1)
  136. {
  137. return Error_code::SUCCESS;
  138. }
  139. }
  140. else
  141. {
  142. return Error_manager(Error_code::SYSTEM_EXECUTOR_PARSE_ERROR, Error_level::MINOR_ERROR,
  143. " message::Dispatch_request_msg ParseFromString error ");
  144. }
  145. break;
  146. }
  147. default :
  148. ;
  149. break;
  150. }
  151. }
  152. //无效的消息,
  153. return Error_manager(Error_code::INVALID_MESSAGE, Error_level::NEGLIGIBLE_ERROR,
  154. " INVALID_MESSAGE error ");
  155. }
  156. //检查执行者的状态, 判断能否处理这条消息,
  157. Error_manager System_executor::check_executer(Communication_message* p_msg)
  158. {
  159. if ( p_msg == NULL )
  160. {
  161. return Error_manager(Error_code::POINTER_IS_NULL, Error_level::MINOR_ERROR,
  162. " POINTER IS NULL ");
  163. }
  164. //检查执行线程池
  165. Error_manager t_executor_result = System_executor::get_instance_references().check_status();
  166. if (t_executor_result.get_error_level() == NEGLIGIBLE_ERROR)//一级故障,轻微故障,
  167. {
  168. std::cout << "executer_is_busy , " << std::endl;
  169. //返回繁忙之后, 通信模块1秒后再次调用check
  170. return Error_code::COMMUNICATION_EXCUTER_IS_BUSY;
  171. }
  172. else if (t_executor_result.get_error_level() > NEGLIGIBLE_ERROR)
  173. {
  174. return Error_manager(Error_code::SYSTEM_EXECUTOR_STATUS_ERROR, Error_level::MINOR_ERROR,
  175. "System_executor::get_instance_references().check_status(); fun error ");
  176. }
  177. //检查接受人
  178. if ( p_msg->get_receiver() == Communication_message::Communicator::eDispatch_mamager )
  179. {
  180. return Dispatch_manager::get_instance_references().check_execute_msg(p_msg);
  181. }
  182. return Error_code::SUCCESS;
  183. }
  184. //处理消息的执行函数
  185. Error_manager System_executor::execute_msg(Communication_message* p_msg)
  186. {
  187. if ( p_msg == NULL )
  188. {
  189. return Error_manager(Error_code::POINTER_IS_NULL, Error_level::MINOR_ERROR,
  190. " POINTER IS NULL ");
  191. }
  192. //检查接受人
  193. if ( p_msg->get_receiver() == Communication_message::Communicator::eDispatch_mamager )
  194. {
  195. switch ( p_msg->get_message_type() )
  196. {
  197. case Communication_message::Message_type::eDispatch_request_msg:
  198. {
  199. message::Dispatch_request_msg t_dispatch_request_msg;
  200. //针对消息类型, 对消息进行二次解析
  201. if (t_dispatch_request_msg.ParseFromString(p_msg->get_message_buf()))
  202. {
  203. //往线程池添加执行任务, 之后会唤醒一个线程去执行他.
  204. m_thread_pool.enqueue(&System_executor::execute_for_dispatch_request_msg, this,
  205. t_dispatch_request_msg );
  206. }
  207. else
  208. {
  209. return Error_manager(Error_code::SYSTEM_EXECUTOR_PARSE_ERROR, Error_level::MINOR_ERROR,
  210. " message::Dispatch_request_msg ParseFromString error ");
  211. }
  212. break;
  213. }
  214. case Communication_message::Message_type::eDispatch_plan_response_msg:
  215. {
  216. message::Dispatch_plan_response_msg t_dispatch_plan_response_msg;
  217. //针对消息类型, 对消息进行二次解析
  218. if (t_dispatch_plan_response_msg.ParseFromString(p_msg->get_message_buf()))
  219. {
  220. //往线程池添加执行任务, 之后会唤醒一个线程去执行他.
  221. m_thread_pool.enqueue(&System_executor::execute_for_dispatch_plan_response_msg, this,
  222. t_dispatch_plan_response_msg );
  223. }
  224. else
  225. {
  226. return Error_manager(Error_code::SYSTEM_EXECUTOR_PARSE_ERROR, Error_level::MINOR_ERROR,
  227. " message::Dispatch_request_msg ParseFromString error ");
  228. }
  229. break;
  230. }
  231. case Communication_message::Message_type::eDispatch_control_request_msg:
  232. {
  233. message::Dispatch_control_request_msg t_dispatch_control_request_msg;
  234. //针对消息类型, 对消息进行二次解析
  235. if (t_dispatch_control_request_msg.ParseFromString(p_msg->get_message_buf()))
  236. {
  237. //往线程池添加执行任务, 之后会唤醒一个线程去执行他.
  238. m_thread_pool.enqueue(&System_executor::execute_for_dispatch_control_request_msg, this,
  239. t_dispatch_control_request_msg );
  240. }
  241. else
  242. {
  243. return Error_manager(Error_code::SYSTEM_EXECUTOR_PARSE_ERROR, Error_level::MINOR_ERROR,
  244. " message::Dispatch_request_msg ParseFromString error ");
  245. }
  246. break;
  247. }
  248. default:
  249. break;
  250. }
  251. }
  252. //检查接受人
  253. if ( p_msg->get_receiver() == Communication_message::Communicator::eEmpty )
  254. {
  255. switch ( p_msg->get_message_type() )
  256. {
  257. case Communication_message::Message_type::eGround_status_msg:
  258. {
  259. message::Ground_status_msg t_ground_status_msg;
  260. //针对消息类型, 对消息进行二次解析
  261. if (t_ground_status_msg.ParseFromString(p_msg->get_message_buf()))
  262. {
  263. //往线程池添加执行任务, 之后会唤醒一个线程去执行他.
  264. m_thread_pool.enqueue(&System_executor::execute_for_ground_status_msg, this,
  265. t_ground_status_msg );
  266. }
  267. else
  268. {
  269. return Error_manager(Error_code::SYSTEM_EXECUTOR_PARSE_ERROR, Error_level::MINOR_ERROR,
  270. " message::Dispatch_request_msg ParseFromString error ");
  271. }
  272. break;
  273. }
  274. case Communication_message::Message_type::eTerminal_status_msg:
  275. {
  276. message::Terminal_status_msg t_terminal_status_msg;
  277. //针对消息类型, 对消息进行二次解析
  278. if (t_terminal_status_msg.ParseFromString(p_msg->get_message_buf()))
  279. {
  280. //往线程池添加执行任务, 之后会唤醒一个线程去执行他.
  281. m_thread_pool.enqueue(&System_executor::execute_for_terminal_status_msg, this,
  282. t_terminal_status_msg );
  283. }
  284. else
  285. {
  286. return Error_manager(Error_code::SYSTEM_EXECUTOR_PARSE_ERROR, Error_level::MINOR_ERROR,
  287. " message::Dispatch_request_msg ParseFromString error ");
  288. }
  289. break;
  290. }
  291. case Communication_message::Message_type::eNotify_status_msg:
  292. {
  293. message::Notify_status_msg t_notify_status_msg;
  294. //针对消息类型, 对消息进行二次解析
  295. if (t_notify_status_msg.ParseFromString(p_msg->get_message_buf()))
  296. {
  297. //往线程池添加执行任务, 之后会唤醒一个线程去执行他.
  298. m_thread_pool.enqueue(&System_executor::execute_for_notify_status_msg, this,
  299. t_notify_status_msg );
  300. }
  301. else
  302. {
  303. return Error_manager(Error_code::SYSTEM_EXECUTOR_PARSE_ERROR, Error_level::MINOR_ERROR,
  304. " message::Dispatch_request_msg ParseFromString error ");
  305. }
  306. break;
  307. }
  308. default:
  309. break;
  310. }
  311. }
  312. return Error_code::SUCCESS;
  313. }
  314. //检查状态
  315. Error_manager System_executor::check_status()
  316. {
  317. if ( m_system_executor_status == SYSTEM_EXECUTOR_READY )
  318. {
  319. if ( m_thread_pool.thread_is_full_load() == false )
  320. {
  321. return Error_code::SUCCESS;
  322. }
  323. else
  324. {
  325. return Error_manager(Error_code::SYSTEM_EXECUTOR_STATUS_BUSY, Error_level::NEGLIGIBLE_ERROR,
  326. " System_executor::check_status error ");
  327. }
  328. }
  329. else
  330. {
  331. return Error_manager(Error_code::SYSTEM_EXECUTOR_STATUS_ERROR, Error_level::MINOR_ERROR,
  332. " System_executor::check_status error ");
  333. }
  334. }
  335. //定时发送状态信息
  336. Error_manager System_executor::encapsulate_send_status()
  337. {
  338. Error_manager t_error;
  339. int t_dispatch_manager_id = Dispatch_manager::get_instance_references().get_dispatch_manager_id();
  340. std::string t_msg;
  341. /*
  342. //创建一条 调度管理总管理的状态
  343. message::Dispatch_manager_status_msg t_dispatch_manager_status_msg;
  344. t_dispatch_manager_status_msg.mutable_base_info()->set_msg_type(message::Message_type::eDispatch_manager_status_msg);
  345. t_dispatch_manager_status_msg.mutable_base_info()->set_timeout_ms(5000);
  346. t_dispatch_manager_status_msg.mutable_base_info()->set_sender(message::Communicator::eDispatch);
  347. t_dispatch_manager_status_msg.mutable_base_info()->set_receiver(message::Communicator::eMain);
  348. t_dispatch_manager_status_msg.set_dispatch_id(t_dispatch_id);
  349. Dispatch_manager::Dispatch_manager_status t_dispatch_manager_status = Dispatch_manager::get_instance_references().get_dispatch_manager_status();
  350. t_dispatch_manager_status_msg.set_dispatch_manager_status((message::Dispatch_manager_status)t_dispatch_manager_status);
  351. t_msg = t_dispatch_manager_status_msg.SerializeAsString();
  352. System_communication::get_instance_references().encapsulate_msg(t_msg);
  353. */
  354. //创建4条 调度模块终端出入口的状态
  355. message::Dispatch_terminal_status_msg t_dispatch_terminal_status_msg;
  356. t_dispatch_terminal_status_msg.mutable_base_info()->set_msg_type(message::Message_type::eDispatch_status_msg);
  357. t_dispatch_terminal_status_msg.mutable_base_info()->set_timeout_ms(5000);
  358. t_dispatch_terminal_status_msg.mutable_base_info()->set_sender(message::Communicator::eDispatch_manager);
  359. t_dispatch_terminal_status_msg.mutable_base_info()->set_receiver(message::Communicator::eMain);
  360. t_dispatch_terminal_status_msg.set_terminal_id(t_dispatch_manager_id*2+0);
  361. t_dispatch_terminal_status_msg.set_terminal_status(message::Terminal_status::E_TERMINAL_READY);
  362. t_dispatch_terminal_status_msg.set_passageway_direction(message::Passageway_direction::E_INLET);
  363. t_msg = t_dispatch_terminal_status_msg.SerializeAsString();
  364. System_communication::get_instance_references().encapsulate_msg(t_msg);
  365. t_dispatch_terminal_status_msg.mutable_base_info()->set_msg_type(message::Message_type::eDispatch_status_msg);
  366. t_dispatch_terminal_status_msg.mutable_base_info()->set_timeout_ms(5000);
  367. t_dispatch_terminal_status_msg.mutable_base_info()->set_sender(message::Communicator::eDispatch_manager);
  368. t_dispatch_terminal_status_msg.mutable_base_info()->set_receiver(message::Communicator::eMain);
  369. t_dispatch_terminal_status_msg.set_terminal_id(t_dispatch_manager_id*2+0);
  370. t_dispatch_terminal_status_msg.set_terminal_status(message::Terminal_status::E_TERMINAL_READY);
  371. t_dispatch_terminal_status_msg.set_passageway_direction(message::Passageway_direction::E_OUTLET);
  372. t_msg = t_dispatch_terminal_status_msg.SerializeAsString();
  373. System_communication::get_instance_references().encapsulate_msg(t_msg);
  374. t_dispatch_terminal_status_msg.mutable_base_info()->set_msg_type(message::Message_type::eDispatch_status_msg);
  375. t_dispatch_terminal_status_msg.mutable_base_info()->set_timeout_ms(5000);
  376. t_dispatch_terminal_status_msg.mutable_base_info()->set_sender(message::Communicator::eDispatch_manager);
  377. t_dispatch_terminal_status_msg.mutable_base_info()->set_receiver(message::Communicator::eMain);
  378. t_dispatch_terminal_status_msg.set_terminal_id(t_dispatch_manager_id*2+1);
  379. t_dispatch_terminal_status_msg.set_terminal_status(message::Terminal_status::E_TERMINAL_READY);
  380. t_dispatch_terminal_status_msg.set_passageway_direction(message::Passageway_direction::E_INLET);
  381. t_msg = t_dispatch_terminal_status_msg.SerializeAsString();
  382. System_communication::get_instance_references().encapsulate_msg(t_msg);
  383. t_dispatch_terminal_status_msg.mutable_base_info()->set_msg_type(message::Message_type::eDispatch_status_msg);
  384. t_dispatch_terminal_status_msg.mutable_base_info()->set_timeout_ms(5000);
  385. t_dispatch_terminal_status_msg.mutable_base_info()->set_sender(message::Communicator::eDispatch_manager);
  386. t_dispatch_terminal_status_msg.mutable_base_info()->set_receiver(message::Communicator::eMain);
  387. t_dispatch_terminal_status_msg.set_terminal_id(t_dispatch_manager_id*2+1);
  388. t_dispatch_terminal_status_msg.set_terminal_status(message::Terminal_status::E_TERMINAL_READY);
  389. t_dispatch_terminal_status_msg.set_passageway_direction(message::Passageway_direction::E_OUTLET);
  390. t_msg = t_dispatch_terminal_status_msg.SerializeAsString();
  391. System_communication::get_instance_references().encapsulate_msg(t_msg);
  392. return Error_code::SUCCESS;
  393. }
  394. //定时发送 调度管理的状态
  395. Error_manager System_executor::encapsulate_send_dispatch_manager_status()
  396. {
  397. return Dispatch_manager::get_instance_references().encapsulate_send_dispatch_manager_status();
  398. }
  399. //判断是否为待机,如果已经准备好,则可以执行任务。
  400. bool System_executor::is_ready()
  401. {
  402. if ( m_system_executor_status == SYSTEM_EXECUTOR_READY && m_thread_pool.thread_is_full_load() == false )
  403. {
  404. return true;
  405. }
  406. else
  407. {
  408. return false;
  409. }
  410. }
  411. System_executor::System_executor_status System_executor::get_system_executor_status()
  412. {
  413. return m_system_executor_status;
  414. }
  415. //雷达感测定位 的处理函数
  416. //input::command_id, 消息指令id, 由主控制系统生成的唯一码
  417. //input::command_id, 终端id, 对应具体的某个车位
  418. //return::void, 没有返回, 执行结果直接生成一条答复消息, 然后通过通信返回
  419. void System_executor::execute_for_measure(std::string command_key, int terminal_id)
  420. {
  421. Error_manager t_error;
  422. LOG(INFO) << " System_executor::execute_for_measure run "<< this;
  423. //这里要处理.......以后再写
  424. //创建一条答复消息
  425. message::Measure_response_msg t_measure_response_msg;
  426. t_measure_response_msg.mutable_base_info()->set_msg_type(message::Message_type::eLocate_response_msg);
  427. t_measure_response_msg.mutable_base_info()->set_timeout_ms(5000);
  428. t_measure_response_msg.mutable_base_info()->set_sender(message::Communicator::eMeasurer);
  429. t_measure_response_msg.mutable_base_info()->set_receiver(message::Communicator::eMain);
  430. t_measure_response_msg.set_command_key(command_key);
  431. t_measure_response_msg.set_terminal_id(terminal_id);
  432. t_measure_response_msg.mutable_error_manager()->set_error_code(t_error.get_error_code());
  433. t_measure_response_msg.mutable_error_manager()->set_error_level((message::Error_level)t_error.get_error_level());
  434. t_measure_response_msg.mutable_error_manager()->set_error_description(t_error.get_error_description());
  435. t_measure_response_msg.mutable_locate_information()->set_locate_x(0);
  436. t_measure_response_msg.mutable_locate_information()->set_locate_y(0);
  437. t_measure_response_msg.mutable_locate_information()->set_locate_angle(0);
  438. t_measure_response_msg.mutable_locate_information()->set_locate_length(0);
  439. t_measure_response_msg.mutable_locate_information()->set_locate_width(0);
  440. t_measure_response_msg.mutable_locate_information()->set_locate_height(0);
  441. t_measure_response_msg.mutable_locate_information()->set_locate_wheel_base(0);
  442. t_measure_response_msg.mutable_locate_information()->set_locate_wheel_width(0);
  443. t_measure_response_msg.mutable_locate_information()->set_locate_correct(0);
  444. std::string t_msg = t_measure_response_msg.SerializeAsString();
  445. System_communication::get_instance_references().encapsulate_msg(t_msg);
  446. LOG(INFO) << " System_executor::execute_for_measure end "<< this;
  447. return ;
  448. }
  449. //调度模块的处理函数
  450. void System_executor::execute_for_dispatch(std::string command_key, Dispatch_manager::Dispatch_motion_direction dispatch_motion_direction,
  451. int terminal_id, int parkspace_id, Locate_information * p_locate_information)
  452. {
  453. Error_manager t_error;
  454. LOG(INFO) << " System_executor::execute_for_dispatch run "<< this;
  455. //这里要处理.......以后再写
  456. t_error = Dispatch_manager::get_instance_references().execute_task(dispatch_motion_direction);
  457. //创建一条答复消息
  458. message::Dispatch_response_msg t_dispatch_response_msg;
  459. t_dispatch_response_msg.mutable_base_info()->set_msg_type(message::Message_type::eDispatch_response_msg);
  460. t_dispatch_response_msg.mutable_base_info()->set_timeout_ms(5000);
  461. t_dispatch_response_msg.mutable_base_info()->set_sender(message::Communicator::eDispatch_manager);
  462. t_dispatch_response_msg.mutable_base_info()->set_receiver(message::Communicator::eMain);
  463. t_dispatch_response_msg.set_command_key(command_key);
  464. t_dispatch_response_msg.mutable_error_manager()->set_error_code(t_error.get_error_code());
  465. t_dispatch_response_msg.mutable_error_manager()->set_error_level((message::Error_level)t_error.get_error_level());
  466. t_dispatch_response_msg.mutable_error_manager()->set_error_description(t_error.get_error_description());
  467. std::string t_msg = t_dispatch_response_msg.SerializeAsString();
  468. System_communication::get_instance_references().encapsulate_msg(t_msg);
  469. std::cout << "huli test dispatch_motion_direction = " << dispatch_motion_direction << std::endl;
  470. std::cout << "huli test error = " << t_error << std::endl;
  471. LOG(INFO) << " System_executor::execute_for_dispatch end "<< this;
  472. return ;
  473. }
  474. //调度模块的处理函数
  475. void System_executor::execute_for_dispatch_request_msg(message::Dispatch_request_msg dispatch_request_msg)
  476. {
  477. Error_manager t_error;
  478. t_error = Dispatch_manager::get_instance_references().execute_for_dispatch_request_msg(dispatch_request_msg);
  479. if ( t_error != Error_code::SUCCESS )
  480. {
  481. LOG(INFO) << " System_executor::execute_for_dispatch_request_msg fun error "<< this;
  482. LOG(INFO) << t_error.to_string() << " "<< this;
  483. }
  484. return;
  485. }
  486. //调度模块 //调度总规划的答复(调度算法->调度管理)
  487. void System_executor::execute_for_dispatch_plan_response_msg(message::Dispatch_plan_response_msg dispatch_plan_response_msg)
  488. {
  489. Error_manager t_error;
  490. t_error = Dispatch_manager::get_instance_references().execute_for_dispatch_plan_response_msg(dispatch_plan_response_msg);
  491. if ( t_error != Error_code::SUCCESS )
  492. {
  493. LOG(INFO) << " System_executor::execute_for_dispatch_request_msg fun error "<< this;
  494. LOG(INFO) << t_error.to_string() << " "<< this;
  495. }
  496. return;
  497. }
  498. //调度模块 //调度控制的任务请求(调度算法->调度管理)
  499. void System_executor::execute_for_dispatch_control_request_msg(message::Dispatch_control_request_msg dispatch_control_request_msg)
  500. {
  501. Error_manager t_error;
  502. t_error = Dispatch_manager::get_instance_references().execute_for_dispatch_control_request_msg(dispatch_control_request_msg);
  503. if ( t_error != Error_code::SUCCESS )
  504. {
  505. LOG(INFO) << " System_executor::execute_for_dispatch_request_msg fun error "<< this;
  506. LOG(INFO) << t_error.to_string() << " "<< this;
  507. }
  508. return;
  509. }
  510. //地面雷达的状态消息(地面雷达->null)
  511. void System_executor::execute_for_ground_status_msg(message::Ground_status_msg ground_status_msg)
  512. {
  513. Error_manager t_error;
  514. t_error = Dispatch_manager::get_instance_references().execute_for_ground_status_msg(ground_status_msg);
  515. if ( t_error != Error_code::SUCCESS )
  516. {
  517. LOG(INFO) << " System_executor::execute_for_dispatch_request_msg fun error "<< this;
  518. LOG(INFO) << t_error.to_string() << " "<< this;
  519. }
  520. return ;
  521. }
  522. //地面雷达的状态消息(地面雷达->null)
  523. void System_executor::execute_for_terminal_status_msg(message::Terminal_status_msg terminal_status_msg)
  524. {
  525. Error_manager t_error;
  526. t_error = Dispatch_manager::get_instance_references().execute_for_singlechip_data_msg(terminal_status_msg.singlechipdata(), terminal_status_msg.singlechip_validity());
  527. if ( t_error != Error_code::SUCCESS )
  528. {
  529. LOG(INFO) << " System_executor::execute_for_singlechip_data_msg fun error "<< this;
  530. LOG(INFO) << t_error.to_string() << " "<< this;
  531. }
  532. return ;
  533. }
  534. //调度模块 ///单片机的状态消息
  535. void System_executor::execute_for_notify_status_msg(message::Notify_status_msg notify_status_msg)
  536. {
  537. Error_manager t_error;
  538. t_error = Dispatch_manager::get_instance_references().execute_for_singlechip_data_msg(notify_status_msg.singlechipdata(), notify_status_msg.singlechip_validity());
  539. if ( t_error != Error_code::SUCCESS )
  540. {
  541. LOG(INFO) << " System_executor::execute_for_singlechip_data_msg fun error "<< this;
  542. LOG(INFO) << t_error.to_string() << " "<< this;
  543. }
  544. return ;
  545. }