system_executor.cpp 24 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616
  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.mutable_id_struct()->terminal_id() == Dispatch_manager::get_instance_references().get_dispatch_manager_id()*2 ||
  97. t_ground_status_msg.mutable_id_struct()->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.id_struct().terminal_id() == Dispatch_manager::get_instance_references().get_dispatch_manager_id()*2 ||
  116. t_terminal_status_msg.id_struct().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.mutable_id_struct()->terminal_id() == Dispatch_manager::get_instance_references().get_dispatch_manager_id()*2 ||
  135. t_notify_status_msg.mutable_id_struct()->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. return Error_code::SUCCESS;
  340. int t_dispatch_manager_id = Dispatch_manager::get_instance_references().get_dispatch_manager_id();
  341. std::string t_msg;
  342. /*
  343. //创建一条 调度管理总管理的状态
  344. message::Dispatch_manager_status_msg t_dispatch_manager_status_msg;
  345. t_dispatch_manager_status_msg.mutable_base_info()->set_msg_type(message::Message_type::eDispatch_manager_status_msg);
  346. t_dispatch_manager_status_msg.mutable_base_info()->set_timeout_ms(5000);
  347. t_dispatch_manager_status_msg.mutable_base_info()->set_sender(message::Communicator::eDispatch);
  348. t_dispatch_manager_status_msg.mutable_base_info()->set_receiver(message::Communicator::eMain);
  349. t_dispatch_manager_status_msg.set_dispatch_id(t_dispatch_id);
  350. Dispatch_manager::Dispatch_manager_status t_dispatch_manager_status = Dispatch_manager::get_instance_references().get_dispatch_manager_status();
  351. t_dispatch_manager_status_msg.set_dispatch_manager_status((message::Dispatch_manager_status)t_dispatch_manager_status);
  352. t_msg = t_dispatch_manager_status_msg.SerializeAsString();
  353. System_communication::get_instance_references().encapsulate_msg(t_msg);
  354. */
  355. /*
  356. //创建4条 调度模块终端出入口的状态
  357. message::Dispatch_terminal_status_msg t_dispatch_terminal_status_msg;
  358. t_dispatch_terminal_status_msg.mutable_base_info()->set_msg_type(message::Message_type::eDispatch_status_msg);
  359. t_dispatch_terminal_status_msg.mutable_base_info()->set_timeout_ms(5000);
  360. t_dispatch_terminal_status_msg.mutable_base_info()->set_sender(message::Communicator::eDispatch_manager);
  361. t_dispatch_terminal_status_msg.mutable_base_info()->set_receiver(message::Communicator::eMain);
  362. t_dispatch_terminal_status_msg.set_terminal_id(t_dispatch_manager_id*2+0);
  363. t_dispatch_terminal_status_msg.set_terminal_status(message::Terminal_status::E_TERMINAL_READY);
  364. t_dispatch_terminal_status_msg.set_passageway_direction(message::Passageway_direction::E_INLET);
  365. t_msg = t_dispatch_terminal_status_msg.SerializeAsString();
  366. System_communication::get_instance_references().encapsulate_msg(t_msg);
  367. t_dispatch_terminal_status_msg.mutable_base_info()->set_msg_type(message::Message_type::eDispatch_status_msg);
  368. t_dispatch_terminal_status_msg.mutable_base_info()->set_timeout_ms(5000);
  369. t_dispatch_terminal_status_msg.mutable_base_info()->set_sender(message::Communicator::eDispatch_manager);
  370. t_dispatch_terminal_status_msg.mutable_base_info()->set_receiver(message::Communicator::eMain);
  371. t_dispatch_terminal_status_msg.set_terminal_id(t_dispatch_manager_id*2+0);
  372. t_dispatch_terminal_status_msg.set_terminal_status(message::Terminal_status::E_TERMINAL_READY);
  373. t_dispatch_terminal_status_msg.set_passageway_direction(message::Passageway_direction::E_OUTLET);
  374. t_msg = t_dispatch_terminal_status_msg.SerializeAsString();
  375. System_communication::get_instance_references().encapsulate_msg(t_msg);
  376. t_dispatch_terminal_status_msg.mutable_base_info()->set_msg_type(message::Message_type::eDispatch_status_msg);
  377. t_dispatch_terminal_status_msg.mutable_base_info()->set_timeout_ms(5000);
  378. t_dispatch_terminal_status_msg.mutable_base_info()->set_sender(message::Communicator::eDispatch_manager);
  379. t_dispatch_terminal_status_msg.mutable_base_info()->set_receiver(message::Communicator::eMain);
  380. t_dispatch_terminal_status_msg.set_terminal_id(t_dispatch_manager_id*2+1);
  381. t_dispatch_terminal_status_msg.set_terminal_status(message::Terminal_status::E_TERMINAL_READY);
  382. t_dispatch_terminal_status_msg.set_passageway_direction(message::Passageway_direction::E_INLET);
  383. t_msg = t_dispatch_terminal_status_msg.SerializeAsString();
  384. System_communication::get_instance_references().encapsulate_msg(t_msg);
  385. t_dispatch_terminal_status_msg.mutable_base_info()->set_msg_type(message::Message_type::eDispatch_status_msg);
  386. t_dispatch_terminal_status_msg.mutable_base_info()->set_timeout_ms(5000);
  387. t_dispatch_terminal_status_msg.mutable_base_info()->set_sender(message::Communicator::eDispatch_manager);
  388. t_dispatch_terminal_status_msg.mutable_base_info()->set_receiver(message::Communicator::eMain);
  389. t_dispatch_terminal_status_msg.set_terminal_id(t_dispatch_manager_id*2+1);
  390. t_dispatch_terminal_status_msg.set_terminal_status(message::Terminal_status::E_TERMINAL_READY);
  391. t_dispatch_terminal_status_msg.set_passageway_direction(message::Passageway_direction::E_OUTLET);
  392. t_msg = t_dispatch_terminal_status_msg.SerializeAsString();
  393. System_communication::get_instance_references().encapsulate_msg(t_msg);
  394. */
  395. return Error_code::SUCCESS;
  396. }
  397. //定时发送 调度管理的状态
  398. Error_manager System_executor::encapsulate_send_dispatch_manager_status()
  399. {
  400. return Dispatch_manager::get_instance_references().encapsulate_send_dispatch_manager_status();
  401. }
  402. //判断是否为待机,如果已经准备好,则可以执行任务。
  403. bool System_executor::is_ready()
  404. {
  405. if ( m_system_executor_status == SYSTEM_EXECUTOR_READY && m_thread_pool.thread_is_full_load() == false )
  406. {
  407. return true;
  408. }
  409. else
  410. {
  411. return false;
  412. }
  413. }
  414. System_executor::System_executor_status System_executor::get_system_executor_status()
  415. {
  416. return m_system_executor_status;
  417. }
  418. //雷达感测定位 的处理函数
  419. //input::command_id, 消息指令id, 由主控制系统生成的唯一码
  420. //input::command_id, 终端id, 对应具体的某个车位
  421. //return::void, 没有返回, 执行结果直接生成一条答复消息, 然后通过通信返回
  422. void System_executor::execute_for_measure(std::string command_key, int unit_id, int terminal_id)
  423. {
  424. Error_manager t_error;
  425. LOG(INFO) << " System_executor::execute_for_measure run "<< this;
  426. //这里要处理.......以后再写
  427. //创建一条答复消息
  428. message::Measure_response_msg t_measure_response_msg;
  429. t_measure_response_msg.mutable_base_info()->set_msg_type(message::Message_type::eLocate_response_msg);
  430. t_measure_response_msg.mutable_base_info()->set_timeout_ms(5000);
  431. t_measure_response_msg.mutable_base_info()->set_sender(message::Communicator::eMeasurer);
  432. t_measure_response_msg.mutable_base_info()->set_receiver(message::Communicator::eMain);
  433. t_measure_response_msg.set_command_key(command_key);
  434. t_measure_response_msg.mutable_id_struct()->set_unit_id(unit_id);
  435. t_measure_response_msg.mutable_id_struct()->set_terminal_id(terminal_id);
  436. t_measure_response_msg.mutable_error_manager()->set_error_code(t_error.get_error_code());
  437. t_measure_response_msg.mutable_error_manager()->set_error_level((message::Error_level)t_error.get_error_level());
  438. t_measure_response_msg.mutable_error_manager()->set_error_description(t_error.get_error_description());
  439. t_measure_response_msg.mutable_locate_information()->set_locate_x(0);
  440. t_measure_response_msg.mutable_locate_information()->set_locate_y(0);
  441. t_measure_response_msg.mutable_locate_information()->set_locate_angle(0);
  442. t_measure_response_msg.mutable_locate_information()->set_locate_length(0);
  443. t_measure_response_msg.mutable_locate_information()->set_locate_width(0);
  444. t_measure_response_msg.mutable_locate_information()->set_locate_height(0);
  445. t_measure_response_msg.mutable_locate_information()->set_locate_wheel_base(0);
  446. t_measure_response_msg.mutable_locate_information()->set_locate_wheel_width(0);
  447. t_measure_response_msg.mutable_locate_information()->set_locate_correct(0);
  448. std::string t_msg = t_measure_response_msg.SerializeAsString();
  449. System_communication::get_instance_references().encapsulate_msg(t_msg);
  450. LOG(INFO) << " System_executor::execute_for_measure end "<< this;
  451. return ;
  452. }
  453. //调度模块的处理函数
  454. void System_executor::execute_for_dispatch(std::string command_key, Dispatch_manager::Dispatch_motion_direction dispatch_motion_direction,
  455. int terminal_id, int parkspace_id, Locate_information * p_locate_information)
  456. {
  457. Error_manager t_error;
  458. LOG(INFO) << " System_executor::execute_for_dispatch run "<< this;
  459. //这里要处理.......以后再写
  460. t_error = Dispatch_manager::get_instance_references().execute_task(dispatch_motion_direction);
  461. //创建一条答复消息
  462. message::Dispatch_response_msg t_dispatch_response_msg;
  463. t_dispatch_response_msg.mutable_base_info()->set_msg_type(message::Message_type::eDispatch_response_msg);
  464. t_dispatch_response_msg.mutable_base_info()->set_timeout_ms(5000);
  465. t_dispatch_response_msg.mutable_base_info()->set_sender(message::Communicator::eDispatch_manager);
  466. t_dispatch_response_msg.mutable_base_info()->set_receiver(message::Communicator::eMain);
  467. t_dispatch_response_msg.set_command_key(command_key);
  468. t_dispatch_response_msg.mutable_error_manager()->set_error_code(t_error.get_error_code());
  469. t_dispatch_response_msg.mutable_error_manager()->set_error_level((message::Error_level)t_error.get_error_level());
  470. t_dispatch_response_msg.mutable_error_manager()->set_error_description(t_error.get_error_description());
  471. std::string t_msg = t_dispatch_response_msg.SerializeAsString();
  472. System_communication::get_instance_references().encapsulate_msg(t_msg);
  473. std::cout << "huli test dispatch_motion_direction = " << dispatch_motion_direction << std::endl;
  474. std::cout << "huli test error = " << t_error << std::endl;
  475. LOG(INFO) << " System_executor::execute_for_dispatch end "<< this;
  476. return ;
  477. }
  478. //调度模块的处理函数
  479. void System_executor::execute_for_dispatch_request_msg(message::Dispatch_request_msg dispatch_request_msg)
  480. {
  481. Error_manager t_error;
  482. t_error = Dispatch_manager::get_instance_references().execute_for_dispatch_request_msg(dispatch_request_msg);
  483. if ( t_error != Error_code::SUCCESS )
  484. {
  485. LOG(INFO) << " System_executor::execute_for_dispatch_request_msg fun error "<< this;
  486. LOG(INFO) << t_error.to_string() << " "<< this;
  487. }
  488. return;
  489. }
  490. //调度模块 //调度总规划的答复(调度算法->调度管理)
  491. void System_executor::execute_for_dispatch_plan_response_msg(message::Dispatch_plan_response_msg dispatch_plan_response_msg)
  492. {
  493. Error_manager t_error;
  494. t_error = Dispatch_manager::get_instance_references().execute_for_dispatch_plan_response_msg(dispatch_plan_response_msg);
  495. if ( t_error != Error_code::SUCCESS )
  496. {
  497. LOG(INFO) << " System_executor::execute_for_dispatch_request_msg fun error "<< this;
  498. LOG(INFO) << t_error.to_string() << " "<< this;
  499. }
  500. return;
  501. }
  502. //调度模块 //调度控制的任务请求(调度算法->调度管理)
  503. void System_executor::execute_for_dispatch_control_request_msg(message::Dispatch_control_request_msg dispatch_control_request_msg)
  504. {
  505. Error_manager t_error;
  506. t_error = Dispatch_manager::get_instance_references().execute_for_dispatch_control_request_msg(dispatch_control_request_msg);
  507. if ( t_error != Error_code::SUCCESS )
  508. {
  509. LOG(INFO) << " System_executor::execute_for_dispatch_request_msg fun error "<< this;
  510. LOG(INFO) << t_error.to_string() << " "<< this;
  511. }
  512. return;
  513. }
  514. //地面雷达的状态消息(地面雷达->null)
  515. void System_executor::execute_for_ground_status_msg(message::Ground_status_msg ground_status_msg)
  516. {
  517. Error_manager t_error;
  518. t_error = Dispatch_manager::get_instance_references().execute_for_ground_status_msg(ground_status_msg);
  519. if ( t_error != Error_code::SUCCESS )
  520. {
  521. LOG(INFO) << " System_executor::execute_for_dispatch_request_msg fun error "<< this;
  522. LOG(INFO) << t_error.to_string() << " "<< this;
  523. }
  524. return ;
  525. }
  526. //地面雷达的状态消息(地面雷达->null)
  527. void System_executor::execute_for_terminal_status_msg(message::Terminal_status_msg terminal_status_msg)
  528. {
  529. Error_manager t_error;
  530. t_error = Dispatch_manager::get_instance_references().execute_for_singlechip_data_msg(terminal_status_msg.singlechipdata(), terminal_status_msg.singlechip_validity());
  531. if ( t_error != Error_code::SUCCESS )
  532. {
  533. LOG(INFO) << " System_executor::execute_for_singlechip_data_msg fun error "<< this;
  534. LOG(INFO) << t_error.to_string() << " "<< this;
  535. }
  536. return ;
  537. }
  538. //调度模块 ///单片机的状态消息
  539. void System_executor::execute_for_notify_status_msg(message::Notify_status_msg notify_status_msg)
  540. {
  541. // LOG(INFO) << "notify_status_msg = " << notify_status_msg.DebugString()<< this;
  542. Error_manager t_error;
  543. t_error = Dispatch_manager::get_instance_references().execute_for_singlechip_data_msg(notify_status_msg.singlechipdata(), notify_status_msg.singlechip_validity());
  544. if ( t_error != Error_code::SUCCESS )
  545. {
  546. LOG(INFO) << " System_executor::execute_for_singlechip_data_msg fun error "<< this;
  547. LOG(INFO) << t_error.to_string() << " "<< this;
  548. }
  549. return ;
  550. }