StoreProcessTask.cpp 26 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697
  1. //
  2. // Created by zx on 2020/7/7.
  3. //
  4. #include <parkspace_excutor.h>
  5. #include <dispatch_message.pb.h>
  6. #include "dispatch_excutor.h"
  7. #include "StoreProcessTask.h"
  8. #include "process_message.pb.h"
  9. #include "command_manager.h"
  10. #include "command_accepter.h"
  11. #include "exception_solver.h"
  12. #include "uniq_key.h"
  13. StoreProcessTask::StoreProcessTask(unsigned int terminor_id,message::Car_info car_info)
  14. :Process_task(terminor_id,car_info)
  15. {
  16. }
  17. StoreProcessTask::~StoreProcessTask()
  18. {
  19. }
  20. Error_manager StoreProcessTask::init_task(message::Locate_information locate_info)
  21. {
  22. reset_msg();
  23. m_locate_info=locate_info;
  24. //初始化进度状态消息基本信息
  25. message::Base_info base_info;
  26. base_info.set_msg_type(message::eStoring_process_statu_msg);
  27. base_info.set_sender(message::eMain);
  28. base_info.set_receiver(message::eEmpty);
  29. m_process_msg.mutable_base_info()->CopyFrom(base_info);
  30. m_process_msg.set_terminal_id(m_terminor_id);
  31. m_process_msg.set_license(m_car_info.license());
  32. m_current_step_type=message::eAlloc_step;
  33. ///创建状态发布线程
  34. if(m_publish_statu_thread== nullptr)
  35. {
  36. m_publish_exit_condition.reset(false, false, false);
  37. m_publish_statu_thread=new std::thread(publish_thread_func,this);
  38. }
  39. return SUCCESS;
  40. }
  41. Error_manager StoreProcessTask::locate_step() {
  42. Error_manager code;
  43. //检查测量模块状态
  44. code=Measure_excutor::get_instance_pointer()->check_statu(m_terminor_id);
  45. if(code!=SUCCESS)
  46. return code;
  47. message::Base_info base_info;
  48. base_info.set_msg_type(message::eLocate_request_msg);
  49. base_info.set_sender(message::eMain);
  50. base_info.set_receiver(message::eMeasurer);
  51. base_info.set_timeout_ms(20000); //测量超时5s
  52. m_measure_request_msg.mutable_base_info()->CopyFrom(base_info);
  53. m_measure_request_msg.set_terminal_id(m_terminor_id);
  54. code=Measure_excutor::get_instance_pointer()->locate_request(m_measure_request_msg,
  55. m_measure_response_msg,m_cancel_condition);
  56. if(code!=SUCCESS)
  57. return code;
  58. if(m_measure_response_msg.error_manager().error_code()==0) {
  59. return SUCCESS;
  60. }
  61. else {
  62. Error_code t_code=(Error_code)m_measure_response_msg.error_manager().error_code();
  63. Error_level t_level=(Error_level)m_measure_response_msg.error_manager().error_level();
  64. return Error_manager(t_code, t_level, m_measure_response_msg.error_manager().error_description().c_str());
  65. }
  66. }
  67. /*
  68. * 回退定位
  69. */
  70. Error_manager StoreProcessTask::back_locate_step()
  71. {
  72. m_measure_request_msg=message::Measure_request_msg();
  73. m_measure_response_msg=message::Measure_response_msg();
  74. return SUCCESS;
  75. }
  76. /*
  77. * 检验结果
  78. */
  79. Error_manager StoreProcessTask::compare_step()
  80. {
  81. return SUCCESS;
  82. }
  83. /*
  84. * 回退检验
  85. */
  86. Error_manager StoreProcessTask::back_compare_step()
  87. {
  88. return SUCCESS;
  89. }
  90. /*
  91. * 调度
  92. */
  93. Error_manager StoreProcessTask::dispatch_step()
  94. {
  95. Error_manager code;
  96. /*
  97. * 判断调度所需的数据是否都正常
  98. */
  99. //1,测量信息是否存在
  100. if(m_measure_response_msg.has_base_info()== false
  101. ||m_measure_response_msg.has_locate_information()==false
  102. ||m_parcspace_alloc_response_msg.has_base_info()== false
  103. ||m_parcspace_alloc_response_msg.has_allocated_space_info()==false)
  104. {
  105. return Error_manager(ERROR,MAJOR_ERROR,"调度所需的前置数据(测量,车位)不存在");
  106. }
  107. //2,判断调度节点状态
  108. code=Dispatch_excutor::get_instance_pointer()->check_entrance_statu(m_terminor_id);
  109. if(code!=SUCCESS)
  110. return code;
  111. message::Base_info base_info;
  112. base_info.set_msg_type(message::eDispatch_request_msg);
  113. base_info.set_sender(message::eMain);
  114. base_info.set_receiver(message::eDispatch);
  115. base_info.set_timeout_ms(1000*15); //超时15s
  116. m_dispatch_request_msg.mutable_base_info()->CopyFrom(base_info);
  117. m_dispatch_request_msg.set_terminal_id(m_terminor_id);
  118. m_dispatch_request_msg.set_dispatch_motion_direction(message::E_STORE_CAR);
  119. m_dispatch_request_msg.set_parkspace_id(m_parcspace_alloc_response_msg.allocated_space_info().parkspace_id());
  120. code=Dispatch_excutor::get_instance_pointer()->dispatch_request(m_dispatch_request_msg,
  121. m_dispatch_response_msg,m_cancel_condition);
  122. if(code!=SUCCESS)
  123. return code;
  124. if(m_dispatch_response_msg.error_manager().error_code()==0) {
  125. return SUCCESS;
  126. }
  127. else
  128. {
  129. Error_code t_code=(Error_code)m_dispatch_response_msg.error_manager().error_code();
  130. Error_level t_level=(Error_level)m_dispatch_response_msg.error_manager().error_level();
  131. return Error_manager(t_code,t_level,"dispatch response error_code error");
  132. }
  133. }
  134. /*
  135. * 回退调度
  136. */
  137. Error_manager StoreProcessTask::back_dispatch_step()
  138. {
  139. //reset 调度请求数据
  140. m_dispatch_request_msg=message::Dispatch_request_msg();
  141. m_dispatch_response_msg=message::Dispatch_response_msg();
  142. return SUCCESS;
  143. }
  144. /*
  145. * 分配车位
  146. */
  147. Error_manager StoreProcessTask::alloc_space_step()
  148. {
  149. message::Base_info base_info_response;
  150. base_info_response.set_msg_type(message::eStore_command_response_msg);
  151. base_info_response.set_sender(message::eMain);
  152. base_info_response.set_receiver(message::eTerminor);
  153. m_command_response_msg.mutable_base_info()->CopyFrom(base_info_response);
  154. m_command_response_msg.set_terminal_id(m_terminor_id);
  155. if(Command_manager::get_instance_pointer()->is_paused()==true)
  156. {
  157. return Error_manager(PAUSE, MINOR_ERROR, "系统已急停");
  158. }
  159. //
  160. message::Entrance_statu statu=Command_manager::get_instance_pointer()->entrance_statu(m_terminor_id);
  161. if(statu.has_paused()==false) {
  162. return Error_manager(ERROR, MINOR_ERROR, "入口已禁止使用 Disable");
  163. }
  164. if(statu.paused()==true)
  165. {
  166. return Error_manager(ERROR, MINOR_ERROR, "入口已禁止使用 Disable");
  167. }
  168. /*
  169. * 检查是否有测量数据
  170. */
  171. if(m_locate_info.has_locate_height()==false||m_locate_info.has_locate_width()==false)
  172. {
  173. return Error_manager(FAILED,MINOR_ERROR,"停车请求缺少车辆高度和宽度信息");
  174. }
  175. /*
  176. * 检查车位管理模块是否正常
  177. */
  178. Error_manager code=Parkspace_excutor::get_instance_pointer()->check_statu();
  179. if(code!=SUCCESS)
  180. {
  181. return code;
  182. }
  183. //发送分配请求
  184. message::Base_info base_info_request;
  185. base_info_request.set_msg_type(message::eParkspace_allocation_request_msg);
  186. base_info_request.set_sender(message::eMain);
  187. base_info_request.set_receiver(message::eParkspace);
  188. base_info_request.set_timeout_ms(5000); //超时1s
  189. m_alloc_request_msg.mutable_base_info()->CopyFrom(base_info_request);
  190. m_alloc_request_msg.mutable_car_info()->CopyFrom(m_car_info);
  191. m_alloc_request_msg.set_terminal_id(m_terminor_id);
  192. code=Parkspace_excutor::get_instance_pointer()->alloc_request(m_alloc_request_msg,
  193. m_parcspace_alloc_response_msg,m_cancel_condition);
  194. if(code!=SUCCESS)
  195. {
  196. return code;
  197. }
  198. if(m_parcspace_alloc_response_msg.error_manager().error_code()==0)
  199. {
  200. message::Car_info alloc_car_info=m_parcspace_alloc_response_msg.allocated_space_info().car_info();
  201. if(alloc_car_info.license()!=m_car_info.license())
  202. {
  203. return Error_manager(ERROR,MINOR_ERROR,"分配车位反馈的车辆信息不匹配");
  204. }
  205. return SUCCESS;
  206. }
  207. else
  208. {
  209. Error_code t_code=(Error_code)m_parcspace_alloc_response_msg.error_manager().error_code();
  210. Error_level t_level=(Error_level)m_parcspace_alloc_response_msg.error_manager().error_level();
  211. std::string description=m_parcspace_alloc_response_msg.error_manager().error_description();
  212. return Error_manager(t_code,t_level,description);
  213. }
  214. }
  215. /*
  216. * 车位占用确认
  217. */
  218. Error_manager StoreProcessTask::confirm_space_step()
  219. {
  220. /*
  221. * 检查车位管理模块是否正常
  222. */
  223. Error_manager code=Parkspace_excutor::get_instance_pointer()->check_statu();
  224. if(code!=SUCCESS)
  225. return code;
  226. message::Parkspace_confirm_alloc_request_msg request;
  227. message::Base_info base_info;
  228. base_info.set_msg_type(message::eParkspace_confirm_alloc_request_msg);
  229. base_info.set_sender(message::eMain);
  230. base_info.set_receiver(message::eParkspace);
  231. base_info.set_timeout_ms(5000); //测量超时1s
  232. request.mutable_base_info()->CopyFrom(base_info);
  233. message::Parkspace_info space_info=m_parcspace_alloc_response_msg.allocated_space_info();
  234. request.mutable_confirm_space_info()->CopyFrom(space_info);
  235. request.set_command_key(create_key());
  236. message::Parkspace_confirm_alloc_response_msg confirm_response;
  237. code=Parkspace_excutor::get_instance_pointer()->confirm_request(request,confirm_response,m_cancel_condition);
  238. if(code!=SUCCESS)
  239. return code;
  240. if(m_parcspace_alloc_response_msg.allocated_space_info().parkspace_id()!=
  241. confirm_response.confirm_alloc_space_info().parkspace_id())
  242. {
  243. return Error_manager(ERROR,MINOR_ERROR,"占用车位与分配车位不一致");
  244. }
  245. if(confirm_response.error_manager().error_code()==0) {
  246. /*LOG(INFO)<<"停车流程正常,确认占用车位成功,停车终端:"<<m_terminor_id
  247. <<", 指令id:"<<m_command_info.place()+m_command_info.time()
  248. <<", 车位楼层:"<<confirm_response.confirm_alloc_space_info().floor()
  249. <<", 车位序号:"<<confirm_response.confirm_alloc_space_info().index()
  250. <<", 车牌号:"<<confirm_response.confirm_alloc_space_info().car_info().license();*/
  251. return SUCCESS;
  252. }
  253. else
  254. {
  255. Error_code t_code=(Error_code)confirm_response.error_manager().error_code();
  256. Error_level t_level=(Error_level)confirm_response.error_manager().error_level();
  257. return Error_manager(t_code,t_level,"parkspace confirm response error_code error");
  258. }
  259. }
  260. /*
  261. * 回退车位分配
  262. */
  263. Error_manager StoreProcessTask::back_alloc_space_step()
  264. {
  265. /*
  266. * 检查是否曾经分配过车位
  267. */
  268. if(m_parcspace_alloc_response_msg.has_allocated_space_info()==false)
  269. {
  270. return Error_manager(FAILED,MAJOR_ERROR," parkspace release request without space info");
  271. }
  272. /*
  273. * 检查车位管理模块是否正常
  274. */
  275. Error_manager code=Parkspace_excutor::get_instance_pointer()->check_statu();
  276. if(code!=SUCCESS)
  277. return Error_manager(code.get_error_code(),MAJOR_ERROR,code.get_error_description());
  278. message::Parkspace_release_request_msg request;
  279. message::Base_info base_info;
  280. base_info.set_msg_type(message::eParkspace_release_request_msg);
  281. base_info.set_sender(message::eMain);
  282. base_info.set_receiver(message::eParkspace);
  283. base_info.set_timeout_ms(5000); //测量超时1s
  284. request.mutable_base_info()->CopyFrom(base_info);
  285. message::Parkspace_info space_info=m_parcspace_alloc_response_msg.allocated_space_info();
  286. request.mutable_release_space_info()->CopyFrom(space_info);
  287. message::Parkspace_release_response_msg release_response;
  288. code=Parkspace_excutor::get_instance_pointer()->release_request(request,release_response,m_cancel_condition);
  289. if(code!=SUCCESS)
  290. return Error_manager(code.get_error_code(),MAJOR_ERROR,code.get_error_description());
  291. if(release_response.error_manager().error_code()==0) {
  292. /*LOG(WARNING)<<"停车流程异常,释放车位成功,停车终端:"<<m_terminor_id
  293. <<", 指令id:"<<m_command_info.place()+m_command_info.time()
  294. <<", 车位楼层:"<<m_parcspace_alloc_response_msg.allocated_space_info().floor()
  295. <<", 车位序号:"<<m_parcspace_alloc_response_msg.allocated_space_info().index()
  296. <<", 车牌号:"<<m_parcspace_alloc_response_msg.allocated_space_info().car_info().license();*/
  297. m_alloc_request_msg=message::Parkspace_allocation_request_msg();
  298. m_parcspace_alloc_response_msg=message::Parkspace_allocation_response_msg();
  299. return SUCCESS;
  300. }
  301. else
  302. {
  303. Error_code t_code=(Error_code)release_response.error_manager().error_code();
  304. Error_level t_level=(Error_level)release_response.error_manager().error_level();
  305. return Error_manager(t_code,MAJOR_ERROR,"back alloc response error_code error");
  306. }
  307. }
  308. /*
  309. * 控制流程到下一步
  310. */
  311. Error_manager StoreProcessTask::next_step()
  312. {
  313. if(m_current_step_statu==message::eWaiting || m_current_step_statu== message::eWorking)
  314. return Error_manager(ERROR,MINOR_ERROR,"当前步骤还未开始或者正在执行中,禁止改变步骤类型");
  315. switch (m_current_step_type)
  316. {
  317. case message::eAlloc_step:
  318. m_current_step_type=(m_current_step_statu==message::eFinished)?message::eMeasure_step:message::eBackComplete;
  319. break;
  320. case message::eMeasure_step:
  321. m_current_step_type=(m_current_step_statu==message::eFinished)?message::eCompare_step:message::eBackAlloc_step;
  322. break;
  323. case message::eCompare_step:
  324. m_current_step_type=(m_current_step_statu==message::eFinished)?message::eDispatch_step:message::eBackMeasure_step;
  325. break;
  326. case message::eDispatch_step:
  327. m_current_step_type=(m_current_step_statu==message::eFinished)?message::eConfirm_step:message::eBack_compare_step;
  328. break;
  329. case message::eConfirm_step:
  330. m_current_step_type=(m_current_step_statu==message::eFinished)?message::eComplete:message::eBackDispatch_step;
  331. break;
  332. case message::eComplete:
  333. break;
  334. case message::eBackDispatch_step:
  335. m_current_step_type=message::eBack_compare_step;
  336. break;
  337. case message::eBack_compare_step:
  338. m_current_step_type=message::eBackMeasure_step;
  339. break;
  340. case message::eBackMeasure_step:
  341. m_current_step_type=message::eBackAlloc_step;
  342. break;
  343. case message::eBackAlloc_step:
  344. m_current_step_type=message::eBackComplete;
  345. break;
  346. case message::eBackComplete:
  347. break;
  348. }
  349. return SUCCESS;
  350. }
  351. /*
  352. * 流程函数
  353. */
  354. void StoreProcessTask::Main()
  355. {
  356. /*
  357. * 外部已经分配好车位,进入到此流程说明车位已经分配好, 存放在 m_parcspace_alloc_response_msg
  358. */
  359. Error_manager code;
  360. //开始执行停车指令
  361. while(is_canceled()==false)
  362. {
  363. //分配车位
  364. if(m_current_step_type == message::eAlloc_step)
  365. {
  366. updata_step_statu(message::eWorking);
  367. code=alloc_space_step();
  368. //发送反馈
  369. message::Error_manager error_msg;
  370. error_msg.set_error_code(code.get_error_code());
  371. error_msg.set_error_description(code.get_error_description());
  372. m_command_response_msg.mutable_code()->CopyFrom(error_msg);
  373. Communication_message msg;
  374. msg.reset(m_command_response_msg.base_info(),m_command_response_msg.SerializeAsString());
  375. Message_communicator::get_instance_pointer()->send_msg(&msg);
  376. LOG_IF(WARNING, code != SUCCESS) << "------ 停 ------- 分配失败:" <<m_car_info.license()<< code.get_error_description();
  377. }
  378. //测量
  379. if (m_current_step_type == message::eMeasure_step)
  380. {
  381. //开始定位
  382. updata_step_statu(message::eWorking);
  383. code = locate_step();
  384. usleep(1000 * 500 );
  385. LOG_IF(WARNING, code != SUCCESS) << "------ 停 ------- 测量失败:" <<m_car_info.license()<< code.get_error_description();
  386. }
  387. if(m_current_step_type== message::eCompare_step)
  388. {
  389. updata_step_statu(message::eWorking);
  390. code=compare_step();
  391. usleep(500*1000);
  392. LOG_IF(WARNING, code != SUCCESS) << "------ 停 ------- 检验失败:"<<m_car_info.license() << code.get_error_description();
  393. }
  394. //调度
  395. if (m_current_step_type == message::eDispatch_step)
  396. {
  397. //开始调度
  398. updata_step_statu(message::eWorking);
  399. code = dispatch_step();
  400. usleep(1000 * 500 );
  401. LOG_IF(WARNING, code != SUCCESS) << "------ 停 ------- 调度失败:"<<m_car_info.license() << code.get_error_description();
  402. }
  403. //占据车位
  404. if (m_current_step_type == message::eConfirm_step)
  405. {
  406. updata_step_statu(message::eWorking);
  407. code = confirm_space_step();
  408. usleep(1000 * 200);
  409. LOG_IF(WARNING, code != SUCCESS) << "------ 停 ------- 占据车位失败,终端号:" << m_terminor_id << "停车流程:" << code.get_error_description() <<
  410. " 车位id :"
  411. << m_parcspace_alloc_response_msg.allocated_space_info().parkspace_id()
  412. << ",车牌:" << m_car_info.license()<<code.to_string();
  413. }
  414. //完成,退出循环
  415. if (m_current_step_type == message::eComplete)
  416. {
  417. //流程结束前,保证至少发送一次流程完成状态
  418. updata_step_statu(message::eFinished);
  419. break;
  420. }
  421. //回退confirm ------------------------------------华丽的分割线------------------------------------------
  422. if (m_current_step_type == message::eBackConfirm_step)
  423. {
  424. updata_step_statu(message::eWorking);
  425. usleep(1000*200);
  426. updata_step_statu(message::eFinished);
  427. }
  428. if(m_current_step_type== message::eBackDispatch_step)
  429. {
  430. updata_step_statu(message::eWorking);
  431. code=back_dispatch_step();
  432. usleep(1000*500);
  433. LOG_IF(WARNING,code!=SUCCESS)<<" ------ 停 ------- 回退调度失败 ------进入异常处理, 车牌号:"
  434. <<m_car_info.license();
  435. }
  436. if(m_current_step_type== message::eBack_compare_step)
  437. {
  438. updata_step_statu(message::eWorking);
  439. code=back_compare_step();
  440. usleep(1000*200);
  441. LOG_IF(WARNING,code!=SUCCESS)<<" ------ 停 ------- 回退对比失败 ------进入异常处理, 车牌号:"<<m_car_info.license();
  442. LOG(WARNING)<<" 手动处理 结果对比, 继续 ..........车牌:"<<m_car_info.license();
  443. }
  444. if(m_current_step_type== message::eBackMeasure_step)
  445. {
  446. updata_step_statu(message::eWorking);
  447. code=back_locate_step();
  448. usleep(1000*200);
  449. LOG_IF(WARNING,code!=SUCCESS)
  450. <<" ------ 停 ------- 回退测量失败 ------进入异常处理, 车牌号:"<<m_car_info.license();
  451. }
  452. if(m_current_step_type== message::eBackAlloc_step)
  453. {
  454. updata_step_statu(message::eWorking);
  455. code=back_alloc_space_step();
  456. LOG_IF(WARNING,code!=SUCCESS)
  457. <<" ------ 停 ------- 回退分配车位失败 ------进入异常处理, 车牌号:"<<m_car_info.license();
  458. }
  459. if(m_current_step_type== message::eBackComplete)
  460. {
  461. break;
  462. }
  463. //异常处理
  464. if(code!=SUCCESS)
  465. {
  466. //处理异常
  467. code=Exception_solver::get_instance_pointer()->solve_exception(code, this);
  468. //根据处理结果更新步骤状态
  469. }
  470. else
  471. {
  472. //本次步骤正常,切换步骤类型,进入下一步,否则不修改步骤类型,再次执行本次步骤
  473. updata_step_statu(message::eFinished);
  474. next_step();
  475. }
  476. }
  477. /*
  478. * 跳出循环后,判断状态,是否正常结束, 循环跳出状态只有可能是 eBackComplete(异常结束),eComplete(正常结束),任务取消状态
  479. */
  480. updata_step_statu(message::eFinished);
  481. publish_step_status();
  482. if(m_cancel_condition.wait_for_millisecond(1)==true) {
  483. LOG(ERROR) << "------ 停 ------- 停车任务被强制取消,车牌号:" << m_car_info.license()
  484. << ", 终端号:" << m_terminor_id;
  485. usleep(1000*200);
  486. return ;
  487. }
  488. if(m_current_step_type== message::eBackComplete)
  489. {
  490. //异常结束
  491. usleep(1000*200);
  492. LOG(WARNING)<<"------ 停 ------- 异常停车,回退结束"<<"车牌号:"<<m_car_info.license()
  493. <<",xxxxxxxxxxxxxx 终端:"<<m_terminor_id<<" xxxxxxxxxxxxxx";
  494. }
  495. if(m_current_step_type== message::eComplete)
  496. {
  497. //正常结束
  498. usleep(1000*200);
  499. LOG(INFO)<<"------ 停 ------- 停车结束,"<<"车牌号:"<<m_car_info.license()
  500. <<",-------------- 终端:"<<m_terminor_id<<" --------------";
  501. }
  502. }
  503. void StoreProcessTask::publish_step_status() {
  504. /*
  505. * 通过communicator 发布状态
  506. */
  507. if (Command_accepter::get_instance_pointer()) {
  508. std::lock_guard<std::mutex> lock(m_process_msg_lock);
  509. Command_accepter::get_instance_pointer()->post_process_statu(m_process_msg);
  510. }
  511. }
  512. /*
  513. * 根据当前流程状态,并修改状态消息
  514. */
  515. void StoreProcessTask::updata_step_statu(message::Step_statu statu)
  516. {
  517. m_current_step_statu=statu;
  518. std::lock_guard<std::mutex> lock(m_process_msg_lock);
  519. switch (m_current_step_type) {
  520. case message::eAlloc_step: {
  521. message::Alloc_space_step_statu alloc_step_statu;
  522. alloc_step_statu.set_step_statu(statu);
  523. m_process_msg.mutable_alloc_space_step()->CopyFrom(alloc_step_statu);
  524. break;
  525. }
  526. case message::eMeasure_step: {
  527. message::Measure_step_statu measure_step_statu;
  528. measure_step_statu.set_step_statu(statu);
  529. measure_step_statu.mutable_locate_info()->CopyFrom(m_locate_info);
  530. m_process_msg.mutable_measure_step()->CopyFrom(measure_step_statu);
  531. break;
  532. }
  533. case message::eCompare_step:{
  534. message::Compare_step_statu compare_step;
  535. compare_step.mutable_locate_info_wj()->CopyFrom(m_locate_info);
  536. compare_step.mutable_locate_info_dj()->CopyFrom(m_measure_response_msg.locate_information());
  537. compare_step.mutable_locate_info_result()->CopyFrom(m_compare_location_data);
  538. compare_step.set_step_statu(statu);
  539. m_process_msg.mutable_compare_step()->CopyFrom(compare_step);
  540. break;
  541. }
  542. case message::eDispatch_step: {
  543. message::Dispatch_store_step_statu dispatch_step_statu;
  544. dispatch_step_statu.set_step_statu(statu);
  545. dispatch_step_statu.mutable_locate_info()->CopyFrom(m_locate_info);
  546. dispatch_step_statu.mutable_space_info()->CopyFrom(m_parcspace_alloc_response_msg.allocated_space_info());
  547. m_process_msg.mutable_dispatch_step()->CopyFrom(dispatch_step_statu);
  548. break;
  549. }
  550. case message::eConfirm_step: {
  551. message::Confirm_space_step_statu confirm_step_type;
  552. confirm_step_type.set_step_statu(statu);
  553. confirm_step_type.mutable_space_info()->CopyFrom(m_parcspace_alloc_response_msg.allocated_space_info());
  554. m_process_msg.mutable_confirm_space_step()->CopyFrom(confirm_step_type);
  555. break;
  556. }
  557. case message::eComplete: {
  558. m_process_msg.set_completed(true);
  559. break;
  560. }
  561. case message::eBackConfirm_step: {
  562. message::Back_confirm_space_step_statu back_confirm_step_type;
  563. back_confirm_step_type.set_step_statu(statu);
  564. m_process_msg.mutable_back_confirm_step()->CopyFrom(back_confirm_step_type);
  565. break;
  566. }
  567. case message::eBackDispatch_step: {
  568. message::Back_dispatch_store_step_statu back_dispatch_step_statu;
  569. back_dispatch_step_statu.set_step_statu(statu);
  570. back_dispatch_step_statu.mutable_space_info()->CopyFrom(m_parcspace_alloc_response_msg.allocated_space_info());
  571. back_dispatch_step_statu.mutable_locate_info()->CopyFrom(m_compare_location_data);
  572. m_process_msg.mutable_back_dispatch_step()->CopyFrom(back_dispatch_step_statu);
  573. break;
  574. }
  575. case message::eBack_compare_step:{
  576. message::Back_compare_step_statu back_compare_step_statu;
  577. back_compare_step_statu.set_step_statu(statu);
  578. back_compare_step_statu.mutable_locate_info_wj()->CopyFrom(m_locate_info);
  579. back_compare_step_statu.mutable_locate_info_dj()->CopyFrom(m_measure_response_msg.locate_information());
  580. back_compare_step_statu.mutable_locate_info_result()->CopyFrom(m_compare_location_data);
  581. m_process_msg.mutable_back_compare_step()->CopyFrom(back_compare_step_statu);
  582. break;
  583. }
  584. case message::eBackMeasure_step: {
  585. message::Back_measure_step_statu back_measure_step_statu;
  586. back_measure_step_statu.set_step_statu(statu);
  587. m_process_msg.mutable_back_measure_step()->CopyFrom(back_measure_step_statu);
  588. break;
  589. }
  590. case message::eBackAlloc_step: {
  591. message::Back_alloc_space_step_statu back_alloc_step_statu;
  592. back_alloc_step_statu.set_step_statu(statu);
  593. back_alloc_step_statu.mutable_space_info()->CopyFrom(m_parcspace_alloc_response_msg.allocated_space_info());
  594. m_process_msg.mutable_back_alloc_space_step()->CopyFrom(back_alloc_step_statu);
  595. break;
  596. }
  597. case message::eBackComplete: {
  598. m_process_msg.set_back_completed(true);
  599. break;
  600. }
  601. default:
  602. break;
  603. }
  604. }
  605. /*
  606. * 初始化 接收到的消息
  607. */
  608. void StoreProcessTask::reset_msg() {
  609. m_alloc_request_msg = message::Parkspace_allocation_request_msg();
  610. m_measure_request_msg = message::Measure_request_msg();
  611. m_dispatch_request_msg = message::Dispatch_request_msg();
  612. m_confirm_request_msg = message::Parkspace_confirm_alloc_request_msg();
  613. m_command_response_msg=message::Store_command_response_msg();
  614. m_locate_info = message::Locate_information();
  615. m_measure_response_msg = message::Measure_response_msg(); //测量模块的测量数据
  616. m_parcspace_alloc_response_msg = message::Parkspace_allocation_response_msg(); //分配的车位数据
  617. m_dispatch_response_msg = message::Dispatch_response_msg(); //调度模块的反馈数据
  618. }