parkspace_manager.cpp 68 KB

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