StoreProcessTask.cpp 26 KB

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