parkspace_manager.cpp 52 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243
  1. /*
  2. * @Description: 车位分配算法模块,使用单例模式,接收外部请求并通过调用通信块接口发送反馈
  3. * @Author: yct
  4. * @Date: 2020-07-10 11:02:40
  5. * @LastEditTime: 2020-08-06 10:32:28
  6. * @LastEditors: yct
  7. */
  8. #include "parkspace_manager.h"
  9. #include "parkspace_communicator.h"
  10. Parkspace_manager::Parkspace_manager()
  11. {
  12. }
  13. Parkspace_manager::~Parkspace_manager()
  14. {
  15. parkspace_manager_uninit();
  16. }
  17. //初始化
  18. Error_manager Parkspace_manager::parkspace_manager_init(int threads_size)
  19. {
  20. // 初始化任务处理线程池
  21. m_thread_pool.thread_pool_init(threads_size);
  22. m_parkspace_manager_satus = eParkspace_manager_normal;
  23. return Error_code::SUCCESS;
  24. }
  25. //反初始化
  26. Error_manager Parkspace_manager::parkspace_manager_uninit()
  27. {
  28. m_thread_pool.thread_pool_uninit();
  29. m_parkspace_manager_satus = eParkspace_manager_unknown;
  30. return Error_code::SUCCESS;
  31. }
  32. //检查执行者的状态, 判断能否处理这条消息,
  33. Error_manager Parkspace_manager::check_status()
  34. {
  35. if(get_parkspace_manage_status() != eParkspace_manager_normal)
  36. {
  37. return Error_manager(Error_code::DB_MANAGER_STATUS_ERROR, Error_level::MAJOR_ERROR,
  38. " Parkspace_manager::check_executer error ");
  39. }
  40. return SUCCESS;
  41. }
  42. //处理消息的执行函数
  43. Error_manager Parkspace_manager::execute_msg(Communication_message* p_msg)
  44. {
  45. if ( p_msg == nullptr )
  46. {
  47. return Error_manager(Error_code::POINTER_IS_NULL, Error_level::MINOR_ERROR,
  48. " POINTER IS NULL ");
  49. }
  50. switch ( p_msg->get_message_type() )
  51. {
  52. ///车位分配请求消息
  53. case Communication_message::eParkspace_allocation_request_msg:
  54. {
  55. message::Parkspace_allocation_request_msg request;
  56. bool result = request.ParseFromString(p_msg->get_message_buf());
  57. LOG(INFO)<<"allocation request, car license: "<<request.car_info().license();
  58. if(!result)
  59. {
  60. return Error_manager(Error_code::PARKSPACE_ALLOCATOR_MSG_PARSE_ERROR, Error_level::MINOR_ERROR,
  61. " message::Parkspace_allocation_request_msg ParseFromString error ");
  62. }
  63. // std::cout<<"分配:"<<request.DebugString()<<std::endl;
  64. //往线程池添加执行任务, 之后会唤醒一个线程去执行他.
  65. m_thread_pool.enqueue(&Parkspace_manager::execute_for_allocate, this,
  66. request.car_info(), request.terminal_id(), request.command_key());
  67. return SUCCESS;
  68. }
  69. // 车位查询请求消息
  70. case Communication_message::eParkspace_search_request_msg:
  71. {
  72. message::Parkspace_search_request_msg request;
  73. bool result = request.ParseFromString(p_msg->get_message_buf());
  74. LOG(INFO)<<"search request, car license: "<<request.car_info().license();
  75. if(!result)
  76. {
  77. return Error_manager(Error_code::PARKSPACE_ALLOCATOR_MSG_PARSE_ERROR, Error_level::MINOR_ERROR,
  78. " message::Parkspace_search_request_msg ParseFromString error ");
  79. }
  80. //往线程池添加执行任务, 之后会唤醒一个线程去执行他.
  81. // std::cout<<"查询:"<<request.DebugString()<<std::endl;
  82. m_thread_pool.enqueue(&Parkspace_manager::execute_for_search, this, request.car_info(), request.command_key());
  83. return SUCCESS;
  84. }
  85. // 车位释放请求消息
  86. case Communication_message::eParkspace_release_request_msg:
  87. {
  88. message::Parkspace_release_request_msg request;
  89. bool result = request.ParseFromString(p_msg->get_message_buf());
  90. LOG(INFO)<<"release request, parkspace id: "<<request.release_space_info().parkingspace_index_id();
  91. if(!result)
  92. {
  93. return Error_manager(Error_code::PARKSPACE_ALLOCATOR_MSG_PARSE_ERROR, Error_level::MINOR_ERROR,
  94. " message::Parkspace_release_request_msg ParseFromString error ");
  95. }
  96. //往线程池添加执行任务, 之后会唤醒一个线程去执行他.
  97. // std::cout<<"释放:"<<request.DebugString()<<std::endl;
  98. m_thread_pool.enqueue(&Parkspace_manager::execute_for_release, this, request.release_space_info(), request.command_key());
  99. return SUCCESS;
  100. }
  101. // 车位手动更新请求消息
  102. case Communication_message::eParkspace_force_update_request_msg:
  103. {
  104. message::Parkspace_force_update_request_msg request;
  105. bool result = request.ParseFromString(p_msg->get_message_buf());
  106. LOG(INFO)<<"force update request, parkspace id: "<<request.update_space_info().parkingspace_index_id();
  107. if(!result)
  108. {
  109. return Error_manager(Error_code::PARKSPACE_ALLOCATOR_MSG_PARSE_ERROR, Error_level::MINOR_ERROR,
  110. " message::Parkspace_force_update_request_msg ParseFromString error ");
  111. }
  112. //往线程池添加执行任务, 之后会唤醒一个线程去执行他.
  113. // std::cout<<"手动:"<<request.DebugString()<<std::endl;
  114. m_thread_pool.enqueue(&Parkspace_manager::execute_for_force_update, this, request.update_space_info(), request.command_key());
  115. return SUCCESS;
  116. }
  117. // 车位确认占用请求消息
  118. case Communication_message::eParkspace_confirm_alloc_request_msg:
  119. {
  120. message::Parkspace_confirm_alloc_request_msg request;
  121. bool result = request.ParseFromString(p_msg->get_message_buf());
  122. LOG(INFO)<<"confirm alloc request, parkspace id: "<<request.confirm_space_info().parkingspace_index_id();
  123. if(!result)
  124. {
  125. return Error_manager(Error_code::PARKSPACE_ALLOCATOR_MSG_PARSE_ERROR, Error_level::MINOR_ERROR,
  126. " message::Parkspace_force_update_request_msg ParseFromString error ");
  127. }
  128. m_thread_pool.enqueue(&Parkspace_manager::execute_for_confirm_alloc, this, request.confirm_space_info(), request.command_key());
  129. return SUCCESS;
  130. }
  131. //车位数据刷新请求
  132. case Communication_message::eParkspace_refresh_request_msg:
  133. {
  134. return send_parkspace_data();
  135. }
  136. }
  137. return Error_manager(Error_code::PARKSPACE_ALLOCATOR_MSG_REQUEST_TYPE_ERROR, Error_level::MINOR_ERROR,
  138. " fun error ");
  139. }
  140. Error_manager Parkspace_manager::encapsulating_heartbeat_messages()
  141. {
  142. //封装心跳消息
  143. Database_controller::Database_controller_status t_database_controller_status;
  144. Parkspace_manager::Parkspace_manager_satus t_parkspace_manager_satus;
  145. t_database_controller_status = Database_controller::get_instance_pointer()->get_database_controller_status();
  146. t_parkspace_manager_satus = Parkspace_manager::get_instance_pointer()->get_parkspace_manage_status();
  147. //车位信息消息赋值
  148. message::Parkspace_allocation_status_msg t_parkspace_status_msg;
  149. message::Base_info t_base_info;
  150. message::Error_manager t_error;
  151. t_base_info.set_msg_type(message::Message_type::eParkspace_allocation_status_msg);
  152. t_base_info.set_timeout_ms(5000);
  153. t_base_info.set_sender(message::Communicator::eParkspace);
  154. t_base_info.set_receiver(message::Communicator::eMain);
  155. t_error.set_error_code(0);
  156. t_parkspace_status_msg.mutable_base_info()->CopyFrom(t_base_info);
  157. t_parkspace_status_msg.mutable_error_manager()->CopyFrom(t_error);
  158. t_parkspace_status_msg.set_database_controller_status((message::Database_controller_status)t_database_controller_status);
  159. t_parkspace_status_msg.set_parkspace_manager_satus((message::Parkspace_manager_satus)t_parkspace_manager_satus);
  160. return Parkspace_communicator::get_instance_references().encapsulate_msg(t_parkspace_status_msg.SerializeAsString());
  161. }
  162. //判断是否为待机,如果已经准备好,则可以执行任务。
  163. bool Parkspace_manager::is_ready()
  164. {
  165. if ( m_parkspace_manager_satus == eParkspace_manager_normal && m_thread_pool.thread_is_full_load() == false )
  166. {
  167. return true;
  168. }
  169. else
  170. {
  171. return false;
  172. }
  173. }
  174. Parkspace_manager::Parkspace_manager_satus Parkspace_manager::get_parkspace_manage_status()
  175. {
  176. return m_parkspace_manager_satus;
  177. }
  178. // 检查车辆是否已存在,通常分配前调用
  179. bool Parkspace_manager::check_car_existence(std::string license)
  180. {
  181. message::Parkspace_info parkspaceInfo;
  182. //获取车辆状态
  183. Error_manager error=m_parkspace_operating_function.query_one_parkspace_with_license(license,parkspaceInfo);
  184. //如果车辆处于停车中或者已入库 则车辆已存在
  185. if(!parkspaceInfo.has_car_info())
  186. {
  187. return false;
  188. }
  189. return true;
  190. }
  191. Error_manager Parkspace_manager::send_parkspace_data()
  192. {
  193. message::Parkspace_allocation_data_msg all_parkspace_data;
  194. Error_manager t_error=m_parkspace_operating_function.get_all_parkspace_info(all_parkspace_data);
  195. if(t_error != SUCCESS)
  196. {
  197. return t_error;
  198. }
  199. message::Base_info t_base_info;
  200. message::Error_manager error;
  201. t_base_info.set_msg_type(message::Message_type::eParkspace_allocation_data_msg);
  202. t_base_info.set_timeout_ms(5000);
  203. t_base_info.set_sender(message::Communicator::eParkspace);
  204. t_base_info.set_receiver(message::Communicator::eMain);
  205. all_parkspace_data.mutable_base_info()->CopyFrom(t_base_info);
  206. error.set_error_code(0);
  207. all_parkspace_data.mutable_error_manager()->CopyFrom(error);
  208. return Parkspace_communicator::get_instance_references().encapsulate_msg(all_parkspace_data.SerializeAsString());
  209. }
  210. //找到一个最优车位---方案一
  211. Error_manager Parkspace_manager::query_the_optimal_parkspace_serverA(message::Parkspace_info &parkspace_info,message::Car_info car_info,int terminal_id)
  212. {
  213. //车辆高大于1550mm分在四楼以下,小于1550mm分在四楼以上
  214. /*
  215. * K=j%15
  216. * P=i%6
  217. * S=15*d-(j%15)*(2*d-1)+[6*d-(i%6)(2*d-1)]*W W>1
  218. */
  219. int time_min=0;
  220. int parkingspace_index_id=-1;
  221. //判断是否是左半库
  222. if ( terminal_id<=3 && terminal_id>=0)
  223. {
  224. //如果是小车 (低于1.55米属于小车)
  225. if ( car_info.car_height() <= MIN_CAR_HIGH )
  226. {
  227. //获取所有小型车位信息
  228. message::Parkspace_allocation_data_msg all_min_parkspace_data;
  229. Error_manager t_error = m_parkspace_operating_function.get_specify_the_type_parkspace_info(all_min_parkspace_data, message::Parkspace_type::MIN_PARKINGSPACE);
  230. if (t_error != SUCCESS)
  231. {
  232. return t_error;
  233. }
  234. //遍历所有小型车位
  235. int i = 0;
  236. while (i < all_min_parkspace_data.parkspace_info_size())
  237. {
  238. //筛选出一号车库的小型车位(第一优先级)的空车位
  239. if (all_min_parkspace_data.parkspace_info(i).parkingspace_index_id() % 15 <= 8
  240. && all_min_parkspace_data.parkspace_info(i).parkingspace_index_id() % 15 >= 1
  241. && all_min_parkspace_data.parkspace_info(i).parkingspace_status() == message::Parkspace_status::eParkspace_empty)
  242. {
  243. //用时=目标终端到电梯口的距离/中跑车速度+(目标车位楼层-2)*楼层高度/电梯速度+电梯口到目标车位的距离/中跑车速度
  244. float time = terminal_id % 6 * TERMINAL_SPACING / MEDIUM_CAR_SPEED + DOWNSTAIRS_SPORTS_TIME +
  245. (all_min_parkspace_data.parkspace_info(i).parkingspace_floor_id() - 2) *all_min_parkspace_data.parkspace_info(i).parkingspace_height() /THE_ELEVATOR_SPEED +ELEVATOR_MOVEMENT_TIME +
  246. all_min_parkspace_data.parkspace_info(i).parkingspace_index_id() % 15 *all_min_parkspace_data.parkspace_info(i).parkingspace_width() / MEDIUM_CAR_SPEED + UPSTAIRS_SPORTS_TIME;
  247. if (time_min == 0)
  248. {
  249. time_min = time;
  250. parkingspace_index_id = i;
  251. }
  252. else
  253. {
  254. time_min = time < time_min ? time : time_min;
  255. parkingspace_index_id = i;
  256. }
  257. }
  258. ++i;
  259. }
  260. //判断小车车位(第一优先级)是否有找到合适的空车位 如果找到了 则不需要继续比较 直接返回
  261. if ( time_min!=0 && parkingspace_index_id!=-1 )
  262. {
  263. parkspace_info.CopyFrom(all_min_parkspace_data.parkspace_info(parkingspace_index_id));
  264. return Error_code::SUCCESS;
  265. }
  266. }
  267. if ( car_info.car_height() <= MID_CAR_HIGH )
  268. {
  269. //第二优先级(中型车位)
  270. //获取中型车位
  271. message::Parkspace_allocation_data_msg all_mid_parkspace_data;
  272. Error_manager t_error=m_parkspace_operating_function.get_specify_the_type_parkspace_info(all_mid_parkspace_data,message::Parkspace_type::MID_PARKINGSPACE);
  273. if(t_error != SUCCESS)
  274. {
  275. return t_error;
  276. }
  277. int i=0;
  278. while(i<all_mid_parkspace_data.parkspace_info_size())
  279. {
  280. //三楼的中型车位有单独的中跑车停车 且机械臂可以直接抓车到三楼
  281. if ( all_mid_parkspace_data.parkspace_info(i).parkingspace_index_id() >= 19
  282. && all_mid_parkspace_data.parkspace_info(i).parkingspace_index_id() <= 23)
  283. {
  284. //只需计算端口到车位的距离
  285. // 三楼中型用时=| 目标车位到电梯的距离 - 终端到电梯的距离 | / 中跑车速度
  286. int t_min=abs( i%15*all_mid_parkspace_data.parkspace_info(i).parkingspace_width()-terminal_id%6*TERMINAL_SPACING )/MEDIUM_CAR_SPEED+DOWNSTAIRS_SPORTS_TIME;
  287. if ( time_min == 0 )
  288. {
  289. time_min=t_min;
  290. parkingspace_index_id=i;
  291. }
  292. else
  293. {
  294. time_min=t_min<time_min?t_min:time_min;
  295. parkingspace_index_id=i;
  296. }
  297. }
  298. //如果是六楼的中型车位
  299. if ( all_mid_parkspace_data.parkspace_info(i).parkingspace_index_id() <= 68
  300. && all_mid_parkspace_data.parkspace_info(i).parkingspace_index_id() >=61
  301. && all_mid_parkspace_data.parkspace_info(i).parkingspace_status() == message::Parkspace_status::eParkspace_empty )
  302. {
  303. //用时=目标终端到电梯口的距离/中跑车速度+(目标车位楼层-2)*楼层高度/电梯速度+电梯口到目标车位的距离/中跑车速度
  304. float time=terminal_id%6*TERMINAL_SPACING/MEDIUM_CAR_SPEED + DOWNSTAIRS_SPORTS_TIME +
  305. (all_mid_parkspace_data.parkspace_info(i).parkingspace_floor_id()-2)*all_mid_parkspace_data.parkspace_info(i).parkingspace_height()/THE_ELEVATOR_SPEED + ELEVATOR_MOVEMENT_TIME +
  306. all_mid_parkspace_data.parkspace_info(i).parkingspace_index_id()%15*all_mid_parkspace_data.parkspace_info(i).parkingspace_width()/MEDIUM_CAR_SPEED + UPSTAIRS_SPORTS_TIME;
  307. if ( time_min == 0 )
  308. {
  309. time_min=time;
  310. parkingspace_index_id=i;
  311. }
  312. else
  313. {
  314. time_min=time<time_min?time:time_min;
  315. parkingspace_index_id=i;
  316. }
  317. }
  318. ++i;
  319. }
  320. //判断中型车位(第二优先级)是否有找到合适的空车位 如果找到了 直接返回
  321. if ( time_min!=0 && parkingspace_index_id!=-1 )
  322. {
  323. parkspace_info.CopyFrom(all_mid_parkspace_data.parkspace_info(parkingspace_index_id));
  324. return Error_code::SUCCESS;
  325. }
  326. }
  327. if ( car_info.car_height() <= BIG_CAR_HIGH )
  328. {
  329. //第三优先级(大型车位)
  330. //获取大型车位
  331. message::Parkspace_allocation_data_msg all_big_parkspace_data;
  332. Error_manager t_error=m_parkspace_operating_function.get_specify_the_type_parkspace_info(all_big_parkspace_data,message::Parkspace_type::BIG_PARKINGSPACE);
  333. if(t_error != SUCCESS)
  334. {
  335. return t_error;
  336. }
  337. int i=0;
  338. while(i<all_big_parkspace_data.parkspace_info_size())
  339. {
  340. //筛选出一号车库的小型车位的靠近电梯的左侧三排(第二优先级)的空车位
  341. if ( all_big_parkspace_data.parkspace_info(i).parkingspace_index_id()%15 <= 8
  342. && all_big_parkspace_data.parkspace_info(i).parkingspace_index_id()%15 >=1
  343. && all_big_parkspace_data.parkspace_info(i).parkingspace_status() == message::Parkspace_status::eParkspace_empty )
  344. {
  345. //如果是二楼车 则特殊处理
  346. if ( all_big_parkspace_data.parkspace_info(i).parkingspace_floor_id() == 2 )
  347. {
  348. // 二楼用时=| 目标车位到电梯的距离 - 终端到电梯的距离 | / 中跑车速度
  349. int t_min=abs( i%15*all_big_parkspace_data.parkspace_info(i).parkingspace_width()-terminal_id%6*TERMINAL_SPACING )/MEDIUM_CAR_SPEED+DOWNSTAIRS_SPORTS_TIME;
  350. if ( time_min == 0 )
  351. {
  352. time_min=t_min;
  353. parkingspace_index_id=i;
  354. }
  355. else
  356. {
  357. time_min=t_min<time_min?t_min:time_min;
  358. parkingspace_index_id=i;
  359. }
  360. }
  361. else
  362. {
  363. //用时=目标终端到电梯口的距离/中跑车速度+(目标车位楼层-2)*楼层高度/电梯速度+电梯口到目标车位的距离/中跑车速度
  364. float time=terminal_id%6*TERMINAL_SPACING/MEDIUM_CAR_SPEED + DOWNSTAIRS_SPORTS_TIME +
  365. (all_big_parkspace_data.parkspace_info(i).parkingspace_floor_id()-2)*all_big_parkspace_data.parkspace_info(i).parkingspace_height()/THE_ELEVATOR_SPEED + ELEVATOR_MOVEMENT_TIME +
  366. all_big_parkspace_data.parkspace_info(i).parkingspace_index_id()%15*all_big_parkspace_data.parkspace_info(i).parkingspace_width()/MEDIUM_CAR_SPEED + UPSTAIRS_SPORTS_TIME;
  367. if ( time_min == 0 )
  368. {
  369. time_min=time;
  370. parkingspace_index_id=i;
  371. }
  372. else
  373. {
  374. time_min=time<time_min?time:time_min;
  375. parkingspace_index_id=i;
  376. }
  377. }
  378. }
  379. ++i;
  380. }
  381. //判断大型车位(第三优先级)是否有找到合适的空车位 如果找到了 直接返回
  382. if ( time_min!=0 && parkingspace_index_id!=-1 )
  383. {
  384. parkspace_info.CopyFrom(all_big_parkspace_data.parkspace_info(parkingspace_index_id));
  385. return Error_code::SUCCESS;
  386. }
  387. else
  388. {
  389. return Error_manager(Error_code::PARKSPACE_ALLOCATOR_ALLOCATE_FAILED, Error_level::MINOR_ERROR,
  390. " query_the_optimal_parkspace_serverA error ");
  391. }
  392. }
  393. }
  394. //判断是否是右半库
  395. else if(terminal_id<=6 && terminal_id>=4)
  396. {
  397. //如果是小车 (低于1.55米属于小车)
  398. if ( car_info.car_height() <= MIN_CAR_HIGH )
  399. {
  400. //获取所有小型车位信息
  401. message::Parkspace_allocation_data_msg all_min_parkspace_data;
  402. Error_manager t_error = m_parkspace_operating_function.get_specify_the_type_parkspace_info(all_min_parkspace_data, message::Parkspace_type::MIN_PARKINGSPACE);
  403. if (t_error != SUCCESS)
  404. {
  405. return t_error;
  406. }
  407. //遍历所有小型车位
  408. int i = 0;
  409. while (i < all_min_parkspace_data.parkspace_info_size())
  410. {
  411. //筛选出一号车库的小型车位(第一优先级)的空车位
  412. if (all_min_parkspace_data.parkspace_info(i).parkingspace_index_id() <= 165
  413. && all_min_parkspace_data.parkspace_info(i).parkingspace_index_id() >= 54
  414. && all_min_parkspace_data.parkspace_info(i).parkingspace_status() == message::Parkspace_status::eParkspace_empty)
  415. {
  416. //用时=目标终端到电梯口的距离/中跑车速度+(目标车位楼层-2)*楼层高度/电梯速度+电梯口到目标车位的距离/中跑车速度
  417. float time = terminal_id % 6 * TERMINAL_SPACING / MEDIUM_CAR_SPEED + DOWNSTAIRS_SPORTS_TIME +
  418. (all_min_parkspace_data.parkspace_info(i).parkingspace_floor_id() - 2) *all_min_parkspace_data.parkspace_info(i).parkingspace_height() /THE_ELEVATOR_SPEED +ELEVATOR_MOVEMENT_TIME +
  419. all_min_parkspace_data.parkspace_info(i).parkingspace_index_id() % 15 *all_min_parkspace_data.parkspace_info(i).parkingspace_width() / MEDIUM_CAR_SPEED + UPSTAIRS_SPORTS_TIME;
  420. if (time_min == 0)
  421. {
  422. time_min = time;
  423. parkingspace_index_id = i;
  424. }
  425. else
  426. {
  427. time_min = time < time_min ? time : time_min;
  428. parkingspace_index_id = i;
  429. }
  430. }
  431. ++i;
  432. }
  433. //判断小车车位(第一优先级)是否有找到合适的空车位 如果找到了 则不需要继续比较 直接返回
  434. if ( time_min!=0 && parkingspace_index_id!=-1 )
  435. {
  436. parkspace_info.CopyFrom(all_min_parkspace_data.parkspace_info(parkingspace_index_id));
  437. return Error_code::SUCCESS;
  438. }
  439. }
  440. if ( car_info.car_height() <= MID_CAR_HIGH )
  441. {
  442. //第二优先级(中型车位)
  443. //获取中型车位
  444. message::Parkspace_allocation_data_msg all_mid_parkspace_data;
  445. Error_manager t_error=m_parkspace_operating_function.get_specify_the_type_parkspace_info(all_mid_parkspace_data,message::Parkspace_type::MID_PARKINGSPACE);
  446. if(t_error != SUCCESS)
  447. {
  448. return t_error;
  449. }
  450. int i=0;
  451. while(i<all_mid_parkspace_data.parkspace_info_size())
  452. {
  453. //三楼的中型车位有单独的中跑车停车 且机械臂可以直接抓车到三楼
  454. if ( all_mid_parkspace_data.parkspace_info(i).parkingspace_index_id() >= 24
  455. && all_mid_parkspace_data.parkspace_info(i).parkingspace_index_id() <= 27 )
  456. {
  457. //只需计算端口到车位的距离
  458. // 三楼中型车位用时=| 目标车位到电梯的距离 - 终端到电梯的距离 | / 中跑车速度
  459. int t_min=abs( i%15*all_mid_parkspace_data.parkspace_info(i).parkingspace_width()-terminal_id%6*TERMINAL_SPACING )/MEDIUM_CAR_SPEED+DOWNSTAIRS_SPORTS_TIME;
  460. if ( time_min == 0 )
  461. {
  462. time_min=t_min;
  463. parkingspace_index_id=i;
  464. }
  465. else
  466. {
  467. time_min=t_min<time_min?t_min:time_min;
  468. parkingspace_index_id=i;
  469. }
  470. }
  471. if ( all_mid_parkspace_data.parkspace_info(i).parkingspace_index_id() <= 75
  472. && all_mid_parkspace_data.parkspace_info(i).parkingspace_index_id() >= 69
  473. && all_mid_parkspace_data.parkspace_info(i).parkingspace_status() == message::Parkspace_status::eParkspace_empty )
  474. {
  475. //用时=目标终端到电梯口的距离/中跑车速度+(目标车位楼层-2)*楼层高度/电梯速度+电梯口到目标车位的距离/中跑车速度
  476. float time=terminal_id%6*TERMINAL_SPACING/MEDIUM_CAR_SPEED + DOWNSTAIRS_SPORTS_TIME +
  477. (all_mid_parkspace_data.parkspace_info(i).parkingspace_floor_id()-2)*all_mid_parkspace_data.parkspace_info(i).parkingspace_height()/THE_ELEVATOR_SPEED + ELEVATOR_MOVEMENT_TIME +
  478. all_mid_parkspace_data.parkspace_info(i).parkingspace_index_id()%15*all_mid_parkspace_data.parkspace_info(i).parkingspace_width()/MEDIUM_CAR_SPEED + UPSTAIRS_SPORTS_TIME;
  479. if ( time_min == 0 )
  480. {
  481. time_min=time;
  482. parkingspace_index_id=i;
  483. }
  484. else
  485. {
  486. time_min=time<time_min?time:time_min;
  487. parkingspace_index_id=i;
  488. }
  489. }
  490. ++i;
  491. }
  492. //判断中型车位(第二优先级)是否有找到合适的空车位 如果找到了 直接返回
  493. if ( time_min!=0 && parkingspace_index_id!=-1 )
  494. {
  495. parkspace_info.CopyFrom(all_mid_parkspace_data.parkspace_info(parkingspace_index_id));
  496. return Error_code::SUCCESS;
  497. }
  498. }
  499. if ( car_info.car_height() <= BIG_CAR_HIGH )
  500. {
  501. //第三优先级(大型车位)
  502. //获取大型车位
  503. message::Parkspace_allocation_data_msg all_big_parkspace_data;
  504. Error_manager t_error=m_parkspace_operating_function.get_specify_the_type_parkspace_info(all_big_parkspace_data,message::Parkspace_type::BIG_PARKINGSPACE);
  505. if(t_error != SUCCESS)
  506. {
  507. return t_error;
  508. }
  509. int i=0;
  510. while(i<all_big_parkspace_data.parkspace_info_size())
  511. {
  512. //筛选出二号车库的大型车位的空车位
  513. if ( all_big_parkspace_data.parkspace_info(i).parkingspace_index_id() <= 45
  514. && all_big_parkspace_data.parkspace_info(i).parkingspace_index_id() >= 9
  515. && all_big_parkspace_data.parkspace_info(i).parkingspace_status() == message::Parkspace_status::eParkspace_empty )
  516. {
  517. //如果是二楼车 则特殊处理
  518. if ( all_big_parkspace_data.parkspace_info(i).parkingspace_floor_id() == 2 )
  519. {
  520. // 二楼用时=| 目标车位到电梯的距离 - 终端到电梯的距离 | / 中跑车速度
  521. int t_min=abs( i%15*all_big_parkspace_data.parkspace_info(i).parkingspace_width()-terminal_id%6*TERMINAL_SPACING )/MEDIUM_CAR_SPEED+DOWNSTAIRS_SPORTS_TIME;
  522. if ( time_min == 0 )
  523. {
  524. time_min=t_min;
  525. parkingspace_index_id=i;
  526. }
  527. else
  528. {
  529. time_min=t_min<time_min?t_min:time_min;
  530. parkingspace_index_id=i;
  531. }
  532. }
  533. else
  534. {
  535. //用时=目标终端到电梯口的距离/中跑车速度+(目标车位楼层-2)*楼层高度/电梯速度+电梯口到目标车位的距离/中跑车速度
  536. float time=terminal_id%6*TERMINAL_SPACING/MEDIUM_CAR_SPEED + DOWNSTAIRS_SPORTS_TIME +
  537. (all_big_parkspace_data.parkspace_info(i).parkingspace_floor_id()-2)*all_big_parkspace_data.parkspace_info(i).parkingspace_height()/THE_ELEVATOR_SPEED + ELEVATOR_MOVEMENT_TIME +
  538. all_big_parkspace_data.parkspace_info(i).parkingspace_index_id()%15*all_big_parkspace_data.parkspace_info(i).parkingspace_width()/MEDIUM_CAR_SPEED + UPSTAIRS_SPORTS_TIME;
  539. if ( time_min == 0 )
  540. {
  541. time_min=time;
  542. parkingspace_index_id=i;
  543. }
  544. else
  545. {
  546. time_min=time<time_min?time:time_min;
  547. parkingspace_index_id=i;
  548. }
  549. }
  550. }
  551. ++i;
  552. }
  553. //判断大型车位(第三优先级)是否有找到合适的空车位 如果找到了 直接返回
  554. if ( time_min!=0 && parkingspace_index_id!=-1 )
  555. {
  556. parkspace_info.CopyFrom(all_big_parkspace_data.parkspace_info(parkingspace_index_id));
  557. return Error_code::SUCCESS;
  558. }
  559. else
  560. {
  561. return Error_manager(Error_code::PARKSPACE_ALLOCATOR_ALLOCATE_FAILED, Error_level::MINOR_ERROR,
  562. " query_the_optimal_parkspace_serverA error ");
  563. }
  564. }
  565. }
  566. else
  567. {
  568. return Error_manager(Error_code::PARAMETER_ERROR, Error_level::MINOR_ERROR,
  569. "query_the_optimal_parkspace_serverA error ");
  570. }
  571. }
  572. //找到一个最优车位---方案二
  573. //找左侧车位
  574. Error_manager Parkspace_manager::query_the_optimal_parkspace_serverB1(message::Parkspace_info &parkspace_info,message::Car_info car_info,int terminal_id)
  575. {
  576. //车辆高大于1550mm分在四楼以下,小于1550mm分在四楼以上
  577. /*
  578. * K=j%15
  579. * P=i%6
  580. * S=15*d-(j%15)*(2*d-1)+[6*d-(i%6)(2*d-1)]*W W>1
  581. */
  582. int time_min=0;
  583. int parkingspace_index_id=-1;
  584. //
  585. //如果是小车 (低于1.55米属于小车)
  586. if ( car_info.car_height() <= MIN_CAR_HIGH )
  587. {
  588. //获取所有小型车位信息
  589. message::Parkspace_allocation_data_msg all_min_parkspace_data;
  590. Error_manager t_error = m_parkspace_operating_function.get_specify_the_type_parkspace_info(all_min_parkspace_data, message::Parkspace_type::MIN_PARKINGSPACE);
  591. if (t_error != SUCCESS)
  592. {
  593. return t_error;
  594. }
  595. //遍历所有小型车位
  596. int i = 0;
  597. while (i < all_min_parkspace_data.parkspace_info_size())
  598. {
  599. //筛选出一号车库的小型车位的中间部分(第一优先级)的空车位
  600. if (all_min_parkspace_data.parkspace_info(i).parkingspace_index_id() % 15 <= 8
  601. && all_min_parkspace_data.parkspace_info(i).parkingspace_index_id() % 15 >= 4
  602. && all_min_parkspace_data.parkspace_info(i).parkingspace_status() == message::Parkspace_status::eParkspace_empty)
  603. {
  604. //用时=目标终端到电梯口的距离/中跑车速度+(目标车位楼层-2)*楼层高度/电梯速度+电梯口到目标车位的距离/中跑车速度
  605. float time = terminal_id % 6 * TERMINAL_SPACING / MEDIUM_CAR_SPEED + DOWNSTAIRS_SPORTS_TIME +
  606. (all_min_parkspace_data.parkspace_info(i).parkingspace_floor_id() - 2) *all_min_parkspace_data.parkspace_info(i).parkingspace_height() /THE_ELEVATOR_SPEED +ELEVATOR_MOVEMENT_TIME +
  607. all_min_parkspace_data.parkspace_info(i).parkingspace_index_id() % 15 *all_min_parkspace_data.parkspace_info(i).parkingspace_width() / MEDIUM_CAR_SPEED + UPSTAIRS_SPORTS_TIME;
  608. if (time_min == 0)
  609. {
  610. time_min = time;
  611. parkingspace_index_id = i;
  612. }
  613. else
  614. {
  615. time_min = time < time_min ? time : time_min;
  616. parkingspace_index_id = i;
  617. }
  618. }
  619. ++i;
  620. }
  621. //判断小车车位中间部分(第一优先级)是否有找到合适的空车位 如果找到了 则不需要继续比较 直接返回
  622. if ( time_min!=0 && parkingspace_index_id!=-1 )
  623. {
  624. parkspace_info.CopyFrom(all_min_parkspace_data.parkspace_info(parkingspace_index_id));
  625. return Error_code::SUCCESS;
  626. }
  627. else
  628. {
  629. //如果没找到则找小车车位第二优先级 (侧边)
  630. int i = 0;
  631. while (i < all_min_parkspace_data.parkspace_info_size())
  632. {
  633. //筛选出一号车库的小型车位的中间部分(第一优先级)的空车位
  634. if (all_min_parkspace_data.parkspace_info(i).parkingspace_index_id() % 15 <= 3
  635. && all_min_parkspace_data.parkspace_info(i).parkingspace_index_id() % 15 >= 1
  636. && all_min_parkspace_data.parkspace_info(i).parkingspace_status() == message::Parkspace_status::eParkspace_empty)
  637. {
  638. //用时=目标终端到电梯口的距离/中跑车速度+(目标车位楼层-2)*楼层高度/电梯速度+电梯口到目标车位的距离/中跑车速度
  639. float time = terminal_id % 6 * TERMINAL_SPACING / MEDIUM_CAR_SPEED + DOWNSTAIRS_SPORTS_TIME +
  640. (all_min_parkspace_data.parkspace_info(i).parkingspace_floor_id() - 2) *all_min_parkspace_data.parkspace_info(i).parkingspace_height() /THE_ELEVATOR_SPEED +ELEVATOR_MOVEMENT_TIME +
  641. all_min_parkspace_data.parkspace_info(i).parkingspace_index_id() % 15 *all_min_parkspace_data.parkspace_info(i).parkingspace_width() / MEDIUM_CAR_SPEED + UPSTAIRS_SPORTS_TIME;
  642. if (time_min == 0)
  643. {
  644. time_min = time;
  645. parkingspace_index_id = i;
  646. }
  647. else
  648. {
  649. time_min = time < time_min ? time : time_min;
  650. parkingspace_index_id = i;
  651. }
  652. }
  653. ++i;
  654. }
  655. //判断小车车位侧边部分(第二优先级)是否有找到合适的空车位 如果找到了 则不需要继续比较 直接返回
  656. if ( time_min!=0 && parkingspace_index_id!=-1 )
  657. {
  658. parkspace_info.CopyFrom(all_min_parkspace_data.parkspace_info(parkingspace_index_id));
  659. return Error_code::SUCCESS;
  660. }
  661. }
  662. }
  663. if ( car_info.car_height() <= MID_CAR_HIGH )
  664. {
  665. //第二优先级(中型车位)
  666. //获取中型车位
  667. message::Parkspace_allocation_data_msg all_mid_parkspace_data;
  668. Error_manager t_error=m_parkspace_operating_function.get_specify_the_type_parkspace_info(all_mid_parkspace_data,message::Parkspace_type::MID_PARKINGSPACE);
  669. if(t_error != SUCCESS)
  670. {
  671. return t_error;
  672. }
  673. int i=0;
  674. while(i<all_mid_parkspace_data.parkspace_info_size())
  675. {
  676. //如果是六楼的中型车位的中间部分(第一优先级)
  677. if ( all_mid_parkspace_data.parkspace_info(i).parkingspace_index_id() <= 68
  678. && all_mid_parkspace_data.parkspace_info(i).parkingspace_index_id() >=64
  679. && all_mid_parkspace_data.parkspace_info(i).parkingspace_status() == message::Parkspace_status::eParkspace_empty )
  680. {
  681. //用时=目标终端到电梯口的距离/中跑车速度+(目标车位楼层-2)*楼层高度/电梯速度+电梯口到目标车位的距离/中跑车速度
  682. float time=terminal_id%6*TERMINAL_SPACING/MEDIUM_CAR_SPEED + DOWNSTAIRS_SPORTS_TIME +
  683. (all_mid_parkspace_data.parkspace_info(i).parkingspace_floor_id()-2)*all_mid_parkspace_data.parkspace_info(i).parkingspace_height()/THE_ELEVATOR_SPEED + ELEVATOR_MOVEMENT_TIME +
  684. all_mid_parkspace_data.parkspace_info(i).parkingspace_index_id()%15*all_mid_parkspace_data.parkspace_info(i).parkingspace_width()/MEDIUM_CAR_SPEED + UPSTAIRS_SPORTS_TIME;
  685. if ( time_min == 0 )
  686. {
  687. time_min=time;
  688. parkingspace_index_id=i;
  689. }
  690. else
  691. {
  692. time_min=time<time_min?time:time_min;
  693. parkingspace_index_id=i;
  694. }
  695. }
  696. ++i;
  697. }
  698. //判断中型车位(第二优先级)是否有找到合适的空车位 如果找到了 直接返回
  699. if ( time_min!=0 && parkingspace_index_id!=-1 )
  700. {
  701. parkspace_info.CopyFrom(all_mid_parkspace_data.parkspace_info(parkingspace_index_id));
  702. return Error_code::SUCCESS;
  703. }
  704. }
  705. if ( car_info.car_height() <= BIG_CAR_HIGH )
  706. {
  707. //第三优先级(大型车位)
  708. //获取大型车位
  709. message::Parkspace_allocation_data_msg all_big_parkspace_data;
  710. Error_manager t_error=m_parkspace_operating_function.get_specify_the_type_parkspace_info(all_big_parkspace_data,message::Parkspace_type::BIG_PARKINGSPACE);
  711. if(t_error != SUCCESS)
  712. {
  713. return t_error;
  714. }
  715. int i=0;
  716. while(i<all_big_parkspace_data.parkspace_info_size())
  717. {
  718. //筛选出一号车库的小型车位的靠近电梯的左侧三排(第二优先级)的空车位
  719. if ( all_big_parkspace_data.parkspace_info(i).parkingspace_index_id()%15 <= 8
  720. && all_big_parkspace_data.parkspace_info(i).parkingspace_index_id()%15 >=1
  721. && all_big_parkspace_data.parkspace_info(i).parkingspace_status() == message::Parkspace_status::eParkspace_empty )
  722. {
  723. //如果是二楼车 则特殊处理
  724. if ( all_big_parkspace_data.parkspace_info(i).parkingspace_floor_id() == 2 )
  725. {
  726. // 二楼用时=| 目标车位到电梯的距离 - 终端到电梯的距离 | / 中跑车速度
  727. int t_min=abs( i%15*all_big_parkspace_data.parkspace_info(i).parkingspace_width()-terminal_id%6*TERMINAL_SPACING )/MEDIUM_CAR_SPEED+DOWNSTAIRS_SPORTS_TIME;
  728. if ( time_min == 0 )
  729. {
  730. time_min=t_min;
  731. parkingspace_index_id=i;
  732. }
  733. else
  734. {
  735. time_min=t_min<time_min?t_min:time_min;
  736. parkingspace_index_id=i;
  737. }
  738. }
  739. else
  740. {
  741. //用时=目标终端到电梯口的距离/中跑车速度+(目标车位楼层-2)*楼层高度/电梯速度+电梯口到目标车位的距离/中跑车速度
  742. float time=terminal_id%6*TERMINAL_SPACING/MEDIUM_CAR_SPEED + DOWNSTAIRS_SPORTS_TIME +
  743. (all_big_parkspace_data.parkspace_info(i).parkingspace_floor_id()-2)*all_big_parkspace_data.parkspace_info(i).parkingspace_height()/THE_ELEVATOR_SPEED + ELEVATOR_MOVEMENT_TIME +
  744. all_big_parkspace_data.parkspace_info(i).parkingspace_index_id()%15*all_big_parkspace_data.parkspace_info(i).parkingspace_width()/MEDIUM_CAR_SPEED + UPSTAIRS_SPORTS_TIME;
  745. if ( time_min == 0 )
  746. {
  747. time_min=time;
  748. parkingspace_index_id=i;
  749. }
  750. else
  751. {
  752. time_min=time<time_min?time:time_min;
  753. parkingspace_index_id=i;
  754. }
  755. }
  756. }
  757. ++i;
  758. }
  759. //判断大型车位(第三优先级)是否有找到合适的空车位 如果找到了 直接返回
  760. if ( time_min!=0 && parkingspace_index_id!=-1 )
  761. {
  762. parkspace_info.CopyFrom(all_big_parkspace_data.parkspace_info(parkingspace_index_id));
  763. return Error_code::SUCCESS;
  764. }
  765. else
  766. {
  767. return Error_manager(Error_code::PARKSPACE_ALLOCATOR_ALLOCATE_FAILED, Error_level::MINOR_ERROR,
  768. " query_the_optimal_parkspace_serverA error ");
  769. }
  770. }
  771. }
  772. //找右侧车位
  773. Error_manager Parkspace_manager::query_the_optimal_parkspace_serverB2(message::Parkspace_info &parkspace_info,message::Car_info car_info,int terminal_id)
  774. {
  775. //车辆高大于1550mm分在四楼以下,小于1550mm分在四楼以上
  776. /*
  777. * K=j%15
  778. * P=i%6
  779. * S=15*d-(j%15)*(2*d-1)+[6*d-(i%6)(2*d-1)]*W W>1
  780. */
  781. int time_min=0;
  782. int parkingspace_index_id=-1;
  783. }
  784. //找缓存区车位
  785. Error_manager Parkspace_manager::query_the_optimal_parkspace_serverB3(message::Parkspace_info &parkspace_info,message::Car_info car_info,int terminal_id)
  786. {
  787. //车辆高大于1550mm分在四楼以下,小于1550mm分在四楼以上
  788. /*
  789. * K=j%15
  790. * P=i%6
  791. * S=15*d-(j%15)*(2*d-1)+[6*d-(i%6)(2*d-1)]*W W>1
  792. */
  793. int time_min=0;
  794. int parkingspace_index_id=-1;
  795. }
  796. //分配车位线程函数
  797. void Parkspace_manager::execute_for_allocate(message::Car_info car_info, int terminal_id, std::string command_key)
  798. {
  799. LOG(INFO) << "分配车位 "<<"牌号:"<<car_info.license()<<" command_key="<<command_key; //huli printf command_key
  800. //根据请求的信息反馈分配的车位,并封装发送
  801. message::Parkspace_allocation_response_msg response_msg;
  802. message::Base_info t_response_header;
  803. t_response_header.set_msg_type(message::Message_type::eParkspace_allocation_response_msg);
  804. t_response_header.set_timeout_ms(1000);
  805. t_response_header.set_sender(message::Communicator::eParkspace);
  806. t_response_header.set_receiver(message::Communicator::eMain);
  807. message::Error_manager t_error;
  808. message::Parkspace_info t_allocated_space;
  809. Error_manager error;
  810. //分配之前查询车辆是否已经存在
  811. if(check_car_existence(car_info.license()))
  812. {
  813. t_error.set_error_code(PARKSPACE_ALLOCATOR_CAR_ALREADY_EXIST);
  814. t_error.set_error_level(message::Error_level::MAJOR_ERROR);
  815. t_error.set_error_description("车辆已存在");
  816. LOG(ERROR) << car_info.license()<<" 车辆已存在";
  817. }
  818. else
  819. {
  820. m_parkspace_lock.lock();
  821. //如果车辆不存在 则找到一个最优车位
  822. // error=query_the_optimal_parkspace(t_allocated_space,car_info,terminal_id);
  823. // query_the_optimal_parkspace_serverA(t_allocated_space,car_info,terminal_id);
  824. //如果车辆不存在则获取一个空车位
  825. error=m_parkspace_operating_function.query_one_empty_parkspace(t_allocated_space);
  826. if ( error != Error_code::SUCCESS )
  827. {
  828. t_error.set_error_code(error.get_error_code());
  829. t_error.set_error_level((message::Error_level)error.get_error_level());
  830. t_error.set_error_description(error.get_error_description());
  831. LOG(ERROR) << car_info.license()<<" 获取空车位失败 "<<error.to_string();
  832. }
  833. else
  834. {
  835. //修改车为状态为锁定
  836. t_allocated_space.set_parkingspace_status(message::Parkspace_status::eParkspace_locked);
  837. t_allocated_space.mutable_car_info()->CopyFrom(car_info);
  838. // 分配车位后更新车位状态
  839. error=m_parkspace_operating_function.update_parkspace_data(t_allocated_space);
  840. if ( error != SUCCESS )
  841. {
  842. t_error.set_error_code(error.get_error_code());
  843. t_error.set_error_level((message::Error_level)error.get_error_level());
  844. t_error.set_error_description(error.get_error_description());
  845. LOG(ERROR) << car_info.license()<<" 更新车位数据失败 "<<error.to_string();
  846. }
  847. else
  848. {
  849. //修改车辆状态为停车中
  850. message::Vehicle_status t_vehicle_status = message::Vehicle_status::eVehicle_parking;
  851. error=m_parkspace_operating_function.update_vehicle_with_parkspace(t_allocated_space,t_vehicle_status);
  852. if ( error != SUCCESS )
  853. {
  854. t_error.set_error_code(error.get_error_code());
  855. t_error.set_error_level((message::Error_level)error.get_error_level());
  856. t_error.set_error_description(error.get_error_description());
  857. LOG(ERROR) << car_info.license()<<" 更新车辆数据失败 "<<error.to_string();
  858. }
  859. else
  860. {
  861. t_error.set_error_code(SUCCESS);
  862. t_error.set_error_level(message::Error_level::NORMAL);
  863. LOG(INFO) <<"分配车位成功 "<<"车位ID:"<<t_allocated_space.parkingspace_index_id()<<" 车牌号:"<<t_allocated_space.car_info().license();
  864. }
  865. }
  866. }
  867. m_parkspace_lock.unlock();
  868. }
  869. response_msg.mutable_base_info()->CopyFrom(t_response_header);
  870. response_msg.set_command_key(command_key);
  871. response_msg.mutable_error_manager()->CopyFrom(t_error);
  872. response_msg.mutable_allocated_space_info()->CopyFrom(t_allocated_space);
  873. Communication_message response=Communication_message();
  874. response.reset(t_response_header, response_msg.SerializeAsString());
  875. Parkspace_communicator::get_instance_references().send_response(&response);
  876. send_parkspace_data();
  877. std::cout<<std::endl;
  878. }
  879. //查询车位线程函数
  880. void Parkspace_manager::execute_for_search(message::Car_info car_info,std::string command_key)
  881. {
  882. LOG(INFO) << "查询车位 "<<"牌号:"<<car_info.license()<<" command_key="<<command_key; //huli printf command_key
  883. //根据车辆凭证信息查询车辆位置
  884. message::Parkspace_search_response_msg response_msg;
  885. message::Base_info t_response_header;
  886. message::Error_manager t_error;
  887. message::Parkspace_info t_car_position;
  888. t_response_header.set_msg_type(message::Message_type::eParkspace_search_response_msg);
  889. t_response_header.set_timeout_ms(1000);
  890. t_response_header.set_sender(message::Communicator::eParkspace);
  891. t_response_header.set_receiver(message::Communicator::eMain);
  892. //查询车辆位置
  893. message::Parkspace_info parkspace_info;
  894. Error_manager error=m_parkspace_operating_function.query_one_parkspace_with_license(car_info.license(),parkspace_info);
  895. if ( error != SUCCESS )
  896. {
  897. t_error.set_error_code(error.get_error_code());
  898. t_error.set_error_level((message::Error_level)error.get_error_level());
  899. t_error.set_error_description(error.get_error_description());
  900. LOG(ERROR) << "查询车位失败 "<<error.to_string();
  901. }
  902. else
  903. {
  904. t_error.set_error_code(SUCCESS);
  905. t_error.set_error_level(message::Error_level::NORMAL);
  906. LOG(INFO) << "车辆"<<parkspace_info.car_info().license()<<" 在"<<parkspace_info.parkingspace_index_id()<<"号车位上";
  907. }
  908. response_msg.mutable_base_info()->CopyFrom(t_response_header);
  909. response_msg.set_command_key(command_key);
  910. response_msg.mutable_error_manager()->CopyFrom(t_error);
  911. response_msg.mutable_car_position()->CopyFrom(t_car_position);
  912. Communication_message response=Communication_message();
  913. response.reset(t_response_header, response_msg.SerializeAsString());
  914. Parkspace_communicator::get_instance_references().send_response(&response);
  915. std::cout<<std::endl;
  916. }
  917. //释放车位线程函数
  918. void Parkspace_manager::execute_for_release(message::Parkspace_info space_info, std::string command_key)
  919. {
  920. LOG(INFO) << "释放车位 "<<"牌号:"<<space_info.car_info().license()<<" command_key="<<command_key;
  921. //根据车位信息定位待释放车位位置,车辆凭证号用于校验
  922. message::Parkspace_release_response_msg response_msg;
  923. message::Base_info t_response_header;
  924. t_response_header.set_msg_type(message::eParkspace_release_response_msg);
  925. t_response_header.set_sender(message::eParkspace);
  926. t_response_header.set_receiver(message::eMain);
  927. t_response_header.set_timeout_ms(1000);
  928. message::Error_manager t_error;
  929. message::Parkspace_info t_release_space;
  930. //找到待释放的车位
  931. m_parkspace_lock.lock();
  932. Error_manager error=m_parkspace_operating_function.query_one_parkspace_with_parkspace_id(space_info.parkingspace_index_id(),t_release_space);
  933. if ( error != SUCCESS )
  934. {
  935. t_error.set_error_code(error.get_error_code());
  936. t_error.set_error_level((message::Error_level)error.get_error_level());
  937. t_error.set_error_description(error.get_error_description());
  938. LOG(ERROR) << "释放车位失败 "<<error.to_string();
  939. }
  940. else if(!t_release_space.has_car_info())
  941. {
  942. t_error.set_error_code(PARKSPACE_ALLOCATOR_RELEASE_FAILED);
  943. t_error.set_error_level(message::Error_level::MAJOR_ERROR);
  944. LOG(WARNING) << "传入待释放车位无车辆信息";
  945. }
  946. else
  947. {
  948. t_release_space.set_parkingspace_status(message::Parkspace_status::eParkspace_empty);
  949. error = m_parkspace_operating_function.update_parkspace_data(t_release_space);
  950. if (error != SUCCESS)
  951. {
  952. t_error.set_error_code(error.get_error_code());
  953. t_error.set_error_level((message::Error_level) error.get_error_level());
  954. t_error.set_error_description(error.get_error_description());
  955. LOG(ERROR) << "释放车位 更新数据库车位数据失败 " << error.to_string();
  956. }
  957. else
  958. {
  959. message::Vehicle_status t_vehicle_status = message::Vehicle_status::eVehicle_idle;
  960. error = m_parkspace_operating_function.update_vehicle_with_parkspace(t_release_space, t_vehicle_status);
  961. if (error != SUCCESS)
  962. {
  963. t_error.set_error_code(error.get_error_code());
  964. t_error.set_error_level((message::Error_level) error.get_error_level());
  965. t_error.set_error_description(error.get_error_description());
  966. LOG(ERROR) << "释放车位 更新数据库车辆数据失败 " << error.to_string();
  967. }
  968. else
  969. {
  970. t_error.set_error_code(SUCCESS);
  971. t_error.set_error_level(message::Error_level::NORMAL);
  972. LOG(INFO) << "第:" << t_release_space.parkingspace_index_id() << "号位 车辆: " << t_release_space.car_info().license()
  973. << " 释放成功";
  974. //获取预约ID
  975. int t_park_record_id;
  976. error = m_parkspace_operating_function.query_vehicle(t_release_space.car_info().license(),
  977. t_vehicle_status, t_park_record_id);
  978. if (error != SUCCESS)
  979. {
  980. t_error.set_error_code(error.get_error_code());
  981. t_error.set_error_level((message::Error_level) error.get_error_level());
  982. t_error.set_error_description(error.get_error_description());
  983. LOG(ERROR) << "释放车位 数据库查询车辆信息失败 " << error.to_string();
  984. }
  985. else if (t_vehicle_status == message::Vehicle_status::eVehicle_idle)
  986. {
  987. time_t tt = time(NULL);
  988. tm *t = localtime(&tt);
  989. char my_time_buf[255];
  990. memset(my_time_buf, 0, 255);
  991. sprintf(my_time_buf, "%d-%02d-%02d %02d:%02d:%02d",
  992. t->tm_year + 1900,
  993. t->tm_mon + 1,
  994. t->tm_mday,
  995. t->tm_hour,
  996. t->tm_min,
  997. t->tm_sec);
  998. t_release_space.set_leave_time(my_time_buf);
  999. error = m_parkspace_operating_function.update_parking_record(t_release_space, t_park_record_id);
  1000. if (error != SUCCESS)
  1001. {
  1002. t_error.set_error_code(error.get_error_code());
  1003. t_error.set_error_level((message::Error_level) error.get_error_level());
  1004. t_error.set_error_description(error.get_error_description());
  1005. LOG(ERROR) << "更新停车记录失败: " << error.to_string();
  1006. }
  1007. }
  1008. }
  1009. }
  1010. }
  1011. m_parkspace_lock.unlock();
  1012. response_msg.mutable_base_info()->CopyFrom(t_response_header);
  1013. response_msg.set_command_key(command_key);
  1014. response_msg.mutable_error_manager()->CopyFrom(t_error);
  1015. response_msg.mutable_release_space_info()->CopyFrom(t_release_space);
  1016. Communication_message response=Communication_message();
  1017. response.reset(t_response_header, response_msg.SerializeAsString());
  1018. Parkspace_communicator::get_instance_references().send_response(&response);
  1019. send_parkspace_data();
  1020. std::cout<<std::endl;
  1021. }
  1022. //强制更新车位信息线程函数
  1023. void Parkspace_manager::execute_for_force_update(message::Parkspace_info space_info, std::string command_key)
  1024. {
  1025. LOG(INFO) << "手动 "<<"牌号:"<<space_info.car_info().license()<<" command_key="<<command_key;
  1026. //根据车位信息定位待释放车位位置,车辆凭证号用于校验
  1027. //!!!!!此处跳过外部处理与调用的过程,直接在内部调用,发送分配结果用于测试,目前一直发布第一个车位
  1028. message::Parkspace_force_update_response_msg response_msg;
  1029. message::Base_info t_response_header;
  1030. t_response_header.set_msg_type(message::eParkspace_force_update_response_msg);
  1031. t_response_header.set_sender(message::eParkspace);
  1032. t_response_header.set_receiver(message::eMain);
  1033. t_response_header.set_timeout_ms(1000);
  1034. message::Error_manager t_error;
  1035. message::Parkspace_info t_update_space;
  1036. Error_manager error;
  1037. // id 9999为特殊情况,复位所有车位状态
  1038. if (space_info.parkingspace_index_id() == 9999)
  1039. {
  1040. // 复位所有车位状态
  1041. error=m_parkspace_operating_function.clear_all_parkspace_info();
  1042. if( error != SUCCESS)
  1043. {
  1044. t_error.set_error_code(error.get_error_code());
  1045. t_error.set_error_level((message::Error_level) error.get_error_level());
  1046. LOG(INFO) << "手动更新所有车位失败 "<<error.to_string();
  1047. }
  1048. else
  1049. {
  1050. t_error.set_error_code(SUCCESS);
  1051. t_error.set_error_level(message::Error_level::NORMAL);
  1052. LOG(INFO) << "所有车位已手动更新 ";
  1053. }
  1054. }
  1055. else
  1056. {
  1057. //手动修改车位信息
  1058. error = m_parkspace_operating_function.update_parkspace_data(t_update_space);
  1059. if (error != SUCCESS)
  1060. {
  1061. t_error.set_error_code(error.get_error_code());
  1062. t_error.set_error_level((message::Error_level)error.get_error_level());
  1063. LOG(INFO) << "手动 数据库更新车位失败 "<<error.to_string();
  1064. }
  1065. else
  1066. {
  1067. t_error.set_error_code(SUCCESS);
  1068. t_error.set_error_level(message::Error_level::NORMAL);
  1069. LOG(INFO) << "第" << t_update_space.parkingspace_index_id() << "号位已手动更新";
  1070. }
  1071. }
  1072. response_msg.mutable_base_info()->CopyFrom(t_response_header);
  1073. response_msg.set_command_key(command_key);
  1074. response_msg.mutable_error_manager()->CopyFrom(t_error);
  1075. response_msg.mutable_update_space_info()->CopyFrom(t_update_space);
  1076. Communication_message response=Communication_message();
  1077. response.reset(t_response_header, response_msg.SerializeAsString());
  1078. Parkspace_communicator::get_instance_references().send_response(&response);
  1079. send_parkspace_data();
  1080. }
  1081. //确认分配车位线程函数
  1082. void Parkspace_manager::execute_for_confirm_alloc(message::Parkspace_info space_info, std::string command_key)
  1083. {
  1084. LOG(INFO) << "确认分配 " << "牌号:" << space_info.car_info().license() << " command_key=" << command_key;
  1085. //根据车位信息定位待确认占用车位
  1086. message::Parkspace_confirm_alloc_response_msg response_msg;
  1087. message::Base_info t_response_header;
  1088. t_response_header.set_msg_type(message::eParkspace_confirm_alloc_response_msg);
  1089. t_response_header.set_sender(message::eParkspace);
  1090. t_response_header.set_receiver(message::eMain);
  1091. t_response_header.set_timeout_ms(1000);
  1092. message::Error_manager t_error;
  1093. message::Parkspace_info t_confirm_space;
  1094. Error_manager error;
  1095. //获取确认分配的车位
  1096. m_parkspace_lock.lock();
  1097. error = m_parkspace_operating_function.query_one_parkspace_with_parkspace_id(space_info.parkingspace_index_id(),
  1098. t_confirm_space);
  1099. if (error != SUCCESS)
  1100. {
  1101. t_error.set_error_code(error.get_error_code());
  1102. t_error.set_error_level((message::Error_level) error.get_error_level());
  1103. t_error.set_error_description(error.get_error_description());
  1104. LOG(ERROR) << "确认分配 查询车位信息失败 " << error.to_string();
  1105. }
  1106. else if (!t_confirm_space.has_car_info())
  1107. {
  1108. t_error.set_error_code(PARKSPACE_ALLOCATOR_RELEASE_FAILED);
  1109. t_error.set_error_level(message::Error_level::MAJOR_ERROR);
  1110. LOG(WARNING) << "传入待确认车位无车辆信息";
  1111. }
  1112. else
  1113. {
  1114. //校验车位状态是否为被锁定
  1115. if (t_confirm_space.parkingspace_status() != message::Parkspace_status::eParkspace_locked)
  1116. {
  1117. t_error.set_error_code(DB_QUERY_DATA_FAILED);
  1118. t_error.set_error_level(message::Error_level::MINOR_ERROR);
  1119. t_error.set_error_description("查询车位状态错误");
  1120. LOG(ERROR) << "确认分配 查询车位状态错误 " << error.to_string();
  1121. }
  1122. else
  1123. {
  1124. //修改车位状态为占用
  1125. t_confirm_space.set_parkingspace_status(message::Parkspace_status::eParkspace_occupied);
  1126. error = m_parkspace_operating_function.update_parkspace_data(t_confirm_space);
  1127. if (error != SUCCESS)
  1128. {
  1129. t_error.set_error_code(error.get_error_code());
  1130. t_error.set_error_level((message::Error_level) error.get_error_level());
  1131. LOG(INFO) << "确认分配 数据库更新车位失败 " << error.to_string();
  1132. }
  1133. else
  1134. {
  1135. //修改车辆状态为已入库
  1136. message::Vehicle_status t_vehicle_status = message::Vehicle_status::eVehicle_in_garage;
  1137. error = m_parkspace_operating_function.update_vehicle_with_parkspace(t_confirm_space, t_vehicle_status);
  1138. if (error != SUCCESS)
  1139. {
  1140. t_error.set_error_code(error.get_error_code());
  1141. t_error.set_error_level((message::Error_level) error.get_error_level());
  1142. t_error.set_error_description(error.get_error_description());
  1143. LOG(ERROR) << "确认分配 更新数据库车辆数据失败 " << error.to_string();
  1144. }
  1145. t_error.set_error_code(SUCCESS);
  1146. t_error.set_error_level(message::Error_level::NORMAL);
  1147. LOG(INFO) << "第:" << t_confirm_space.parkingspace_index_id() << "号位 车辆: " << t_confirm_space.car_info().license()<< " 确认占用成功";
  1148. //插入停车记录
  1149. time_t tt = time(NULL);
  1150. tm *t = localtime(&tt);
  1151. char my_time_buf[255];
  1152. memset(my_time_buf, 0, 255);
  1153. sprintf(my_time_buf, "%d-%02d-%02d %02d:%02d:%02d",
  1154. t->tm_year + 1900,
  1155. t->tm_mon + 1,
  1156. t->tm_mday,
  1157. t->tm_hour,
  1158. t->tm_min,
  1159. t->tm_sec);
  1160. t_confirm_space.set_entry_time(my_time_buf);
  1161. error = m_parkspace_operating_function.insert_parking_record(t_confirm_space);
  1162. if ( error != SUCCESS )
  1163. {
  1164. t_error.set_error_code(error.get_error_code());
  1165. t_error.set_error_level((message::Error_level) error.get_error_level());
  1166. LOG(ERROR) << "插入停车记录失败: " << error.to_string();
  1167. }
  1168. //查询停车记录的ID
  1169. int t_record_id;
  1170. error = m_parkspace_operating_function.query_parking_record(t_confirm_space,t_record_id);
  1171. if ( error != SUCCESS )
  1172. {
  1173. t_error.set_error_code(error.get_error_code());
  1174. t_error.set_error_level((message::Error_level) error.get_error_level());
  1175. LOG(ERROR) << "查询停车记录ID失败: " << error.to_string();
  1176. }
  1177. //更新停车记录ID
  1178. error = m_parkspace_operating_function.update_record_id(t_confirm_space.car_info().license(),t_record_id);
  1179. if ( error != SUCCESS )
  1180. {
  1181. t_error.set_error_code(error.get_error_code());
  1182. t_error.set_error_level((message::Error_level) error.get_error_level());
  1183. LOG(ERROR) << "更新停车记录ID失败: " << error.to_string();
  1184. }
  1185. }
  1186. }
  1187. }
  1188. m_parkspace_lock.unlock();
  1189. response_msg.mutable_base_info()->CopyFrom(t_response_header);
  1190. response_msg.set_command_key(command_key);
  1191. response_msg.mutable_error_manager()->CopyFrom(t_error);
  1192. response_msg.mutable_confirm_alloc_space_info()->CopyFrom(t_confirm_space);
  1193. Communication_message response=Communication_message();
  1194. response.reset(t_response_header, response_msg.SerializeAsString());
  1195. Parkspace_communicator::get_instance_references().send_response(&response);
  1196. send_parkspace_data();
  1197. std::cout<<std::endl;
  1198. }