StoreProcessTask.cpp 8.3 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250
  1. //
  2. // Created by zx on 2020/7/7.
  3. //
  4. #include <Parkspace_communicator.h>
  5. #include <dispatch_message.pb.h>
  6. #include "dispatch_communicator.h"
  7. #include "StoreProcessTask.h"
  8. #include "process_message.pb.h"
  9. #include "command_manager.h"
  10. StoreProcessTask::StoreProcessTask()
  11. {
  12. m_command_id=-1;
  13. m_terminor_id=-1;
  14. mb_completed=false;
  15. }
  16. StoreProcessTask::~StoreProcessTask()
  17. {
  18. }
  19. Error_manager StoreProcessTask::init_task(unsigned int command_id, unsigned int terminor_id,
  20. message::Locate_information locate_info,message::Car_info car_info)
  21. {
  22. m_command_id=command_id;
  23. m_terminor_id=terminor_id;
  24. m_car_info=car_info;
  25. m_locate_info=locate_info;
  26. return SUCCESS;
  27. }
  28. Error_manager StoreProcessTask::locate_step() {
  29. message::Measure_request_msg request;
  30. message::Base_info base_info;
  31. base_info.set_msg_type(message::eLocate_request_msg);
  32. base_info.set_sender(message::eMain);
  33. base_info.set_receiver(message::eMeasurer);
  34. base_info.set_timeout_ms(5000); //测量超时5s
  35. request.mutable_base_info()->CopyFrom(base_info);
  36. request.set_command_id(m_command_id);
  37. request.set_terminal_id(m_terminor_id);
  38. Error_manager code=Locate_communicator::get_instance_pointer()->locate_request(request,m_measure_response_msg);
  39. if(code!=SUCCESS)
  40. return code;
  41. if(m_measure_response_msg.error_manager().error_code()==0) {
  42. return SUCCESS;
  43. }
  44. else
  45. return Error_manager(FAILED,MINOR_ERROR,"measure response error_code error");
  46. }
  47. /*
  48. * 调度
  49. */
  50. Error_manager StoreProcessTask::dispatch_step()
  51. {
  52. /*
  53. * 判断调度所需的数据是否都正常
  54. */
  55. //1,测量信息是否存在
  56. if(m_measure_response_msg.has_base_info()== false
  57. ||m_measure_response_msg.has_locate_information()==false
  58. ||m_parcspace_alloc_response_msg.has_base_info()== false
  59. ||m_parcspace_alloc_response_msg.has_allocated_space_info()==false)
  60. {
  61. return Error_manager(ERROR,MAJOR_ERROR,"调度所需的前置数据(测量,车位)不存在");
  62. }
  63. message::Dispatch_request_msg request;
  64. message::Base_info base_info;
  65. base_info.set_msg_type(message::eDispatch_request_msg);
  66. base_info.set_sender(message::eMain);
  67. base_info.set_receiver(message::eDispatch);
  68. base_info.set_timeout_ms(1000*15); //测量超时15s
  69. request.mutable_base_info()->CopyFrom(base_info);
  70. request.set_command_id(m_command_id);
  71. request.set_terminal_id(m_terminor_id);
  72. request.set_dispatch_motion_direction(message::E_STORE_CAR);
  73. request.set_parkspace_id(m_parcspace_alloc_response_msg.allocated_space_info().parkspace_id());
  74. Error_manager code=Dispatch_communicator::get_instance_pointer()->dispatch_request(request,m_dispatch_response_msg);
  75. if(code!=SUCCESS)
  76. return code;
  77. if(m_dispatch_response_msg.error_manager().error_code()==0) {
  78. return SUCCESS;
  79. }
  80. else
  81. return Error_manager(FAILED,MINOR_ERROR,"dispatch response error_code error");
  82. }
  83. /*
  84. * 分配车位
  85. */
  86. Error_manager StoreProcessTask::alloc_space()
  87. {
  88. /*
  89. * 检查是否有测量数据
  90. */
  91. if(m_locate_info.has_locate_height()==false||m_locate_info.has_locate_width()==false)
  92. {
  93. return Error_manager(FAILED,MINOR_ERROR," parkspace alloc request without measure info");
  94. }
  95. message::Parkspace_allocation_request_msg request;
  96. message::Base_info base_info;
  97. base_info.set_msg_type(message::eParkspace_allocation_request_msg);
  98. base_info.set_sender(message::eMain);
  99. base_info.set_receiver(message::eParkspace);
  100. base_info.set_timeout_ms(1000); //测量超时1s
  101. request.mutable_base_info()->CopyFrom(base_info);
  102. request.mutable_car_info()->CopyFrom(m_car_info);
  103. request.set_command_id(m_command_id);
  104. request.set_terminal_id(m_terminor_id);
  105. Error_manager code=Parkspace_communicator::get_instance_pointer()->alloc_request(request,m_parcspace_alloc_response_msg);
  106. if(code!=SUCCESS)
  107. return code;
  108. if(m_parcspace_alloc_response_msg.error_manager().error_code()==0)
  109. {
  110. /*LOG(INFO)<<"分配车位成功,停车终端:"<<m_terminor_id
  111. <<", 指令id:"<<m_command_id
  112. <<", 车位楼层:"<<m_parcspace_alloc_response_msg.allocated_space_info().floor()
  113. <<", 车位序号:"<<m_parcspace_alloc_response_msg.allocated_space_info().index()
  114. <<", 车牌号:"<<m_parcspace_alloc_response_msg.allocated_space_info().car_info().license();*/
  115. return SUCCESS;
  116. }
  117. else
  118. return Error_manager(FAILED,MINOR_ERROR,"parkspace alloc response error_code error");
  119. }
  120. /*
  121. * 车位解锁,当停车失败时需要车位解锁
  122. */
  123. Error_manager StoreProcessTask::release_space_step()
  124. {
  125. /*
  126. * 检查是否曾经分配过车位
  127. */
  128. if(m_parcspace_alloc_response_msg.has_allocated_space_info()==false)
  129. {
  130. return Error_manager(FAILED,MINOR_ERROR," parkspace release request without space info");
  131. }
  132. message::Parkspace_release_request_msg request;
  133. message::Base_info base_info;
  134. base_info.set_msg_type(message::eParkspace_release_request_msg);
  135. base_info.set_sender(message::eMain);
  136. base_info.set_receiver(message::eParkspace);
  137. base_info.set_timeout_ms(1000); //测量超时1s
  138. request.mutable_base_info()->CopyFrom(base_info);
  139. message::Parkspace_info space_info=m_parcspace_alloc_response_msg.allocated_space_info();
  140. request.mutable_release_space_info()->CopyFrom(space_info);
  141. request.set_command_id(m_command_id);
  142. message::Parkspace_release_response_msg release_response;
  143. Error_manager code=Parkspace_communicator::get_instance_pointer()->release_request(request,release_response);
  144. if(code!=SUCCESS)
  145. return code;
  146. if(release_response.error_manager().error_code()==0) {
  147. LOG(ERROR)<<"停车流程异常,释放车位成功,停车终端:"<<m_terminor_id
  148. <<", 指令id:"<<m_command_id
  149. <<", 车位楼层:"<<m_parcspace_alloc_response_msg.allocated_space_info().floor()
  150. <<", 车位序号:"<<m_parcspace_alloc_response_msg.allocated_space_info().index()
  151. <<", 车牌号:"<<m_parcspace_alloc_response_msg.allocated_space_info().car_info().license();
  152. return SUCCESS;
  153. }
  154. else
  155. return Error_manager(FAILED,MINOR_ERROR,"parkspace release response error_code error");
  156. }
  157. void StoreProcessTask::Main()
  158. {
  159. /*
  160. * 外部已经分配好车位,进入到此流程说明车位已经分配好, 存放在 m_parcspace_alloc_response_msg
  161. */
  162. Error_manager code;
  163. Command_manager::get_instance_pointer()->updata_store_entrance_statu(m_terminor_id,message::eWorking);
  164. //开始执行停车指令
  165. //第一步测量
  166. switch (0)
  167. {
  168. //第一步,测量
  169. case 0:
  170. {
  171. code=locate_step();
  172. if(code!=SUCCESS)
  173. {
  174. LOG(ERROR)<<"测量失败:"<<code.to_string();
  175. break;
  176. }
  177. }
  178. //第二步,调度
  179. case 1:
  180. {
  181. code=dispatch_step();
  182. if(code!=SUCCESS)
  183. {
  184. LOG(ERROR)<<"调度失败:"<<code.to_string();
  185. break;
  186. }
  187. }
  188. //第三步,占据车位
  189. case 2:
  190. {
  191. ////
  192. Command_manager::get_instance_pointer()->updata_store_entrance_statu(m_terminor_id,message::eReady);
  193. LOG(INFO)<<"停车成功,停车终端:"<<m_terminor_id<<"指令id:"<<m_command_id
  194. <<", 车位id:"<<m_parcspace_alloc_response_msg.allocated_space_info().parkspace_id()
  195. <<", 车位楼层:"<<m_parcspace_alloc_response_msg.allocated_space_info().floor()
  196. <<", 车位序号:"<<m_parcspace_alloc_response_msg.allocated_space_info().index()
  197. <<", 车牌号:"<<m_car_info.license()
  198. <<", 库内车牌号:"<<m_parcspace_alloc_response_msg.allocated_space_info().car_info().license();
  199. return ;
  200. }
  201. }
  202. /*
  203. * switch 语句break,说明停车故障,需清除车位
  204. */
  205. //失败,清理车位
  206. code=release_space_step();
  207. if(code!=SUCCESS)
  208. {
  209. LOG(ERROR)<<"致命故障,停车失败,清理车位故障:"<<code.to_string();
  210. /*
  211. * 此处应暂停系统,待管理员介入
  212. */
  213. }
  214. //更新状态
  215. Command_manager::get_instance_pointer()->updata_store_entrance_statu(m_terminor_id,message::eReady);
  216. }