system_executor.cpp 23 KB

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