main.cpp 6.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219
  1. //
  2. //
  3. // 20210425, hl_dispatch 和 hl_dispatch_B的版本进行同步, 此时调度管理的功能全部完成.后续可能还需要日志记录.
  4. //
  5. #include <iostream>
  6. #include "./error_code/error_code.h"
  7. //#include "LogFiles.h"
  8. #include <glog/logging.h>
  9. #include "./communication/communication_socket_base.h"
  10. #include "./tool/thread_pool.h"
  11. #include "./system/system_communication.h"
  12. #include "./system/system_executor.h"
  13. #include "./dispatch/dispatch_manager.h"
  14. #include "./dispatch/dispatch_communication.h"
  15. #include "./dispatch/dispatch_coordinates.h"
  16. #include "./tool/common_data.h"
  17. #include "./tool/time_tool.h"
  18. #include <algorithm> // std::for_each
  19. #define LIVOX_NUMBER 2
  20. GOOGLE_GLOG_DLL_DECL void shut_down_logging(const char* data, int size)
  21. {
  22. time_t tt;
  23. time( &tt );
  24. tt = tt + 8*3600; // transform the time zone
  25. tm* t= gmtime( &tt );
  26. char buf[255]={0};
  27. sprintf(buf,"./%d%02d%02d-%02d%02d%02d-dump.txt",
  28. t->tm_year + 1900,
  29. t->tm_mon + 1,
  30. t->tm_mday,
  31. t->tm_hour,
  32. t->tm_min,
  33. t->tm_sec);
  34. FILE* tp_file=fopen(buf,"w");
  35. fprintf(tp_file,data,strlen(data));
  36. fclose(tp_file);
  37. }
  38. #include <chrono>
  39. using namespace std;
  40. int main(int argc,char* argv[])
  41. {
  42. int t_id = 0;
  43. if ( argc == 2 )
  44. {
  45. t_id = stoi(argv[1]);
  46. }
  47. Error_manager t_error;
  48. const char* logPath = "./";
  49. google::InitGoogleLogging("LidarMeasurement");
  50. google::SetStderrLogging(google::INFO);
  51. google::SetLogDestination(0, logPath);
  52. google::SetLogFilenameExtension("zxlog");
  53. google::InstallFailureSignalHandler();
  54. google::InstallFailureWriter(&shut_down_logging);
  55. FLAGS_colorlogtostderr = true; // Set log color
  56. FLAGS_logbufsecs = 0; // Set log output speed(s)
  57. FLAGS_max_log_size = 1024; // Set max log file size(GB)
  58. FLAGS_stop_logging_if_full_disk = true;
  59. //#define MAIN_TEST 1
  60. #ifdef MAIN_TEST
  61. // t_error = Dispatch_coordinates::get_instance_references().dispatch_coordinates_init();
  62. // std::cout << " huli test :::: " << " Dispatch_coordinates::get_instance_references().dispatch_coordinates_init() = " << t_error.to_string() << std::endl;
  63. t_error = Dispatch_communication::get_instance_references().communication_init(t_id);
  64. std::cout << " huli test :::: " << " Dispatch_communication::get_instance_references().communication_init() = " << t_error.to_string() << std::endl;
  65. std::cout << "Dispatch_communication = " << Dispatch_communication::get_instance_references().get_status() << std::endl;
  66. t_error = Dispatch_manager::get_instance_references().dispatch_manager_init(t_id);
  67. std::cout << " huli test :::: " << " Dispatch_manager::get_instance_references().dispatch_manager_init(0) = " << t_error.to_string() << std::endl;
  68. std::cout << "Dispatch_manager = " << Dispatch_manager::get_instance_references().get_dispatch_manager_status() << std::endl;
  69. System_executor::get_instance_references().system_executor_init(10);
  70. std::cout << "System_executor = " << System_executor::get_instance_references().get_system_executor_status() << std::endl;
  71. if ( argc == 2 )
  72. {
  73. System_communication::get_instance_references().communication_init(t_id);
  74. }
  75. else
  76. {
  77. System_communication::get_instance_references().communication_init();
  78. }
  79. System_communication::get_instance_references().set_encapsulate_cycle_time(1000);
  80. //20210922
  81. while (1)
  82. {
  83. std::string test_string;
  84. std::cin >> test_string ;
  85. if ( test_string == "9" )
  86. {
  87. message::Dispatch_request_msg dispatch_request_msg;
  88. dispatch_request_msg.mutable_base_info()->set_msg_type(message::Message_type::eDispatch_request_msg);
  89. dispatch_request_msg.mutable_base_info()->set_timeout_ms(5000000);
  90. dispatch_request_msg.mutable_base_info()->set_sender(message::Communicator::eMain);
  91. dispatch_request_msg.mutable_base_info()->set_receiver(message::Communicator::eDispatch_manager);
  92. dispatch_request_msg.set_command_key("12345678901234567890123456789012");
  93. dispatch_request_msg.set_dispatch_motion_direction(message::Dispatch_motion_direction::E_STORE_CAR);
  94. dispatch_request_msg.mutable_id_struct()->set_terminal_id(4);
  95. dispatch_request_msg.mutable_id_struct()->set_unit_id(2);
  96. message::Locate_information t_locate_information;
  97. t_locate_information.set_locate_x(-1.901);
  98. t_locate_information.set_locate_y(-5.829);
  99. t_locate_information.set_locate_angle(2);
  100. t_locate_information.set_locate_length(4.78);
  101. t_locate_information.set_locate_width(1.88);
  102. t_locate_information.set_locate_height(1.65);
  103. t_locate_information.set_locate_wheel_base(2.78);
  104. t_locate_information.set_locate_wheel_width(1.88);
  105. t_locate_information.set_locate_front_theta(0);
  106. t_locate_information.set_uniformed_car_x(0);
  107. t_locate_information.set_uniformed_car_y(0);
  108. t_locate_information.set_locate_correct(true);
  109. dispatch_request_msg.mutable_locate_information()->CopyFrom(t_locate_information);
  110. message::Parkspace_info *tp_parkspace_info = dispatch_request_msg.mutable_parkspace_info_ex()->Add();
  111. tp_parkspace_info->set_parkingspace_index_id(167);
  112. tp_parkspace_info->set_parkingspace_type(message::Parkspace_type::MID_PARKINGSPACE);
  113. tp_parkspace_info->set_parkingspace_unit_id(3);
  114. tp_parkspace_info->set_parkingspace_label_id(11);
  115. tp_parkspace_info->set_parkingspace_room_id(5);
  116. tp_parkspace_info->set_parkingspace_direction(message::Direction::eBackward);
  117. tp_parkspace_info->set_parkingspace_floor_id(3);
  118. tp_parkspace_info->set_parkingspace_width(0);
  119. tp_parkspace_info->set_parkingspace_height(0);
  120. tp_parkspace_info->set_parkingspace_status(message::Parkspace_status::eParkspace_empty);
  121. tp_parkspace_info->set_car_type(message::Car_type::MID_CAR);
  122. dispatch_request_msg.set_car_type(message::Car_type::MID_CAR);
  123. Dispatch_manager::get_instance_references().execute_for_dispatch_request_msg(dispatch_request_msg);
  124. }
  125. std::this_thread::sleep_for(std::chrono::seconds(1));
  126. }
  127. return 0;
  128. #endif
  129. while (1)
  130. {
  131. }
  132. char ch123 ;
  133. std::cin >> ch123 ;
  134. Dispatch_communication::get_instance_references().communication_uninit();
  135. return 0;
  136. int t_dispatch_id = 0;
  137. // std::cin >> t_dispatch_id ;
  138. if ( argc == 2 )
  139. {
  140. std::cout << " huli test :::: " << " argv[1] = " << argv[1] << std::endl;
  141. t_dispatch_id = atoi(argv[1]);
  142. }
  143. std::cout << " huli test :::: " << " t_dispatch_id = " << t_dispatch_id << std::endl;
  144. Dispatch_manager::get_instance_references().dispatch_manager_init(t_dispatch_id);
  145. std::cout << "Dispatch_manager = " << Dispatch_manager::get_instance_references().get_dispatch_manager_status() << std::endl;
  146. System_executor::get_instance_references().system_executor_init(8);
  147. std::cout << "System_executor = " << System_executor::get_instance_references().get_system_executor_status() << std::endl;
  148. System_communication::get_instance_references().communication_init();
  149. char ch ;
  150. std::cin >> ch ;
  151. System_communication::get_instance_references().communication_uninit();
  152. System_executor::get_instance_references().system_executor_uninit();
  153. Dispatch_manager::get_instance_references().dispatch_manager_uninit();
  154. return 0;
  155. }