command_manager.cpp 14 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335
  1. //
  2. // Created by zx on 2020/7/14.
  3. //
  4. #include <sstream>
  5. #include <iomanip>
  6. #include <Parkspace_communicator.h>
  7. #include "command_manager.h"
  8. #include "StoreProcessTask.h"
  9. #include "PickupProcessTask.h"
  10. #include "system_communicator.h"
  11. Command_manager::Command_manager()
  12. :m_thread_queue_process(nullptr)
  13. {
  14. }
  15. Command_manager::~Command_manager()
  16. {
  17. //等待线程池完成
  18. if(m_thread_queue_process!=nullptr) {
  19. m_thread_queue_process->WaitForFinish();
  20. m_thread_queue_process->Stop();
  21. }
  22. }
  23. Error_manager Command_manager::init(setting::System_setting system_setting) {
  24. /*
  25. * 检查参数
  26. */
  27. if (system_setting.has_bind_ip() == false || system_setting.has_entrance_num() == false
  28. || system_setting.has_export_num() == false) {
  29. return Error_manager(ERROR, MAJOR_ERROR, "系统配置错误");
  30. }
  31. if (system_setting.entrance_num() < 0 || system_setting.export_num() < 0) {
  32. return Error_manager(ERROR, MAJOR_ERROR, "系统配置出入口数量错误");
  33. }
  34. //创建线程池
  35. if (m_thread_queue_process == nullptr) {
  36. m_thread_queue_process = tq::TQFactory::CreateDefaultQueue();
  37. m_thread_queue_process->Start(12);
  38. }
  39. /*
  40. * 此处添加等待各个通讯模块正常代码
  41. */
  42. /*std::chrono::system_clock::time_point t_start=std::chrono::system_clock::now();
  43. std::chrono::system_clock::time_point t_end=std::chrono::system_clock::now();
  44. Error_manager parkspace_code=ERROR;
  45. LOG(INFO)<<"初始化车位管理模块...";
  46. do
  47. {
  48. if (parkspace_code != SUCCESS) {
  49. parkspace_code = Parkspace_communicator::get_instance_pointer()->check_statu();
  50. LOG_IF(INFO, parkspace_code == SUCCESS) << "车位管理模块初始化完成!!!";
  51. }
  52. if(parkspace_code==SUCCESS)
  53. break;
  54. t_end=std::chrono::system_clock::now();
  55. usleep(1000*100);
  56. }while(t_end-t_start<std::chrono::seconds(300));
  57. LOG_IF(ERROR,parkspace_code!=SUCCESS)<<"车位管理节点连接超时";
  58. if(parkspace_code!=SUCCESS)
  59. {
  60. return Error_manager(ERROR,MAJOR_ERROR,"车位管理模块初始化超时");
  61. }
  62. //检查节点并创建停取车流程
  63. for(int i=0;i<system_setting.entrance_num();++i)
  64. {
  65. //
  66. // 检查入口 i 的各个节点状态
  67. //
  68. LOG(INFO)<<"初始化停车入口:"<<i<<" 测量及调度模块...";
  69. Error_manager locate_code=ERROR,dispatch_code=ERROR;
  70. do {
  71. if (locate_code != SUCCESS) {
  72. locate_code = Locate_communicator::get_instance_pointer()->check_statu(i);
  73. LOG_IF(INFO, locate_code == SUCCESS) << "停车入口:"<<i<<" 测量模块初始化完成!!!";
  74. }
  75. if (dispatch_code != SUCCESS) {
  76. dispatch_code = Dispatch_communicator::get_instance_pointer()->check_entrance_statu(i);
  77. LOG_IF(INFO, dispatch_code == SUCCESS) << "停车入口:"<<i<<" 调度模块初始化完成!!!";
  78. }
  79. t_end=std::chrono::system_clock::now();
  80. if (locate_code == SUCCESS && dispatch_code == SUCCESS)
  81. break;
  82. usleep(1000*100);
  83. }while(t_end-t_start<std::chrono::seconds(300));
  84. LOG_IF(ERROR,locate_code!=SUCCESS||dispatch_code!=SUCCESS)<<"停车口:"<<i<<" 测量/调度节点连接超时";
  85. if(locate_code!=SUCCESS||dispatch_code!=SUCCESS)
  86. {
  87. return Error_manager(ERROR,MAJOR_ERROR,"停车入口通讯节点初始化超时");
  88. }
  89. }
  90. for(int i=0;i<system_setting.export_num();++i)
  91. {
  92. LOG(INFO)<<"初始化取车出口:"<<i<<" 调度模块...";
  93. Error_manager dispatch_code=ERROR;
  94. do {
  95. if (dispatch_code != SUCCESS) {
  96. dispatch_code = Dispatch_communicator::get_instance_pointer()->check_export_statu(i);
  97. LOG_IF(INFO, dispatch_code == SUCCESS) << "取车出口:" << i << " 调度模块初始化完成!!!";
  98. }
  99. t_end = std::chrono::system_clock::now();
  100. if (dispatch_code == SUCCESS)
  101. break;
  102. usleep(1000*100);
  103. }while(t_end-t_start<std::chrono::seconds(300));
  104. LOG_IF(ERROR,dispatch_code!=SUCCESS)<<"取车出口:"<<i<<" 调度节点连接超时";
  105. if(dispatch_code!=SUCCESS)
  106. {
  107. return Error_manager(ERROR,MAJOR_ERROR,"取车出口通讯节点初始化超时");
  108. }
  109. }
  110. return SUCCESS;
  111. }
  112. /*
  113. * 执行停车请求
  114. */
  115. }
  116. Error_manager Command_manager::execute_store_command(message::Store_command_request_msg& request,message::Store_command_response_msg& response)
  117. {
  118. if (m_thread_queue_process == nullptr) {
  119. return Error_manager(ERROR, CRITICAL_ERROR, "线程池未初始化,bug");
  120. }
  121. if (request.base_info().msg_type() == message::eStore_command_request_msg
  122. && request.base_info().receiver() == message::eMain
  123. && request.base_info().sender() == message::eTerminor)
  124. {
  125. if (request.has_locate_information() && request.has_base_info())
  126. {
  127. message::Locate_information locate_info = request.locate_information();
  128. if (locate_info.has_locate_correct())
  129. {
  130. if (locate_info.locate_correct() == true)
  131. {
  132. if (locate_info.has_locate_width() && locate_info.has_locate_height()
  133. && locate_info.has_locate_x() && locate_info.has_locate_y()
  134. && locate_info.has_locate_angle() && locate_info.has_locate_wheel_base())
  135. {
  136. /*
  137. * 检查消息完毕,开始处理
  138. */
  139. message::Base_info base_info;
  140. base_info.set_msg_type(message::eStore_command_response_msg);
  141. base_info.set_sender(message::eMain);
  142. base_info.set_receiver(message::eTerminor);
  143. response.mutable_base_info()->CopyFrom(base_info);
  144. response.set_terminal_id(request.terminal_id());
  145. message::Error_manager error_msg;
  146. error_msg.set_error_code(0);
  147. /*
  148. * 检查各个节点是否正常
  149. */
  150. /*Error_manager parkspace_code= Parkspace_communicator::get_instance_pointer()->check_statu();
  151. if(parkspace_code!=SUCCESS)
  152. {
  153. error_msg.set_error_code(parkspace_code.get_error_code());
  154. error_msg.set_error_description(parkspace_code.get_error_description());
  155. response.mutable_code()->CopyFrom(error_msg);
  156. return parkspace_code;
  157. }
  158. Error_manager locate_code= Locate_communicator::get_instance_pointer()->check_statu(request.terminal_id());
  159. if(locate_code!=SUCCESS)
  160. {
  161. error_msg.set_error_code(locate_code.get_error_code());
  162. error_msg.set_error_description(locate_code.get_error_description());
  163. response.mutable_code()->CopyFrom(error_msg);
  164. return locate_code;
  165. }
  166. Error_manager dispatch_code= Dispatch_communicator::get_instance_pointer()->check_entrance_statu(request.terminal_id());
  167. if(dispatch_code!=SUCCESS)
  168. {
  169. error_msg.set_error_code(dispatch_code.get_error_code());
  170. error_msg.set_error_description(dispatch_code.get_error_description());
  171. response.mutable_code()->CopyFrom(error_msg);
  172. return dispatch_code;
  173. }*/
  174. //一切正常,接受指令
  175. message::Command_info command_info;
  176. //获取当前时间
  177. auto t = std::chrono::system_clock::to_time_t(std::chrono::system_clock::now());
  178. std::stringstream ss;
  179. ss << std::put_time(std::localtime(&t), "%Y-%m-%d:%H-%M-%S");
  180. std::string str_time = ss.str();
  181. command_info.set_time(str_time);
  182. char place[255] = {0};
  183. sprintf(place, "027-01-%02d:%s", request.terminal_id(), request.car_info().license().c_str());
  184. command_info.set_place(place);
  185. command_info.set_event(message::eStoring);
  186. LOG(INFO) << "收到停车指令:" << command_info.place() + "-" + command_info.time() << ", 车牌:"
  187. << request.car_info().license() <<
  188. ",终端:" << request.terminal_id();
  189. tq::BaseTask *ptask = new StoreProcessTask(request.terminal_id());
  190. StoreProcessTask *pStore_task = (StoreProcessTask *) ptask;
  191. //初始化流程
  192. pStore_task->init_task(command_info, locate_info, request.car_info());
  193. //获取车位
  194. Error_manager code = pStore_task->alloc_space();
  195. if (code == SUCCESS) {
  196. m_thread_queue_process->AddTask(pStore_task);
  197. response.mutable_code()->CopyFrom(error_msg);
  198. return SUCCESS;
  199. }
  200. usleep(1000 * 5000);
  201. //delete pStore_task;
  202. error_msg.set_error_code(code.get_error_code());
  203. error_msg.set_error_description(code.to_string());
  204. response.mutable_code()->CopyFrom(error_msg);
  205. LOG(ERROR) << "创建停车流程失败(车位分配失败),终端:" << request.terminal_id() <<
  206. "车牌:" << request.car_info().license() << " " << code.to_string();
  207. return code;
  208. }
  209. }
  210. }
  211. }
  212. return Error_manager(FAILED, MINOR_ERROR, "创建停车流程失败......");
  213. } else {
  214. return Error_manager(INVALID_MESSAGE, MAJOR_ERROR, "停车请求基本信息错误");
  215. }
  216. }
  217. /*
  218. * 执行取车请求
  219. */
  220. Error_manager Command_manager::execute_pickup_command(message::Pickup_command_request_msg& request,message::Pickup_command_response_msg& response)
  221. {
  222. if(m_thread_queue_process==nullptr)
  223. {
  224. return Error_manager(ERROR,CRITICAL_ERROR,"线程池未初始化,bug");
  225. }
  226. if(request.base_info().msg_type()==message::ePickup_command_request_msg
  227. &&request.base_info().receiver()==message::eMain
  228. &&request.base_info().sender()==message::eTerminor
  229. &&request.has_car_info()) {
  230. message::Base_info baseInfo;
  231. baseInfo.set_msg_type(message::ePickup_command_response_msg);
  232. baseInfo.set_sender(message::eMain);
  233. baseInfo.set_receiver(message::eTerminor);
  234. response.mutable_base_info()->CopyFrom(baseInfo);
  235. response.set_terminal_id(request.terminal_id());
  236. message::Error_manager error_msg;
  237. error_msg.set_error_code(0);
  238. /*
  239. * 检查各个节点是否正常
  240. */
  241. Error_manager parkspace_code= Parkspace_communicator::get_instance_pointer()->check_statu();
  242. if(parkspace_code!=SUCCESS)
  243. {
  244. error_msg.set_error_code(parkspace_code.get_error_code());
  245. error_msg.set_error_description(parkspace_code.get_error_description());
  246. response.mutable_code()->CopyFrom(error_msg);
  247. return parkspace_code;
  248. }
  249. Error_manager dispatch_code= Dispatch_communicator::get_instance_pointer()->check_export_statu(request.terminal_id());
  250. if(dispatch_code!=SUCCESS)
  251. {
  252. error_msg.set_error_code(dispatch_code.get_error_code());
  253. error_msg.set_error_description(dispatch_code.get_error_description());
  254. response.mutable_code()->CopyFrom(error_msg);
  255. return dispatch_code;
  256. }
  257. //一切正常,接受指令
  258. Error_manager code;
  259. message::Command_info command_info;
  260. //获取当前时间
  261. auto t = std::chrono::system_clock::to_time_t(std::chrono::system_clock::now());
  262. std::stringstream ss;
  263. ss << std::put_time(std::localtime(&t), "%Y-%m-%d:%H-%M-%S-%ms");
  264. std::string str_time = ss.str();
  265. command_info.set_time(str_time);
  266. char place[255]={0};
  267. sprintf(place ,"027-01-%02d",request.terminal_id());
  268. command_info.set_place(place);
  269. command_info.set_event(message::ePicking);
  270. tq::BaseTask* ptask=new PickupProcessTask(request.terminal_id());
  271. PickupProcessTask* pPick_task=(PickupProcessTask*)ptask;
  272. //初始化流程
  273. pPick_task->init_task(command_info, request.car_info());
  274. /////查询车位
  275. code=pPick_task->search_space();
  276. if(code==SUCCESS)
  277. {
  278. m_thread_queue_process->AddTask(pPick_task);
  279. response.mutable_code()->CopyFrom(error_msg);
  280. return SUCCESS;
  281. }
  282. error_msg.set_error_code(code.get_error_code());
  283. error_msg.set_error_description(code.to_string());
  284. response.mutable_code()->CopyFrom(error_msg);
  285. LOG(ERROR)<<"创建取车流程失败(车位查询失败),终端:"<<request.terminal_id()<<
  286. "车牌:"<<request.car_info().license()<<" "<<code.to_string();
  287. return code;
  288. }
  289. else
  290. {
  291. return Error_manager(INVALID_MESSAGE,MAJOR_ERROR,"停车请求信息错误");
  292. }
  293. }