command_manager.cpp 9.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228
  1. //
  2. // Created by zx on 2020/7/14.
  3. //
  4. #include <Parkspace_communicator.h>
  5. #include "command_manager.h"
  6. #include "StoreProcessTask.h"
  7. #include "PickupProcessTask.h"
  8. #include "system_communicator.h"
  9. Command_manager::Command_manager()
  10. :m_thread_queue_process(nullptr)
  11. {
  12. }
  13. Command_manager::~Command_manager()
  14. {
  15. //等待线程池完成
  16. if(m_thread_queue_process!=nullptr) {
  17. m_thread_queue_process->WaitForFinish();
  18. m_thread_queue_process->Stop();
  19. }
  20. }
  21. Error_manager Command_manager::init()
  22. {
  23. //创建线程池
  24. if(m_thread_queue_process== nullptr)
  25. {
  26. m_thread_queue_process=tq::TQFactory::CreateDefaultQueue();
  27. m_thread_queue_process->Start(12);
  28. }
  29. return SUCCESS;
  30. }
  31. /*
  32. * 执行停车请求
  33. */
  34. Error_manager Command_manager::execute_store_command(message::Store_command_request_msg& request,message::Store_command_response_msg& response)
  35. {
  36. if(m_thread_queue_process==nullptr)
  37. {
  38. return Error_manager(ERROR,CRITICAL_ERROR,"线程池未初始化,bug");
  39. }
  40. if(request.base_info().msg_type()==message::eStore_command_request_msg
  41. &&request.base_info().receiver()==message::eMain
  42. &&request.base_info().sender()==message::eTerminor)
  43. {
  44. if(request.has_locate_information())
  45. {
  46. message::Locate_information locate_info=request.locate_information();
  47. if(locate_info.has_locate_correct())
  48. {
  49. if(locate_info.locate_correct()==true)
  50. {
  51. if(locate_info.has_locate_width()&&locate_info.has_locate_height()
  52. &&locate_info.has_locate_x()&&locate_info.has_locate_y()
  53. &&locate_info.has_locate_angle()&&locate_info.has_locate_wheel_base())
  54. {
  55. /*
  56. * 检查消息完毕,开始处理
  57. */
  58. message::Base_info base_info;
  59. base_info.set_msg_type(message::eStore_command_response_msg);
  60. base_info.set_sender(message::eMain);
  61. base_info.set_receiver(message::eTerminor);
  62. response.mutable_base_info()->CopyFrom(base_info);
  63. response.set_terminal_id(request.terminal_id());
  64. message::Error_manager error_msg;
  65. error_msg.set_error_code(0);
  66. /*
  67. * 检查各个节点是否正常
  68. */
  69. Error_manager parkspace_code= Parkspace_communicator::get_instance_pointer()->check_statu();
  70. if(parkspace_code!=SUCCESS)
  71. {
  72. error_msg.set_error_code(parkspace_code.get_error_code());
  73. error_msg.set_error_description(parkspace_code.get_error_description());
  74. response.mutable_code()->CopyFrom(error_msg);
  75. return parkspace_code;
  76. }
  77. Error_manager locate_code= Locate_communicator::get_instance_pointer()->check_statu();
  78. if(locate_code!=SUCCESS)
  79. {
  80. error_msg.set_error_code(locate_code.get_error_code());
  81. error_msg.set_error_description(locate_code.get_error_description());
  82. response.mutable_code()->CopyFrom(error_msg);
  83. return locate_code;
  84. }
  85. Error_manager dispatch_code= Dispatch_communicator::get_instance_pointer()->check_statu();
  86. if(dispatch_code!=SUCCESS)
  87. {
  88. error_msg.set_error_code(dispatch_code.get_error_code());
  89. error_msg.set_error_description(dispatch_code.get_error_description());
  90. response.mutable_code()->CopyFrom(error_msg);
  91. return dispatch_code;
  92. }
  93. //一切正常,接受指令
  94. int command_id=request.terminal_id()+10000;
  95. LOG(INFO)<<"收到停车指令:"<<command_id<<", 车牌:"<<request.car_info().license()<<
  96. ",终端:"<<request.terminal_id();
  97. tq::BaseTask* ptask;
  98. if(false==m_store_command_task_map.find(request.terminal_id(),ptask))
  99. {
  100. ptask=new StoreProcessTask(request.terminal_id());
  101. m_store_command_task_map[request.terminal_id()]=ptask;
  102. }
  103. StoreProcessTask* pStore_task=(StoreProcessTask*)ptask;
  104. //初始化流程
  105. pStore_task->init_task(command_id,locate_info,request.car_info());
  106. //获取车位
  107. Error_manager code=pStore_task->alloc_space();
  108. if(code==SUCCESS)
  109. {
  110. m_thread_queue_process->AddTask(pStore_task);
  111. response.mutable_code()->CopyFrom(error_msg);
  112. return SUCCESS;
  113. }
  114. error_msg.set_error_code(code.get_error_code());
  115. error_msg.set_error_description(code.to_string());
  116. response.mutable_code()->CopyFrom(error_msg);
  117. LOG(ERROR)<<"创建停车流程失败(车位分配失败),终端:"<<request.terminal_id()<<
  118. "车牌:"<<request.car_info().license()<<" "<<code.to_string();
  119. return code;
  120. }
  121. }
  122. }
  123. }
  124. return Error_manager(FAILED,MINOR_ERROR,"创建停车流程失败......");
  125. }
  126. else
  127. {
  128. return Error_manager(INVALID_MESSAGE,MAJOR_ERROR,"停车请求基本信息错误");
  129. }
  130. }
  131. /*
  132. * 执行取车请求
  133. */
  134. Error_manager Command_manager::execute_pickup_command(message::Pickup_command_request_msg& request,message::Pickup_command_response_msg& response)
  135. {
  136. if(m_thread_queue_process==nullptr)
  137. {
  138. return Error_manager(ERROR,CRITICAL_ERROR,"线程池未初始化,bug");
  139. }
  140. if(request.base_info().msg_type()==message::ePickup_command_request_msg
  141. &&request.base_info().receiver()==message::eMain
  142. &&request.base_info().sender()==message::eTerminor
  143. &&request.has_car_info()) {
  144. message::Base_info baseInfo;
  145. baseInfo.set_msg_type(message::ePickup_command_response_msg);
  146. baseInfo.set_sender(message::eMain);
  147. baseInfo.set_receiver(message::eTerminor);
  148. response.mutable_base_info()->CopyFrom(baseInfo);
  149. response.set_terminal_id(request.terminal_id());
  150. message::Error_manager error_msg;
  151. error_msg.set_error_code(0);
  152. /*
  153. * 检查各个节点是否正常
  154. */
  155. Error_manager parkspace_code= Parkspace_communicator::get_instance_pointer()->check_statu();
  156. if(parkspace_code!=SUCCESS)
  157. {
  158. error_msg.set_error_code(parkspace_code.get_error_code());
  159. error_msg.set_error_description(parkspace_code.get_error_description());
  160. response.mutable_code()->CopyFrom(error_msg);
  161. return parkspace_code;
  162. }
  163. Error_manager dispatch_code= Dispatch_communicator::get_instance_pointer()->check_statu();
  164. if(dispatch_code!=SUCCESS)
  165. {
  166. error_msg.set_error_code(dispatch_code.get_error_code());
  167. error_msg.set_error_description(dispatch_code.get_error_description());
  168. response.mutable_code()->CopyFrom(error_msg);
  169. return dispatch_code;
  170. }
  171. //一切正常,接受指令
  172. Error_manager code;
  173. int command_id = request.terminal_id()+20000;
  174. tq::BaseTask* ptask;
  175. if(false==m_pick_command_task_map.find(request.terminal_id(),ptask))
  176. {
  177. ptask=new PickupProcessTask(request.terminal_id());
  178. m_pick_command_task_map[request.terminal_id()]=ptask;
  179. }
  180. PickupProcessTask* pPick_task=(PickupProcessTask*)ptask;
  181. //初始化流程
  182. pPick_task->init_task(command_id, request.car_info());
  183. /////查询车位
  184. code=pPick_task->search_space();
  185. if(code==SUCCESS)
  186. {
  187. m_thread_queue_process->AddTask(pPick_task);
  188. response.mutable_code()->CopyFrom(error_msg);
  189. return SUCCESS;
  190. }
  191. error_msg.set_error_code(code.get_error_code());
  192. error_msg.set_error_description(code.to_string());
  193. response.mutable_code()->CopyFrom(error_msg);
  194. LOG(ERROR)<<"创建取车流程失败(车位查询失败),终端:"<<request.terminal_id()<<
  195. "车牌:"<<request.car_info().license()<<" "<<code.to_string();
  196. return code;
  197. }
  198. else
  199. {
  200. return Error_manager(INVALID_MESSAGE,MAJOR_ERROR,"停车请求信息错误");
  201. }
  202. }