parkspace_manager.cpp 67 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693
  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. float time_min=0;
  220. int parkingspace_index_id=-1;
  221. //判断是否是左半库
  222. if ( terminal_id<=3 && terminal_id>=0 )
  223. {
  224. LOG(INFO) << " 左半库 车牌号:"<<car_info.license()<<" 车高:"<<car_info.car_height()<< this;
  225. //如果是小车 (低于1.55米属于小车)
  226. if ( car_info.car_height() <= MIN_CAR_HIGH )
  227. {
  228. //获取所有小型车位信息
  229. message::Parkspace_allocation_data_msg all_min_parkspace_data;
  230. Error_manager t_error = m_parkspace_operating_function.get_specify_the_type_parkspace_info(all_min_parkspace_data, message::Parkspace_type::MIN_PARKINGSPACE);
  231. if (t_error != SUCCESS)
  232. {
  233. return t_error;
  234. }
  235. //遍历所有小型车位
  236. int i = 0;
  237. while (i < all_min_parkspace_data.parkspace_info_size())
  238. {
  239. int room_id=all_min_parkspace_data.parkspace_info(i).parkingspace_index_id();
  240. //筛选出一号车库的小型车位(第一优先级)的空车位
  241. if (room_id %15 <= 8 && room_id %15 >= 1
  242. && all_min_parkspace_data.parkspace_info(i).parkingspace_status() == message::Parkspace_status::eParkspace_empty)
  243. {
  244. //用时=目标终端到电梯口的距离/中跑车速度+(目标车位楼层-2)*楼层高度/电梯速度+电梯口到目标车位的距离/中跑车速度
  245. float time = terminal_id % 6 * TERMINAL_SPACING / MEDIUM_CAR_SPEED + DOWNSTAIRS_SPORTS_TIME +
  246. (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 +
  247. 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;
  248. if (time_min == 0)
  249. {
  250. time_min = time;
  251. parkingspace_index_id = i;
  252. }
  253. else
  254. {
  255. if ( time < time_min )
  256. {
  257. time_min = time;
  258. parkingspace_index_id = i;
  259. }
  260. }
  261. }
  262. ++i;
  263. }
  264. //判断小车车位(第一优先级)是否有找到合适的空车位 如果找到了 则不需要继续比较 直接返回
  265. if ( time_min!=0 && parkingspace_index_id!=-1 )
  266. {
  267. parkspace_info.CopyFrom(all_min_parkspace_data.parkspace_info(parkingspace_index_id));
  268. return Error_code::SUCCESS;
  269. }
  270. else
  271. {
  272. LOG(INFO) << " 小车车位未找到合适车位 "<< this;
  273. }
  274. }
  275. if ( car_info.car_height() <= MID_CAR_HIGH )
  276. {
  277. //第二优先级(中型车位)
  278. //获取中型车位
  279. message::Parkspace_allocation_data_msg all_mid_parkspace_data;
  280. Error_manager t_error=m_parkspace_operating_function.get_specify_the_type_parkspace_info(all_mid_parkspace_data,message::Parkspace_type::MID_PARKINGSPACE);
  281. if(t_error != SUCCESS)
  282. {
  283. return t_error;
  284. }
  285. int i=0;
  286. while(i<all_mid_parkspace_data.parkspace_info_size())
  287. {
  288. //三楼的中型车位有单独的中跑车停车 且机械臂可以直接抓车到三楼
  289. int room_id=all_mid_parkspace_data.parkspace_info(i).parkingspace_index_id();
  290. if ( room_id >= 19 && room_id <= 23)
  291. {
  292. //只需计算端口到车位的距离
  293. // 三楼中型用时=| 目标车位到电梯的距离 - 终端到电梯的距离 | / 中跑车速度
  294. float t_min=abs( room_id%15*all_mid_parkspace_data.parkspace_info(i).parkingspace_width()-(terminal_id%6+2)*TERMINAL_SPACING )/MEDIUM_CAR_SPEED+DOWNSTAIRS_SPORTS_TIME;
  295. if ( time_min == 0 )
  296. {
  297. time_min=t_min;
  298. parkingspace_index_id=i;
  299. }
  300. else
  301. {
  302. if ( t_min<time_min )
  303. {
  304. time_min=t_min;
  305. parkingspace_index_id=i;
  306. }
  307. }
  308. }
  309. //如果是六楼的中型车位
  310. if ( room_id <= 68 && room_id >=61
  311. && all_mid_parkspace_data.parkspace_info(i).parkingspace_status() == message::Parkspace_status::eParkspace_empty )
  312. {
  313. //用时=目标终端到电梯口的距离/中跑车速度+(目标车位楼层-2)*楼层高度/电梯速度+电梯口到目标车位的距离/中跑车速度
  314. float time=(terminal_id%6+2)*TERMINAL_SPACING/MEDIUM_CAR_SPEED + DOWNSTAIRS_SPORTS_TIME +
  315. (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 +
  316. 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;
  317. if ( time_min == 0 )
  318. {
  319. time_min=time;
  320. parkingspace_index_id=i;
  321. }
  322. else
  323. {
  324. if ( time<time_min )
  325. {
  326. time_min=time;
  327. parkingspace_index_id=i;
  328. }
  329. }
  330. }
  331. ++i;
  332. }
  333. //判断中型车位(第二优先级)是否有找到合适的空车位 如果找到了 直接返回
  334. if ( time_min!=0 && parkingspace_index_id!=-1 )
  335. {
  336. parkspace_info.CopyFrom(all_mid_parkspace_data.parkspace_info(parkingspace_index_id));
  337. return Error_code::SUCCESS;
  338. }
  339. else
  340. {
  341. LOG(INFO) << " 中车车位未找到合适车位 "<< this;
  342. }
  343. }
  344. if ( car_info.car_height() <= BIG_CAR_HIGH )
  345. {
  346. //第三优先级(大型车位)
  347. //获取大型车位
  348. message::Parkspace_allocation_data_msg all_big_parkspace_data;
  349. Error_manager t_error=m_parkspace_operating_function.get_specify_the_type_parkspace_info(all_big_parkspace_data,message::Parkspace_type::BIG_PARKINGSPACE);
  350. if(t_error != SUCCESS)
  351. {
  352. return t_error;
  353. }
  354. std::cout << " all_big_parkspace_data.parkspace_info_size() = " << all_big_parkspace_data.parkspace_info_size() << std::endl;
  355. int i=0;
  356. while(i<all_big_parkspace_data.parkspace_info_size())
  357. {
  358. int room_id=all_big_parkspace_data.parkspace_info(i).parkingspace_index_id();
  359. //筛选出一号车库的大型车位
  360. if ( room_id%15 <= 8 && room_id %15 >=1
  361. && all_big_parkspace_data.parkspace_info(i).parkingspace_status() == message::Parkspace_status::eParkspace_empty )
  362. {
  363. //如果是二楼车 则特殊处理
  364. if ( all_big_parkspace_data.parkspace_info(i).parkingspace_floor_id() == 2 )
  365. {
  366. // 二楼用时=| 目标车位到电梯的距离 - 终端到电梯的距离 | / 中跑车速度
  367. float t_min=abs( room_id%15*all_big_parkspace_data.parkspace_info(i).parkingspace_width() - (terminal_id%6+2)*TERMINAL_SPACING )/MEDIUM_CAR_SPEED+DOWNSTAIRS_SPORTS_TIME;
  368. if ( time_min == 0 )
  369. {
  370. time_min=t_min;
  371. parkingspace_index_id=i;
  372. }
  373. else
  374. {
  375. if ( t_min<time_min )
  376. {
  377. time_min=t_min;
  378. parkingspace_index_id=i;
  379. }
  380. }
  381. }
  382. else
  383. {
  384. //用时=目标终端到电梯口的距离/中跑车速度+(目标车位楼层-2)*楼层高度/电梯速度+电梯口到目标车位的距离/中跑车速度
  385. float time=(terminal_id%6+2)*TERMINAL_SPACING/MEDIUM_CAR_SPEED + DOWNSTAIRS_SPORTS_TIME +
  386. (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 +
  387. 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;
  388. if ( time_min == 0 )
  389. {
  390. time_min=time;
  391. parkingspace_index_id=i;
  392. }
  393. else
  394. {
  395. if ( time<time_min )
  396. {
  397. time_min=time;
  398. parkingspace_index_id=i;
  399. }
  400. }
  401. }
  402. }
  403. ++i;
  404. }
  405. //判断大型车位(第三优先级)是否有找到合适的空车位 如果找到了 直接返回
  406. if ( time_min!=0 && parkingspace_index_id!=-1 )
  407. {
  408. parkspace_info.CopyFrom(all_big_parkspace_data.parkspace_info(parkingspace_index_id));
  409. return Error_code::SUCCESS;
  410. }
  411. else
  412. {
  413. return Error_manager(Error_code::PARKSPACE_ALLOCATOR_ALLOCATE_FAILED, Error_level::MINOR_ERROR,
  414. " query_the_optimal_parkspace_serverA error ");
  415. }
  416. }
  417. }
  418. //判断是否是右半库
  419. else if(terminal_id<=6 && terminal_id>=4)
  420. {
  421. //如果是小车 (低于1.55米属于小车)
  422. if ( car_info.car_height() <= MIN_CAR_HIGH )
  423. {
  424. //获取所有小型车位信息
  425. message::Parkspace_allocation_data_msg all_min_parkspace_data;
  426. Error_manager t_error = m_parkspace_operating_function.get_specify_the_type_parkspace_info(all_min_parkspace_data, message::Parkspace_type::MIN_PARKINGSPACE);
  427. if (t_error != SUCCESS)
  428. {
  429. return t_error;
  430. }
  431. //遍历所有小型车位
  432. int i = 0;
  433. while (i < all_min_parkspace_data.parkspace_info_size())
  434. {
  435. int room_id=all_min_parkspace_data.parkspace_info(i).parkingspace_index_id();
  436. //筛选出一号车库的小型车位(第一优先级)的空车位
  437. if (room_id <= 165 && room_id >= 54
  438. && all_min_parkspace_data.parkspace_info(i).parkingspace_status() == message::Parkspace_status::eParkspace_empty)
  439. {
  440. //用时=目标终端到电梯口的距离/中跑车速度+(目标车位楼层-2)*楼层高度/电梯速度+电梯口到目标车位的距离/中跑车速度
  441. float time = terminal_id % 6 * TERMINAL_SPACING / MEDIUM_CAR_SPEED + DOWNSTAIRS_SPORTS_TIME +
  442. (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 +
  443. 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;
  444. if (time_min == 0)
  445. {
  446. time_min = time;
  447. parkingspace_index_id = i;
  448. }
  449. else
  450. {
  451. if ( time < time_min )
  452. {
  453. time_min = time;
  454. parkingspace_index_id = i;
  455. }
  456. }
  457. }
  458. ++i;
  459. }
  460. //判断小车车位(第一优先级)是否有找到合适的空车位 如果找到了 则不需要继续比较 直接返回
  461. if ( time_min!=0 && parkingspace_index_id!=-1 )
  462. {
  463. parkspace_info.CopyFrom(all_min_parkspace_data.parkspace_info(parkingspace_index_id));
  464. return Error_code::SUCCESS;
  465. }
  466. }
  467. if ( car_info.car_height() <= MID_CAR_HIGH )
  468. {
  469. //第二优先级(中型车位)
  470. //获取中型车位
  471. message::Parkspace_allocation_data_msg all_mid_parkspace_data;
  472. Error_manager t_error=m_parkspace_operating_function.get_specify_the_type_parkspace_info(all_mid_parkspace_data,message::Parkspace_type::MID_PARKINGSPACE);
  473. if(t_error != SUCCESS)
  474. {
  475. return t_error;
  476. }
  477. int i=0;
  478. while(i<all_mid_parkspace_data.parkspace_info_size())
  479. {
  480. int room_id=all_mid_parkspace_data.parkspace_info(i).parkingspace_index_id();
  481. //三楼的中型车位有单独的中跑车停车 且机械臂可以直接抓车到三楼
  482. if ( room_id >= 24 && room_id <= 27 )
  483. {
  484. //只需计算端口到车位的距离
  485. // 三楼中型车位用时=| 目标车位到电梯的距离 - 终端到电梯的距离 | / 中跑车速度
  486. float t_min=abs( room_id%15*all_mid_parkspace_data.parkspace_info(i).parkingspace_width()-(terminal_id%6+2)*TERMINAL_SPACING )/MEDIUM_CAR_SPEED+DOWNSTAIRS_SPORTS_TIME;
  487. if ( time_min == 0 )
  488. {
  489. time_min=t_min;
  490. parkingspace_index_id=i;
  491. }
  492. else
  493. {
  494. if ( t_min<time_min )
  495. {
  496. time_min=t_min;
  497. parkingspace_index_id=i;
  498. }
  499. }
  500. }
  501. if ( room_id <= 75 && room_id >= 69
  502. && all_mid_parkspace_data.parkspace_info(i).parkingspace_status() == message::Parkspace_status::eParkspace_empty )
  503. {
  504. //用时=目标终端到电梯口的距离/中跑车速度+(目标车位楼层-2)*楼层高度/电梯速度+电梯口到目标车位的距离/中跑车速度
  505. float time=(terminal_id%6+2)*TERMINAL_SPACING/MEDIUM_CAR_SPEED + DOWNSTAIRS_SPORTS_TIME +
  506. (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 +
  507. 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;
  508. if ( time_min == 0 )
  509. {
  510. time_min=time;
  511. parkingspace_index_id=i;
  512. }
  513. else
  514. {
  515. if ( time<time_min )
  516. {
  517. time_min=time;
  518. parkingspace_index_id=i;
  519. }
  520. }
  521. }
  522. ++i;
  523. }
  524. //判断中型车位(第二优先级)是否有找到合适的空车位 如果找到了 直接返回
  525. if ( time_min!=0 && parkingspace_index_id!=-1 )
  526. {
  527. parkspace_info.CopyFrom(all_mid_parkspace_data.parkspace_info(parkingspace_index_id));
  528. return Error_code::SUCCESS;
  529. }
  530. }
  531. if ( car_info.car_height() <= BIG_CAR_HIGH )
  532. {
  533. //第三优先级(大型车位)
  534. //获取大型车位
  535. message::Parkspace_allocation_data_msg all_big_parkspace_data;
  536. Error_manager t_error=m_parkspace_operating_function.get_specify_the_type_parkspace_info(all_big_parkspace_data,message::Parkspace_type::BIG_PARKINGSPACE);
  537. if(t_error != SUCCESS)
  538. {
  539. return t_error;
  540. }
  541. int i=0;
  542. while(i<all_big_parkspace_data.parkspace_info_size())
  543. {
  544. int room_id=all_big_parkspace_data.parkspace_info(i).parkingspace_index_id();
  545. //筛选出二号车库的大型车位的空车位
  546. if ( room_id %15 >=9 && room_id %15 <=14 || room_id %15 == 0
  547. && all_big_parkspace_data.parkspace_info(i).parkingspace_status() == message::Parkspace_status::eParkspace_empty )
  548. {
  549. //如果是二楼车 则特殊处理
  550. if ( all_big_parkspace_data.parkspace_info(i).parkingspace_floor_id() == 2 )
  551. {
  552. // 二楼用时=| 目标车位到电梯的距离 - 终端到电梯的距离 | / 中跑车速度
  553. float t_min=abs( room_id%15*all_big_parkspace_data.parkspace_info(i).parkingspace_width()-(terminal_id%6+2)*TERMINAL_SPACING )/MEDIUM_CAR_SPEED+DOWNSTAIRS_SPORTS_TIME;
  554. if ( time_min == 0 )
  555. {
  556. time_min=t_min;
  557. parkingspace_index_id=i;
  558. }
  559. else
  560. {
  561. if ( t_min<time_min )
  562. {
  563. time_min=t_min;
  564. parkingspace_index_id=i;
  565. }
  566. }
  567. }
  568. else
  569. {
  570. //用时=目标终端到电梯口的距离/中跑车速度+(目标车位楼层-2)*楼层高度/电梯速度+电梯口到目标车位的距离/中跑车速度
  571. float time=(terminal_id%6+2)*TERMINAL_SPACING/MEDIUM_CAR_SPEED + DOWNSTAIRS_SPORTS_TIME +
  572. (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 +
  573. 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;
  574. if ( time_min == 0 )
  575. {
  576. time_min=time;
  577. parkingspace_index_id=i;
  578. }
  579. else
  580. {
  581. if ( time<time_min )
  582. {
  583. time_min=time;
  584. parkingspace_index_id=i;
  585. }
  586. }
  587. }
  588. }
  589. ++i;
  590. }
  591. //判断大型车位(第三优先级)是否有找到合适的空车位 如果找到了 直接返回
  592. if ( time_min!=0 && parkingspace_index_id!=-1 )
  593. {
  594. parkspace_info.CopyFrom(all_big_parkspace_data.parkspace_info(parkingspace_index_id));
  595. return Error_code::SUCCESS;
  596. }
  597. else
  598. {
  599. return Error_manager(Error_code::PARKSPACE_ALLOCATOR_ALLOCATE_FAILED, Error_level::MINOR_ERROR,
  600. " query_the_optimal_parkspace_serverA error ");
  601. }
  602. }
  603. }
  604. else
  605. {
  606. return Error_manager(Error_code::PARAMETER_ERROR, Error_level::MINOR_ERROR,
  607. "query_the_optimal_parkspace_serverA error ");
  608. }
  609. }
  610. //找到一个最优车位---方案二
  611. //找左侧车位
  612. Error_manager Parkspace_manager::query_the_optimal_parkspace_serverB1(message::Parkspace_info &parkspace_info,message::Car_info car_info,int terminal_id)
  613. {
  614. //车辆高大于1550mm分在四楼以下,小于1550mm分在四楼以上
  615. /*
  616. * K=j%15
  617. * P=i%6
  618. * S=15*d-(j%15)*(2*d-1)+[6*d-(i%6)(2*d-1)]*W W>1
  619. */
  620. float time_min=0;
  621. int parkingspace_index_id=-1;
  622. //找左侧车位
  623. //如果是小车 (低于1.55米属于小车)
  624. if ( car_info.car_height() <= MIN_CAR_HIGH )
  625. {
  626. //获取所有小型车位信息
  627. message::Parkspace_allocation_data_msg all_min_parkspace_data;
  628. Error_manager t_error = m_parkspace_operating_function.get_specify_the_type_parkspace_info(all_min_parkspace_data, message::Parkspace_type::MIN_PARKINGSPACE);
  629. if (t_error != SUCCESS)
  630. {
  631. return t_error;
  632. }
  633. //遍历所有小型车位
  634. int i = 0;
  635. while (i < all_min_parkspace_data.parkspace_info_size())
  636. {
  637. int room_id=all_min_parkspace_data.parkspace_info(i).parkingspace_index_id();
  638. //筛选出小型车位的中间部分(第一优先级)的空车位
  639. if (room_id % 15 <= 8 && room_id % 15 >= 4
  640. && all_min_parkspace_data.parkspace_info(i).parkingspace_status() == message::Parkspace_status::eParkspace_empty)
  641. {
  642. //用时=目标终端到电梯口的距离/中跑车速度+(目标车位楼层-2)*楼层高度/电梯速度+电梯口到目标车位的距离/中跑车速度
  643. float time = terminal_id % 6 * TERMINAL_SPACING / MEDIUM_CAR_SPEED + DOWNSTAIRS_SPORTS_TIME +
  644. (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 +
  645. 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;
  646. if (time_min == 0)
  647. {
  648. time_min = time;
  649. parkingspace_index_id = i;
  650. }
  651. else
  652. {
  653. if ( time<time_min )
  654. {
  655. time_min=time;
  656. parkingspace_index_id=i;
  657. }
  658. }
  659. }
  660. ++i;
  661. }
  662. //判断小车车位中间部分(第一优先级)是否有找到合适的空车位 如果找到了 则不需要继续比较 直接返回
  663. if ( time_min!=0 && parkingspace_index_id!=-1 )
  664. {
  665. parkspace_info.CopyFrom(all_min_parkspace_data.parkspace_info(parkingspace_index_id));
  666. return Error_code::SUCCESS;
  667. }
  668. else
  669. {
  670. //如果没找到则找小车车位第二优先级 (侧边)
  671. int i = 0;
  672. while (i < all_min_parkspace_data.parkspace_info_size())
  673. {
  674. int room_id=all_min_parkspace_data.parkspace_info(i).parkingspace_index_id();
  675. //筛选出一号车库的小型车位的中间部分(第一优先级)的空车位
  676. if (room_id % 15 <= 3 && room_id % 15 >= 1
  677. && all_min_parkspace_data.parkspace_info(i).parkingspace_status() == message::Parkspace_status::eParkspace_empty)
  678. {
  679. //用时=目标终端到电梯口的距离/中跑车速度+(目标车位楼层-2)*楼层高度/电梯速度+电梯口到目标车位的距离/中跑车速度
  680. float time = terminal_id % 6 * TERMINAL_SPACING / MEDIUM_CAR_SPEED + DOWNSTAIRS_SPORTS_TIME +
  681. (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 +
  682. 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;
  683. if (time_min == 0)
  684. {
  685. time_min = time;
  686. parkingspace_index_id = i;
  687. }
  688. else
  689. {
  690. if ( time < time_min )
  691. {
  692. time_min = time;
  693. parkingspace_index_id = i;
  694. }
  695. }
  696. }
  697. ++i;
  698. }
  699. //判断小车车位侧边部分(第二优先级)是否有找到合适的空车位 如果找到了 则不需要继续比较 直接返回
  700. if ( time_min!=0 && parkingspace_index_id!=-1 )
  701. {
  702. parkspace_info.CopyFrom(all_min_parkspace_data.parkspace_info(parkingspace_index_id));
  703. return Error_code::SUCCESS;
  704. }
  705. }
  706. }
  707. if ( car_info.car_height() <= MID_CAR_HIGH )
  708. {
  709. //找中型车位
  710. //获取中型车位
  711. message::Parkspace_allocation_data_msg all_mid_parkspace_data;
  712. Error_manager t_error=m_parkspace_operating_function.get_specify_the_type_parkspace_info(all_mid_parkspace_data,message::Parkspace_type::MID_PARKINGSPACE);
  713. if(t_error != SUCCESS)
  714. {
  715. return t_error;
  716. }
  717. int i=0;
  718. while(i<all_mid_parkspace_data.parkspace_info_size())
  719. {
  720. int room_id=all_mid_parkspace_data.parkspace_info(i).parkingspace_index_id();
  721. //如果是六楼的中型车位的中间部分(第一优先级)
  722. if ( room_id >=64 && room_id <= 68
  723. && all_mid_parkspace_data.parkspace_info(i).parkingspace_status() == message::Parkspace_status::eParkspace_empty )
  724. {
  725. //用时=目标终端到电梯口的距离/中跑车速度+(目标车位楼层-2)*楼层高度/电梯速度+电梯口到目标车位的距离/中跑车速度
  726. float time=(terminal_id%6+2)*TERMINAL_SPACING/MEDIUM_CAR_SPEED + DOWNSTAIRS_SPORTS_TIME +
  727. (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 +
  728. 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;
  729. if ( time_min == 0 )
  730. {
  731. time_min=time;
  732. parkingspace_index_id=i;
  733. }
  734. else
  735. {
  736. if ( time<time_min )
  737. {
  738. time_min=time;
  739. parkingspace_index_id=i;
  740. }
  741. }
  742. }
  743. ++i;
  744. }
  745. //判断中型车位的中间部分(第一优先级)是否有找到合适的空车位 如果找到了 直接返回
  746. if ( time_min!=0 && parkingspace_index_id!=-1 )
  747. {
  748. parkspace_info.CopyFrom(all_mid_parkspace_data.parkspace_info(parkingspace_index_id));
  749. return Error_code::SUCCESS;
  750. }
  751. else
  752. {
  753. //如果没找到则找侧边中型车位(第二优先级)
  754. int i=0;
  755. while(i<all_mid_parkspace_data.parkspace_info_size())
  756. {
  757. int room_id=all_mid_parkspace_data.parkspace_info(i).parkingspace_index_id();
  758. //如果是六楼的中型车位的侧边(第二优先级)
  759. if ( room_id >=61 && room_id <= 63
  760. && all_mid_parkspace_data.parkspace_info(i).parkingspace_status() == message::Parkspace_status::eParkspace_empty )
  761. {
  762. //用时=目标终端到电梯口的距离/中跑车速度+(目标车位楼层-2)*楼层高度/电梯速度+电梯口到目标车位的距离/中跑车速度
  763. float time=(terminal_id%6+2)*TERMINAL_SPACING/MEDIUM_CAR_SPEED + DOWNSTAIRS_SPORTS_TIME +
  764. (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 +
  765. 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;
  766. if ( time_min == 0 )
  767. {
  768. time_min=time;
  769. parkingspace_index_id=i;
  770. }
  771. else
  772. {
  773. if ( time<time_min )
  774. {
  775. time_min=time;
  776. parkingspace_index_id=i;
  777. }
  778. }
  779. }
  780. ++i;
  781. }
  782. //判断中型车位侧边(第二优先级)是否有找到合适的空车位 如果找到了 直接返回
  783. if ( time_min!=0 && parkingspace_index_id!=-1 )
  784. {
  785. parkspace_info.CopyFrom(all_mid_parkspace_data.parkspace_info(parkingspace_index_id));
  786. return Error_code::SUCCESS;
  787. }
  788. }
  789. }
  790. if ( car_info.car_height() <= BIG_CAR_HIGH )
  791. {
  792. //找大型车位
  793. //获取大型车位
  794. message::Parkspace_allocation_data_msg all_big_parkspace_data;
  795. Error_manager t_error=m_parkspace_operating_function.get_specify_the_type_parkspace_info(all_big_parkspace_data,message::Parkspace_type::BIG_PARKINGSPACE);
  796. if(t_error != SUCCESS)
  797. {
  798. return t_error;
  799. }
  800. int i=0;
  801. while(i<all_big_parkspace_data.parkspace_info_size())
  802. {
  803. int room_id=all_big_parkspace_data.parkspace_info(i).parkingspace_index_id();
  804. //筛选出一号车库的小型车位的靠近电梯的左侧三排(第二优先级)的空车位
  805. if ( room_id %15 == 1 || room_id %15 == 2 || room_id %15 == 3 || room_id>=34 && room_id<=38
  806. && all_big_parkspace_data.parkspace_info(i).parkingspace_status() == message::Parkspace_status::eParkspace_empty )
  807. {
  808. //如果是二楼车 则特殊处理
  809. if ( all_big_parkspace_data.parkspace_info(i).parkingspace_floor_id() == 2 )
  810. {
  811. // 二楼用时=| 目标车位到电梯的距离 - 终端到电梯的距离 | / 中跑车速度
  812. float t_min=abs( room_id%15*all_big_parkspace_data.parkspace_info(i).parkingspace_width()-(terminal_id%6+2)*TERMINAL_SPACING )/MEDIUM_CAR_SPEED+DOWNSTAIRS_SPORTS_TIME;
  813. if ( time_min == 0 )
  814. {
  815. time_min=t_min;
  816. parkingspace_index_id=i;
  817. }
  818. else
  819. {
  820. if ( t_min<time_min )
  821. {
  822. time_min=t_min;
  823. parkingspace_index_id=i;
  824. }
  825. }
  826. }
  827. else
  828. {
  829. //用时=目标终端到电梯口的距离/中跑车速度+(目标车位楼层-2)*楼层高度/电梯速度+电梯口到目标车位的距离/中跑车速度
  830. float time=(terminal_id%6+2)*TERMINAL_SPACING/MEDIUM_CAR_SPEED + DOWNSTAIRS_SPORTS_TIME +
  831. (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 +
  832. 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;
  833. if ( time_min == 0 )
  834. {
  835. time_min=time;
  836. parkingspace_index_id=i;
  837. }
  838. else
  839. {
  840. if ( time<time_min )
  841. {
  842. time_min=time;
  843. parkingspace_index_id=i;
  844. }
  845. }
  846. }
  847. }
  848. ++i;
  849. }
  850. //判断大型车位是否有找到合适的空车位 如果找到了 直接返回
  851. if ( time_min!=0 && parkingspace_index_id!=-1 )
  852. {
  853. parkspace_info.CopyFrom(all_big_parkspace_data.parkspace_info(parkingspace_index_id));
  854. return Error_code::SUCCESS;
  855. }
  856. else
  857. {
  858. //如果没找到则代表左侧没找到合适车位
  859. parkspace_info.set_parkingspace_index_id(-1);
  860. return Error_manager(Error_code::PARKSPACE_ALLOCATOR_ALLOCATE_FAILED, Error_level::NEGLIGIBLE_ERROR,
  861. "query_the_optimal_parkspace_serverB1 error ");
  862. }
  863. }
  864. return Error_manager(Error_code::PARAMETER_ERROR, Error_level::MINOR_ERROR,
  865. " query_the_optimal_parkspace_serverB1 error ");
  866. }
  867. //找右侧车位
  868. Error_manager Parkspace_manager::query_the_optimal_parkspace_serverB2(message::Parkspace_info &parkspace_info,message::Car_info car_info,int terminal_id)
  869. {
  870. //车辆高大于1550mm分在四楼以下,小于1550mm分在四楼以上
  871. /*
  872. * K=j%15
  873. * P=i%6
  874. * S=15*d-(j%15)*(2*d-1)+[6*d-(i%6)(2*d-1)]*W W>1
  875. */
  876. float time_min=0;
  877. int parkingspace_index_id=-1;
  878. //找右侧车位
  879. //如果是小车 (低于1.55米属于小车)
  880. if ( car_info.car_height() <= MIN_CAR_HIGH )
  881. {
  882. //获取所有小型车位信息
  883. message::Parkspace_allocation_data_msg all_min_parkspace_data;
  884. Error_manager t_error = m_parkspace_operating_function.get_specify_the_type_parkspace_info(all_min_parkspace_data, message::Parkspace_type::MIN_PARKINGSPACE);
  885. if (t_error != SUCCESS)
  886. {
  887. return t_error;
  888. }
  889. //遍历所有小型车位
  890. int i = 0;
  891. while (i < all_min_parkspace_data.parkspace_info_size())
  892. {
  893. int room_id=all_min_parkspace_data.parkspace_info(i).parkingspace_index_id();
  894. //筛选出小型车位的中间部分(第一优先级)的空车位
  895. if (room_id % 15 >= 9 && room_id % 15 <= 12
  896. && all_min_parkspace_data.parkspace_info(i).parkingspace_status() == message::Parkspace_status::eParkspace_empty)
  897. {
  898. //用时=目标终端到电梯口的距离/中跑车速度+(目标车位楼层-2)*楼层高度/电梯速度+电梯口到目标车位的距离/中跑车速度
  899. float time = terminal_id % 6 * TERMINAL_SPACING / MEDIUM_CAR_SPEED + DOWNSTAIRS_SPORTS_TIME +
  900. (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 +
  901. 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;
  902. if (time_min == 0)
  903. {
  904. time_min = time;
  905. parkingspace_index_id = i;
  906. }
  907. else
  908. {
  909. if ( time<time_min )
  910. {
  911. time_min=time;
  912. parkingspace_index_id=i;
  913. }
  914. }
  915. }
  916. ++i;
  917. }
  918. //判断小车车位中间部分(第一优先级)是否有找到合适的空车位 如果找到了 则不需要继续比较 直接返回
  919. if ( time_min!=0 && parkingspace_index_id!=-1 )
  920. {
  921. parkspace_info.CopyFrom(all_min_parkspace_data.parkspace_info(parkingspace_index_id));
  922. return Error_code::SUCCESS;
  923. }
  924. else
  925. {
  926. //如果没找到则找小车车位第二优先级 (侧边)
  927. int i = 0;
  928. while (i < all_min_parkspace_data.parkspace_info_size())
  929. {
  930. int room_id=all_min_parkspace_data.parkspace_info(i).parkingspace_index_id();
  931. //筛选出一号车库的小型车位的中间部分(第一优先级)的空车位
  932. if (room_id % 15 == 13 || room_id % 15 == 14 || room_id % 15 == 0
  933. && all_min_parkspace_data.parkspace_info(i).parkingspace_status() == message::Parkspace_status::eParkspace_empty)
  934. {
  935. //用时=目标终端到电梯口的距离/中跑车速度+(目标车位楼层-2)*楼层高度/电梯速度+电梯口到目标车位的距离/中跑车速度
  936. float time = terminal_id % 6 * TERMINAL_SPACING / MEDIUM_CAR_SPEED + DOWNSTAIRS_SPORTS_TIME +
  937. (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 +
  938. 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;
  939. if (time_min == 0)
  940. {
  941. time_min = time;
  942. parkingspace_index_id = i;
  943. }
  944. else
  945. {
  946. if ( time < time_min )
  947. {
  948. time_min = time;
  949. parkingspace_index_id = i;
  950. }
  951. }
  952. }
  953. ++i;
  954. }
  955. //判断小车车位侧边部分(第二优先级)是否有找到合适的空车位 如果找到了 则不需要继续比较 直接返回
  956. if ( time_min!=0 && parkingspace_index_id!=-1 )
  957. {
  958. parkspace_info.CopyFrom(all_min_parkspace_data.parkspace_info(parkingspace_index_id));
  959. return Error_code::SUCCESS;
  960. }
  961. }
  962. }
  963. if ( car_info.car_height() <= MID_CAR_HIGH )
  964. {
  965. //找中型车位
  966. //获取中型车位
  967. message::Parkspace_allocation_data_msg all_mid_parkspace_data;
  968. Error_manager t_error=m_parkspace_operating_function.get_specify_the_type_parkspace_info(all_mid_parkspace_data,message::Parkspace_type::MID_PARKINGSPACE);
  969. if(t_error != SUCCESS)
  970. {
  971. return t_error;
  972. }
  973. int i=0;
  974. while(i<all_mid_parkspace_data.parkspace_info_size())
  975. {
  976. int room_id=all_mid_parkspace_data.parkspace_info(i).parkingspace_index_id();
  977. //如果是六楼的中型车位的中间部分(第一优先级)
  978. if ( room_id >= 69 && room_id <= 72
  979. && all_mid_parkspace_data.parkspace_info(i).parkingspace_status() == message::Parkspace_status::eParkspace_empty )
  980. {
  981. //用时=目标终端到电梯口的距离/中跑车速度+(目标车位楼层-2)*楼层高度/电梯速度+电梯口到目标车位的距离/中跑车速度
  982. float time=(terminal_id%6+2)*TERMINAL_SPACING/MEDIUM_CAR_SPEED + DOWNSTAIRS_SPORTS_TIME +
  983. (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 +
  984. 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;
  985. if ( time_min == 0 )
  986. {
  987. time_min=time;
  988. parkingspace_index_id=i;
  989. }
  990. else
  991. {
  992. if ( time<time_min )
  993. {
  994. time_min=time;
  995. parkingspace_index_id=i;
  996. }
  997. }
  998. }
  999. ++i;
  1000. }
  1001. //判断中型车位的中间部分(第一优先级)是否有找到合适的空车位 如果找到了 直接返回
  1002. if ( time_min!=0 && parkingspace_index_id!=-1 )
  1003. {
  1004. parkspace_info.CopyFrom(all_mid_parkspace_data.parkspace_info(parkingspace_index_id));
  1005. return Error_code::SUCCESS;
  1006. }
  1007. else
  1008. {
  1009. //如果没找到则找侧边中型车位(第二优先级)
  1010. int i=0;
  1011. while(i<all_mid_parkspace_data.parkspace_info_size())
  1012. {
  1013. int room_id=all_mid_parkspace_data.parkspace_info(i).parkingspace_index_id();
  1014. //如果是六楼的中型车位的侧边(第二优先级)
  1015. if ( room_id >=73 && room_id <= 75
  1016. && all_mid_parkspace_data.parkspace_info(i).parkingspace_status() == message::Parkspace_status::eParkspace_empty )
  1017. {
  1018. //用时=目标终端到电梯口的距离/中跑车速度+(目标车位楼层-2)*楼层高度/电梯速度+电梯口到目标车位的距离/中跑车速度
  1019. float time=(terminal_id%6+2)*TERMINAL_SPACING/MEDIUM_CAR_SPEED + DOWNSTAIRS_SPORTS_TIME +
  1020. (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 +
  1021. 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;
  1022. if ( time_min == 0 )
  1023. {
  1024. time_min=time;
  1025. parkingspace_index_id=i;
  1026. }
  1027. else
  1028. {
  1029. if ( time<time_min )
  1030. {
  1031. time_min=time;
  1032. parkingspace_index_id=i;
  1033. }
  1034. }
  1035. }
  1036. ++i;
  1037. }
  1038. //判断中型车位侧边(第二优先级)是否有找到合适的空车位 如果找到了 直接返回
  1039. if ( time_min!=0 && parkingspace_index_id!=-1 )
  1040. {
  1041. parkspace_info.CopyFrom(all_mid_parkspace_data.parkspace_info(parkingspace_index_id));
  1042. return Error_code::SUCCESS;
  1043. }
  1044. }
  1045. }
  1046. if ( car_info.car_height() <= BIG_CAR_HIGH )
  1047. {
  1048. //找大型车位
  1049. //获取大型车位
  1050. message::Parkspace_allocation_data_msg all_big_parkspace_data;
  1051. Error_manager t_error=m_parkspace_operating_function.get_specify_the_type_parkspace_info(all_big_parkspace_data,message::Parkspace_type::BIG_PARKINGSPACE);
  1052. if(t_error != SUCCESS)
  1053. {
  1054. return t_error;
  1055. }
  1056. int i=0;
  1057. while(i<all_big_parkspace_data.parkspace_info_size())
  1058. {
  1059. int room_id=all_big_parkspace_data.parkspace_info(i).parkingspace_index_id();
  1060. //筛选出大型车位的靠近电梯的右侧三排(第二优先级)的空车位
  1061. if ( room_id %15 == 13 || room_id %15 == 14 || room_id %15 == 0|| room_id>=39 && room_id<=42
  1062. && all_big_parkspace_data.parkspace_info(i).parkingspace_status() == message::Parkspace_status::eParkspace_empty )
  1063. {
  1064. //如果是二楼车 则特殊处理
  1065. if ( all_big_parkspace_data.parkspace_info(i).parkingspace_floor_id() == 2 )
  1066. {
  1067. // 二楼用时=| 目标车位到电梯的距离 - 终端到电梯的距离 | / 中跑车速度
  1068. float t_min=abs( room_id%15*all_big_parkspace_data.parkspace_info(i).parkingspace_width()-(terminal_id%6+2)*TERMINAL_SPACING )/MEDIUM_CAR_SPEED+DOWNSTAIRS_SPORTS_TIME;
  1069. if ( time_min == 0 )
  1070. {
  1071. time_min=t_min;
  1072. parkingspace_index_id=i;
  1073. }
  1074. else
  1075. {
  1076. if ( t_min<time_min )
  1077. {
  1078. time_min=t_min;
  1079. parkingspace_index_id=i;
  1080. }
  1081. }
  1082. }
  1083. else
  1084. {
  1085. //用时=目标终端到电梯口的距离/中跑车速度+(目标车位楼层-2)*楼层高度/电梯速度+电梯口到目标车位的距离/中跑车速度
  1086. float time=(terminal_id%6+2)*TERMINAL_SPACING/MEDIUM_CAR_SPEED + DOWNSTAIRS_SPORTS_TIME +
  1087. (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 +
  1088. 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;
  1089. if ( time_min == 0 )
  1090. {
  1091. time_min=time;
  1092. parkingspace_index_id=i;
  1093. }
  1094. else
  1095. {
  1096. if ( time<time_min )
  1097. {
  1098. time_min=time;
  1099. parkingspace_index_id=i;
  1100. }
  1101. }
  1102. }
  1103. }
  1104. ++i;
  1105. }
  1106. //判断大型车位是否有找到合适的空车位 如果找到了 直接返回
  1107. if ( time_min!=0 && parkingspace_index_id!=-1 )
  1108. {
  1109. parkspace_info.CopyFrom(all_big_parkspace_data.parkspace_info(parkingspace_index_id));
  1110. return Error_code::SUCCESS;
  1111. }
  1112. else
  1113. {
  1114. //如果没找到则代表右侧没找到合适车位
  1115. parkspace_info.set_parkingspace_index_id(-1);
  1116. return Error_manager(Error_code::PARKSPACE_ALLOCATOR_ALLOCATE_FAILED, Error_level::NEGLIGIBLE_ERROR,
  1117. "query_the_optimal_parkspace_serverB2 error ");
  1118. }
  1119. }
  1120. return Error_manager(Error_code::PARAMETER_ERROR, Error_level::MINOR_ERROR,
  1121. " query_the_optimal_parkspace_serverB2 error ");
  1122. }
  1123. //找缓存区车位
  1124. Error_manager Parkspace_manager::query_the_optimal_parkspace_serverB3(message::Parkspace_info &parkspace_info,message::Car_info car_info,int terminal_id)
  1125. {
  1126. //车辆高大于1550mm分在四楼以下,小于1550mm分在四楼以上
  1127. /*
  1128. * K=j%15
  1129. * P=i%6
  1130. * S=15*d-(j%15)*(2*d-1)+[6*d-(i%6)(2*d-1)]*W W>1
  1131. */
  1132. float time_min=0;
  1133. int parkingspace_index_id=-1;
  1134. //找缓存区车位 缓冲区只有中型车位和大型车位
  1135. if ( car_info.car_height() <= MID_CAR_HIGH )
  1136. {
  1137. message::Parkspace_allocation_data_msg all_mid_parkspace_data;
  1138. Error_manager t_error=m_parkspace_operating_function.get_specify_the_type_parkspace_info(all_mid_parkspace_data,message::Parkspace_type::MID_PARKINGSPACE);
  1139. if(t_error != SUCCESS)
  1140. {
  1141. return t_error;
  1142. }
  1143. int i=0;
  1144. while (i < all_mid_parkspace_data.parkspace_info_size())
  1145. {
  1146. //筛选中型车位缓冲区
  1147. int room_id=all_mid_parkspace_data.parkspace_info(i).parkingspace_index_id();
  1148. if ( room_id >= 19 && room_id <= 27
  1149. && all_mid_parkspace_data.parkspace_info(i).parkingspace_status() == message::eParkspace_empty)
  1150. {
  1151. //只需计算端口到车位的距离
  1152. // 三楼中型用时=| 目标车位到电梯的距离 - 终端到电梯的距离 | / 中跑车速度
  1153. float t_min=abs( room_id%15*all_mid_parkspace_data.parkspace_info(i).parkingspace_width()-(terminal_id%6+2)*TERMINAL_SPACING )/MEDIUM_CAR_SPEED+DOWNSTAIRS_SPORTS_TIME;
  1154. if ( time_min == 0 )
  1155. {
  1156. time_min=t_min;
  1157. parkingspace_index_id=i;
  1158. }
  1159. else
  1160. {
  1161. if ( t_min<time_min )
  1162. {
  1163. time_min=t_min;
  1164. parkingspace_index_id=i;
  1165. }
  1166. }
  1167. }
  1168. }
  1169. //判断缓冲区的中型车位是否有找到合适的空车位 如果找到了 直接返回
  1170. if ( time_min!=0 && parkingspace_index_id!=-1 )
  1171. {
  1172. parkspace_info.CopyFrom(all_mid_parkspace_data.parkspace_info(parkingspace_index_id));
  1173. return Error_code::SUCCESS;
  1174. }
  1175. }
  1176. if( car_info.car_height() <= BIG_CAR_HIGH )
  1177. {
  1178. message::Parkspace_allocation_data_msg all_big_parkspace_data;
  1179. Error_manager t_error=m_parkspace_operating_function.get_specify_the_type_parkspace_info(all_big_parkspace_data,message::Parkspace_type::BIG_PARKINGSPACE);
  1180. if(t_error != SUCCESS)
  1181. {
  1182. return t_error;
  1183. }
  1184. int i=0;
  1185. while (i < all_big_parkspace_data.parkspace_info_size())
  1186. {
  1187. //筛选中型车位缓冲区
  1188. int room_id=all_big_parkspace_data.parkspace_info(i).parkingspace_index_id();
  1189. if ( room_id >= 4 && room_id <= 12
  1190. && all_big_parkspace_data.parkspace_info(i).parkingspace_status() == message::eParkspace_empty)
  1191. {
  1192. //只需计算端口到车位的距离
  1193. // 二楼中型用时=| 目标车位到电梯的距离 - 终端到电梯的距离 | / 中跑车速度
  1194. float t_min=abs( room_id%15*all_big_parkspace_data.parkspace_info(i).parkingspace_width()-(terminal_id%6+2)*TERMINAL_SPACING )/MEDIUM_CAR_SPEED+DOWNSTAIRS_SPORTS_TIME;
  1195. if ( time_min == 0 )
  1196. {
  1197. time_min=t_min;
  1198. parkingspace_index_id=i;
  1199. }
  1200. else
  1201. {
  1202. if ( t_min<time_min )
  1203. {
  1204. time_min=t_min;
  1205. parkingspace_index_id=i;
  1206. }
  1207. }
  1208. }
  1209. }
  1210. //判断缓冲区的中型车位是否有找到合适的空车位 如果找到了 直接返回
  1211. if ( time_min!=0 && parkingspace_index_id!=-1 )
  1212. {
  1213. parkspace_info.CopyFrom(all_big_parkspace_data.parkspace_info(parkingspace_index_id));
  1214. return Error_code::SUCCESS;
  1215. }
  1216. else
  1217. {
  1218. //如果没找到则代表缓冲区没找到合适车位
  1219. parkspace_info.set_parkingspace_index_id(-1);
  1220. return Error_manager(Error_code::PARKSPACE_ALLOCATOR_ALLOCATE_FAILED, Error_level::NEGLIGIBLE_ERROR,
  1221. "query_the_optimal_parkspace_serverB2 error ");
  1222. }
  1223. }
  1224. return Error_manager(Error_code::PARAMETER_ERROR, Error_level::MINOR_ERROR,
  1225. " query_the_optimal_parkspace_serverB3 error ");
  1226. }
  1227. //分配车位线程函数
  1228. void Parkspace_manager::execute_for_allocate(message::Car_info car_info, int terminal_id, std::string command_key)
  1229. {
  1230. LOG(INFO) << "分配车位 "<<"牌号:"<<car_info.license()<<" command_key="<<command_key; //huli printf command_key
  1231. //根据请求的信息反馈分配的车位,并封装发送
  1232. message::Parkspace_allocation_response_msg response_msg;
  1233. message::Base_info t_response_header;
  1234. t_response_header.set_msg_type(message::Message_type::eParkspace_allocation_response_msg);
  1235. t_response_header.set_timeout_ms(1000);
  1236. t_response_header.set_sender(message::Communicator::eParkspace);
  1237. t_response_header.set_receiver(message::Communicator::eMain);
  1238. message::Error_manager t_error;
  1239. message::Parkspace_info t_allocated_space;
  1240. Error_manager error;
  1241. //分配之前查询车辆是否已经存在
  1242. if(check_car_existence(car_info.license()))
  1243. {
  1244. t_error.set_error_code(PARKSPACE_ALLOCATOR_CAR_ALREADY_EXIST);
  1245. t_error.set_error_level(message::Error_level::MAJOR_ERROR);
  1246. t_error.set_error_description("车辆已存在");
  1247. LOG(ERROR) << car_info.license()<<" 车辆已存在";
  1248. }
  1249. else
  1250. {
  1251. m_parkspace_lock.lock();
  1252. //如果车辆不存在 则找到一个最优车位
  1253. error=query_the_optimal_parkspace_serverA(t_allocated_space,car_info,terminal_id);
  1254. // query_the_optimal_parkspace_serverA(t_allocated_space,car_info,terminal_id);
  1255. //如果车辆不存在则获取一个空车位
  1256. // error=m_parkspace_operating_function.query_one_empty_parkspace(t_allocated_space);
  1257. if ( error != Error_code::SUCCESS )
  1258. {
  1259. t_error.set_error_code(error.get_error_code());
  1260. t_error.set_error_level((message::Error_level)error.get_error_level());
  1261. t_error.set_error_description(error.get_error_description());
  1262. LOG(ERROR) << car_info.license()<<" 获取空车位失败 "<<error.to_string();
  1263. }
  1264. else
  1265. {
  1266. LOG(INFO) <<"分配的车位ID为:"<<t_allocated_space.parkingspace_index_id();
  1267. return ;
  1268. //修改车为状态为锁定
  1269. t_allocated_space.set_parkingspace_status(message::Parkspace_status::eParkspace_locked);
  1270. t_allocated_space.mutable_car_info()->CopyFrom(car_info);
  1271. // 分配车位后更新车位状态
  1272. error=m_parkspace_operating_function.update_parkspace_data(t_allocated_space);
  1273. if ( error != SUCCESS )
  1274. {
  1275. t_error.set_error_code(error.get_error_code());
  1276. t_error.set_error_level((message::Error_level)error.get_error_level());
  1277. t_error.set_error_description(error.get_error_description());
  1278. LOG(ERROR) << car_info.license()<<" 更新车位数据失败 "<<error.to_string();
  1279. }
  1280. else
  1281. {
  1282. //修改车辆状态为停车中
  1283. message::Vehicle_status t_vehicle_status = message::Vehicle_status::eVehicle_parking;
  1284. error=m_parkspace_operating_function.update_vehicle_with_parkspace(t_allocated_space,t_vehicle_status);
  1285. if ( error != SUCCESS )
  1286. {
  1287. t_error.set_error_code(error.get_error_code());
  1288. t_error.set_error_level((message::Error_level)error.get_error_level());
  1289. t_error.set_error_description(error.get_error_description());
  1290. LOG(ERROR) << car_info.license()<<" 更新车辆数据失败 "<<error.to_string();
  1291. }
  1292. else
  1293. {
  1294. t_error.set_error_code(SUCCESS);
  1295. t_error.set_error_level(message::Error_level::NORMAL);
  1296. LOG(INFO) <<"分配车位成功 "<<"车位ID:"<<t_allocated_space.parkingspace_index_id()<<" 车牌号:"<<t_allocated_space.car_info().license();
  1297. }
  1298. }
  1299. }
  1300. m_parkspace_lock.unlock();
  1301. }
  1302. response_msg.mutable_base_info()->CopyFrom(t_response_header);
  1303. response_msg.set_command_key(command_key);
  1304. response_msg.mutable_error_manager()->CopyFrom(t_error);
  1305. response_msg.mutable_allocated_space_info()->CopyFrom(t_allocated_space);
  1306. Communication_message response=Communication_message();
  1307. response.reset(t_response_header, response_msg.SerializeAsString());
  1308. Parkspace_communicator::get_instance_references().send_response(&response);
  1309. send_parkspace_data();
  1310. std::cout<<std::endl;
  1311. }
  1312. //查询车位线程函数
  1313. void Parkspace_manager::execute_for_search(message::Car_info car_info,std::string command_key)
  1314. {
  1315. LOG(INFO) << "查询车位 "<<"牌号:"<<car_info.license()<<" command_key="<<command_key; //huli printf command_key
  1316. //根据车辆凭证信息查询车辆位置
  1317. message::Parkspace_search_response_msg response_msg;
  1318. message::Base_info t_response_header;
  1319. message::Error_manager t_error;
  1320. message::Parkspace_info t_car_position;
  1321. t_response_header.set_msg_type(message::Message_type::eParkspace_search_response_msg);
  1322. t_response_header.set_timeout_ms(1000);
  1323. t_response_header.set_sender(message::Communicator::eParkspace);
  1324. t_response_header.set_receiver(message::Communicator::eMain);
  1325. //查询车辆位置
  1326. message::Parkspace_info parkspace_info;
  1327. Error_manager error=m_parkspace_operating_function.query_one_parkspace_with_license(car_info.license(),parkspace_info);
  1328. if ( error != SUCCESS )
  1329. {
  1330. t_error.set_error_code(error.get_error_code());
  1331. t_error.set_error_level((message::Error_level)error.get_error_level());
  1332. t_error.set_error_description(error.get_error_description());
  1333. LOG(ERROR) << "查询车位失败 "<<error.to_string();
  1334. }
  1335. else
  1336. {
  1337. t_error.set_error_code(SUCCESS);
  1338. t_error.set_error_level(message::Error_level::NORMAL);
  1339. LOG(INFO) << "车辆"<<parkspace_info.car_info().license()<<" 在"<<parkspace_info.parkingspace_index_id()<<"号车位上";
  1340. }
  1341. response_msg.mutable_base_info()->CopyFrom(t_response_header);
  1342. response_msg.set_command_key(command_key);
  1343. response_msg.mutable_error_manager()->CopyFrom(t_error);
  1344. response_msg.mutable_car_position()->CopyFrom(t_car_position);
  1345. Communication_message response=Communication_message();
  1346. response.reset(t_response_header, response_msg.SerializeAsString());
  1347. Parkspace_communicator::get_instance_references().send_response(&response);
  1348. std::cout<<std::endl;
  1349. }
  1350. //释放车位线程函数
  1351. void Parkspace_manager::execute_for_release(message::Parkspace_info space_info, std::string command_key)
  1352. {
  1353. LOG(INFO) << "释放车位 "<<"牌号:"<<space_info.car_info().license()<<" command_key="<<command_key;
  1354. //根据车位信息定位待释放车位位置,车辆凭证号用于校验
  1355. message::Parkspace_release_response_msg response_msg;
  1356. message::Base_info t_response_header;
  1357. t_response_header.set_msg_type(message::eParkspace_release_response_msg);
  1358. t_response_header.set_sender(message::eParkspace);
  1359. t_response_header.set_receiver(message::eMain);
  1360. t_response_header.set_timeout_ms(1000);
  1361. message::Error_manager t_error;
  1362. message::Parkspace_info t_release_space;
  1363. //找到待释放的车位
  1364. m_parkspace_lock.lock();
  1365. Error_manager error=m_parkspace_operating_function.query_one_parkspace_with_parkspace_id(space_info.parkingspace_index_id(),t_release_space);
  1366. if ( error != SUCCESS )
  1367. {
  1368. t_error.set_error_code(error.get_error_code());
  1369. t_error.set_error_level((message::Error_level)error.get_error_level());
  1370. t_error.set_error_description(error.get_error_description());
  1371. LOG(ERROR) << "释放车位失败 "<<error.to_string();
  1372. }
  1373. else if(!t_release_space.has_car_info())
  1374. {
  1375. t_error.set_error_code(PARKSPACE_ALLOCATOR_RELEASE_FAILED);
  1376. t_error.set_error_level(message::Error_level::MAJOR_ERROR);
  1377. LOG(WARNING) << "传入待释放车位无车辆信息";
  1378. }
  1379. else
  1380. {
  1381. t_release_space.set_parkingspace_status(message::Parkspace_status::eParkspace_empty);
  1382. error = m_parkspace_operating_function.update_parkspace_data(t_release_space);
  1383. if (error != SUCCESS)
  1384. {
  1385. t_error.set_error_code(error.get_error_code());
  1386. t_error.set_error_level((message::Error_level) error.get_error_level());
  1387. t_error.set_error_description(error.get_error_description());
  1388. LOG(ERROR) << "释放车位 更新数据库车位数据失败 " << error.to_string();
  1389. }
  1390. else
  1391. {
  1392. message::Vehicle_status t_vehicle_status = message::Vehicle_status::eVehicle_idle;
  1393. error = m_parkspace_operating_function.update_vehicle_with_parkspace(t_release_space, t_vehicle_status);
  1394. if (error != SUCCESS)
  1395. {
  1396. t_error.set_error_code(error.get_error_code());
  1397. t_error.set_error_level((message::Error_level) error.get_error_level());
  1398. t_error.set_error_description(error.get_error_description());
  1399. LOG(ERROR) << "释放车位 更新数据库车辆数据失败 " << error.to_string();
  1400. }
  1401. else
  1402. {
  1403. t_error.set_error_code(SUCCESS);
  1404. t_error.set_error_level(message::Error_level::NORMAL);
  1405. LOG(INFO) << "第:" << t_release_space.parkingspace_index_id() << "号位 车辆: " << t_release_space.car_info().license()
  1406. << " 释放成功";
  1407. //获取预约ID
  1408. int t_park_record_id;
  1409. error = m_parkspace_operating_function.query_vehicle(t_release_space.car_info().license(),
  1410. t_vehicle_status, t_park_record_id);
  1411. if (error != SUCCESS)
  1412. {
  1413. t_error.set_error_code(error.get_error_code());
  1414. t_error.set_error_level((message::Error_level) error.get_error_level());
  1415. t_error.set_error_description(error.get_error_description());
  1416. LOG(ERROR) << "释放车位 数据库查询车辆信息失败 " << error.to_string();
  1417. }
  1418. else if (t_vehicle_status == message::Vehicle_status::eVehicle_idle)
  1419. {
  1420. time_t tt = time(NULL);
  1421. tm *t = localtime(&tt);
  1422. char my_time_buf[255];
  1423. memset(my_time_buf, 0, 255);
  1424. sprintf(my_time_buf, "%d-%02d-%02d %02d:%02d:%02d",
  1425. t->tm_year + 1900,
  1426. t->tm_mon + 1,
  1427. t->tm_mday,
  1428. t->tm_hour,
  1429. t->tm_min,
  1430. t->tm_sec);
  1431. t_release_space.set_leave_time(my_time_buf);
  1432. error = m_parkspace_operating_function.update_parking_record(t_release_space, t_park_record_id);
  1433. if (error != SUCCESS)
  1434. {
  1435. t_error.set_error_code(error.get_error_code());
  1436. t_error.set_error_level((message::Error_level) error.get_error_level());
  1437. t_error.set_error_description(error.get_error_description());
  1438. LOG(ERROR) << "更新停车记录失败: " << error.to_string();
  1439. }
  1440. }
  1441. }
  1442. }
  1443. }
  1444. m_parkspace_lock.unlock();
  1445. response_msg.mutable_base_info()->CopyFrom(t_response_header);
  1446. response_msg.set_command_key(command_key);
  1447. response_msg.mutable_error_manager()->CopyFrom(t_error);
  1448. response_msg.mutable_release_space_info()->CopyFrom(t_release_space);
  1449. Communication_message response=Communication_message();
  1450. response.reset(t_response_header, response_msg.SerializeAsString());
  1451. Parkspace_communicator::get_instance_references().send_response(&response);
  1452. send_parkspace_data();
  1453. std::cout<<std::endl;
  1454. }
  1455. //强制更新车位信息线程函数
  1456. void Parkspace_manager::execute_for_force_update(message::Parkspace_info space_info, std::string command_key)
  1457. {
  1458. LOG(INFO) << "手动 "<<"牌号:"<<space_info.car_info().license()<<" command_key="<<command_key;
  1459. //根据车位信息定位待释放车位位置,车辆凭证号用于校验
  1460. //!!!!!此处跳过外部处理与调用的过程,直接在内部调用,发送分配结果用于测试,目前一直发布第一个车位
  1461. message::Parkspace_force_update_response_msg response_msg;
  1462. message::Base_info t_response_header;
  1463. t_response_header.set_msg_type(message::eParkspace_force_update_response_msg);
  1464. t_response_header.set_sender(message::eParkspace);
  1465. t_response_header.set_receiver(message::eMain);
  1466. t_response_header.set_timeout_ms(1000);
  1467. message::Error_manager t_error;
  1468. message::Parkspace_info t_update_space;
  1469. Error_manager error;
  1470. // id 9999为特殊情况,复位所有车位状态
  1471. if (space_info.parkingspace_index_id() == 9999)
  1472. {
  1473. // 复位所有车位状态
  1474. error=m_parkspace_operating_function.clear_all_parkspace_info();
  1475. if( error != SUCCESS)
  1476. {
  1477. t_error.set_error_code(error.get_error_code());
  1478. t_error.set_error_level((message::Error_level) error.get_error_level());
  1479. LOG(INFO) << "手动更新所有车位失败 "<<error.to_string();
  1480. }
  1481. else
  1482. {
  1483. t_error.set_error_code(SUCCESS);
  1484. t_error.set_error_level(message::Error_level::NORMAL);
  1485. LOG(INFO) << "所有车位已手动更新 ";
  1486. }
  1487. }
  1488. else
  1489. {
  1490. //手动修改车位信息
  1491. error = m_parkspace_operating_function.update_parkspace_data(t_update_space);
  1492. if (error != SUCCESS)
  1493. {
  1494. t_error.set_error_code(error.get_error_code());
  1495. t_error.set_error_level((message::Error_level)error.get_error_level());
  1496. LOG(INFO) << "手动 数据库更新车位失败 "<<error.to_string();
  1497. }
  1498. else
  1499. {
  1500. t_error.set_error_code(SUCCESS);
  1501. t_error.set_error_level(message::Error_level::NORMAL);
  1502. LOG(INFO) << "第" << t_update_space.parkingspace_index_id() << "号位已手动更新";
  1503. }
  1504. }
  1505. response_msg.mutable_base_info()->CopyFrom(t_response_header);
  1506. response_msg.set_command_key(command_key);
  1507. response_msg.mutable_error_manager()->CopyFrom(t_error);
  1508. response_msg.mutable_update_space_info()->CopyFrom(t_update_space);
  1509. Communication_message response=Communication_message();
  1510. response.reset(t_response_header, response_msg.SerializeAsString());
  1511. Parkspace_communicator::get_instance_references().send_response(&response);
  1512. send_parkspace_data();
  1513. }
  1514. //确认分配车位线程函数
  1515. void Parkspace_manager::execute_for_confirm_alloc(message::Parkspace_info space_info, std::string command_key)
  1516. {
  1517. LOG(INFO) << "确认分配 " << "牌号:" << space_info.car_info().license() << " command_key=" << command_key;
  1518. //根据车位信息定位待确认占用车位
  1519. message::Parkspace_confirm_alloc_response_msg response_msg;
  1520. message::Base_info t_response_header;
  1521. t_response_header.set_msg_type(message::eParkspace_confirm_alloc_response_msg);
  1522. t_response_header.set_sender(message::eParkspace);
  1523. t_response_header.set_receiver(message::eMain);
  1524. t_response_header.set_timeout_ms(1000);
  1525. message::Error_manager t_error;
  1526. message::Parkspace_info t_confirm_space;
  1527. Error_manager error;
  1528. //获取确认分配的车位
  1529. m_parkspace_lock.lock();
  1530. error = m_parkspace_operating_function.query_one_parkspace_with_parkspace_id(space_info.parkingspace_index_id(),
  1531. t_confirm_space);
  1532. if (error != SUCCESS)
  1533. {
  1534. t_error.set_error_code(error.get_error_code());
  1535. t_error.set_error_level((message::Error_level) error.get_error_level());
  1536. t_error.set_error_description(error.get_error_description());
  1537. LOG(ERROR) << "确认分配 查询车位信息失败 " << error.to_string();
  1538. }
  1539. else if (!t_confirm_space.has_car_info())
  1540. {
  1541. t_error.set_error_code(PARKSPACE_ALLOCATOR_RELEASE_FAILED);
  1542. t_error.set_error_level(message::Error_level::MAJOR_ERROR);
  1543. LOG(WARNING) << "传入待确认车位无车辆信息";
  1544. }
  1545. else
  1546. {
  1547. //校验车位状态是否为被锁定
  1548. if (t_confirm_space.parkingspace_status() != message::Parkspace_status::eParkspace_locked)
  1549. {
  1550. t_error.set_error_code(DB_QUERY_DATA_FAILED);
  1551. t_error.set_error_level(message::Error_level::MINOR_ERROR);
  1552. t_error.set_error_description("查询车位状态错误");
  1553. LOG(ERROR) << "确认分配 查询车位状态错误 " << error.to_string();
  1554. }
  1555. else
  1556. {
  1557. //修改车位状态为占用
  1558. t_confirm_space.set_parkingspace_status(message::Parkspace_status::eParkspace_occupied);
  1559. error = m_parkspace_operating_function.update_parkspace_data(t_confirm_space);
  1560. if (error != SUCCESS)
  1561. {
  1562. t_error.set_error_code(error.get_error_code());
  1563. t_error.set_error_level((message::Error_level) error.get_error_level());
  1564. LOG(INFO) << "确认分配 数据库更新车位失败 " << error.to_string();
  1565. }
  1566. else
  1567. {
  1568. //修改车辆状态为已入库
  1569. message::Vehicle_status t_vehicle_status = message::Vehicle_status::eVehicle_in_garage;
  1570. error = m_parkspace_operating_function.update_vehicle_with_parkspace(t_confirm_space, t_vehicle_status);
  1571. if (error != SUCCESS)
  1572. {
  1573. t_error.set_error_code(error.get_error_code());
  1574. t_error.set_error_level((message::Error_level) error.get_error_level());
  1575. t_error.set_error_description(error.get_error_description());
  1576. LOG(ERROR) << "确认分配 更新数据库车辆数据失败 " << error.to_string();
  1577. }
  1578. t_error.set_error_code(SUCCESS);
  1579. t_error.set_error_level(message::Error_level::NORMAL);
  1580. LOG(INFO) << "第:" << t_confirm_space.parkingspace_index_id() << "号位 车辆: " << t_confirm_space.car_info().license()<< " 确认占用成功";
  1581. //插入停车记录
  1582. time_t tt = time(NULL);
  1583. tm *t = localtime(&tt);
  1584. char my_time_buf[255];
  1585. memset(my_time_buf, 0, 255);
  1586. sprintf(my_time_buf, "%d-%02d-%02d %02d:%02d:%02d",
  1587. t->tm_year + 1900,
  1588. t->tm_mon + 1,
  1589. t->tm_mday,
  1590. t->tm_hour,
  1591. t->tm_min,
  1592. t->tm_sec);
  1593. t_confirm_space.set_entry_time(my_time_buf);
  1594. error = m_parkspace_operating_function.insert_parking_record(t_confirm_space);
  1595. if ( error != SUCCESS )
  1596. {
  1597. t_error.set_error_code(error.get_error_code());
  1598. t_error.set_error_level((message::Error_level) error.get_error_level());
  1599. LOG(ERROR) << "插入停车记录失败: " << error.to_string();
  1600. }
  1601. //查询停车记录的ID
  1602. int t_record_id;
  1603. error = m_parkspace_operating_function.query_parking_record(t_confirm_space,t_record_id);
  1604. if ( error != SUCCESS )
  1605. {
  1606. t_error.set_error_code(error.get_error_code());
  1607. t_error.set_error_level((message::Error_level) error.get_error_level());
  1608. LOG(ERROR) << "查询停车记录ID失败: " << error.to_string();
  1609. }
  1610. //更新停车记录ID
  1611. error = m_parkspace_operating_function.update_record_id(t_confirm_space.car_info().license(),t_record_id);
  1612. if ( error != SUCCESS )
  1613. {
  1614. t_error.set_error_code(error.get_error_code());
  1615. t_error.set_error_level((message::Error_level) error.get_error_level());
  1616. LOG(ERROR) << "更新停车记录ID失败: " << error.to_string();
  1617. }
  1618. }
  1619. }
  1620. }
  1621. m_parkspace_lock.unlock();
  1622. response_msg.mutable_base_info()->CopyFrom(t_response_header);
  1623. response_msg.set_command_key(command_key);
  1624. response_msg.mutable_error_manager()->CopyFrom(t_error);
  1625. response_msg.mutable_confirm_alloc_space_info()->CopyFrom(t_confirm_space);
  1626. Communication_message response=Communication_message();
  1627. response.reset(t_response_header, response_msg.SerializeAsString());
  1628. Parkspace_communicator::get_instance_references().send_response(&response);
  1629. send_parkspace_data();
  1630. std::cout<<std::endl;
  1631. }