StoreProcessTask.cpp 26 KB

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