// // Created by zx on 2020/7/7. // #include #include #include "dispatch_communicator.h" #include "StoreProcessTask.h" #include "process_message.pb.h" #include "command_manager.h" StoreProcessTask::StoreProcessTask() { m_command_id=-1; m_terminor_id=-1; mb_completed=false; } StoreProcessTask::~StoreProcessTask() { } Error_manager StoreProcessTask::init_task(unsigned int command_id, unsigned int terminor_id, message::Locate_information locate_info,message::Car_info car_info) { m_command_id=command_id; m_terminor_id=terminor_id; m_car_info=car_info; m_locate_info=locate_info; return SUCCESS; } Error_manager StoreProcessTask::locate_step() { message::Measure_request_msg request; message::Base_info base_info; base_info.set_msg_type(message::eLocate_request_msg); base_info.set_sender(message::eMain); base_info.set_receiver(message::eMeasurer); base_info.set_timeout_ms(5000); //测量超时5s request.mutable_base_info()->CopyFrom(base_info); request.set_command_id(m_command_id); request.set_terminal_id(m_terminor_id); Error_manager code=Locate_communicator::get_instance_pointer()->locate_request(request,m_measure_response_msg); if(code!=SUCCESS) return code; if(m_measure_response_msg.error_manager().error_code()==0) { return SUCCESS; } else return Error_manager(FAILED,MINOR_ERROR,"measure response error_code error"); } /* * 调度 */ Error_manager StoreProcessTask::dispatch_step() { /* * 判断调度所需的数据是否都正常 */ //1,测量信息是否存在 if(m_measure_response_msg.has_base_info()== false ||m_measure_response_msg.has_locate_information()==false ||m_parcspace_alloc_response_msg.has_base_info()== false ||m_parcspace_alloc_response_msg.has_allocated_space_info()==false) { return Error_manager(ERROR,MAJOR_ERROR,"调度所需的前置数据(测量,车位)不存在"); } message::Dispatch_request_msg request; message::Base_info base_info; base_info.set_msg_type(message::eDispatch_request_msg); base_info.set_sender(message::eMain); base_info.set_receiver(message::eDispatch); base_info.set_timeout_ms(1000*15); //测量超时15s request.mutable_base_info()->CopyFrom(base_info); request.set_command_id(m_command_id); request.set_terminal_id(m_terminor_id); request.set_dispatch_motion_direction(message::E_STORE_CAR); request.set_parkspace_id(m_parcspace_alloc_response_msg.allocated_space_info().parkspace_id()); Error_manager code=Dispatch_communicator::get_instance_pointer()->dispatch_request(request,m_dispatch_response_msg); if(code!=SUCCESS) return code; if(m_dispatch_response_msg.error_manager().error_code()==0) { return SUCCESS; } else return Error_manager(FAILED,MINOR_ERROR,"dispatch response error_code error"); } /* * 分配车位 */ Error_manager StoreProcessTask::alloc_space() { /* * 检查是否有测量数据 */ if(m_locate_info.has_locate_height()==false||m_locate_info.has_locate_width()==false) { return Error_manager(FAILED,MINOR_ERROR," parkspace alloc request without measure info"); } message::Parkspace_allocation_request_msg request; message::Base_info base_info; base_info.set_msg_type(message::eParkspace_allocation_request_msg); base_info.set_sender(message::eMain); base_info.set_receiver(message::eParkspace); base_info.set_timeout_ms(1000); //测量超时1s request.mutable_base_info()->CopyFrom(base_info); request.mutable_car_info()->CopyFrom(m_car_info); request.set_command_id(m_command_id); request.set_terminal_id(m_terminor_id); Error_manager code=Parkspace_communicator::get_instance_pointer()->alloc_request(request,m_parcspace_alloc_response_msg); if(code!=SUCCESS) return code; if(m_parcspace_alloc_response_msg.error_manager().error_code()==0) { /*LOG(INFO)<<"分配车位成功,停车终端:"<CopyFrom(base_info); message::Parkspace_info space_info=m_parcspace_alloc_response_msg.allocated_space_info(); request.mutable_release_space_info()->CopyFrom(space_info); request.set_command_id(m_command_id); message::Parkspace_release_response_msg release_response; Error_manager code=Parkspace_communicator::get_instance_pointer()->release_request(request,release_response); if(code!=SUCCESS) return code; if(release_response.error_manager().error_code()==0) { LOG(ERROR)<<"停车流程异常,释放车位成功,停车终端:"<updata_store_entrance_statu(m_terminor_id,message::eWorking); //开始执行停车指令 //第一步测量 switch (0) { //第一步,测量 case 0: { code=locate_step(); if(code!=SUCCESS) { LOG(ERROR)<<"测量失败:"<updata_store_entrance_statu(m_terminor_id,message::eReady); LOG(INFO)<<"停车成功,停车终端:"<updata_store_entrance_statu(m_terminor_id,message::eReady); }