main.cpp 31 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663
  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 <algorithm> // std::for_each
  18. #define LIVOX_NUMBER 2
  19. GOOGLE_GLOG_DLL_DECL void shut_down_logging(const char* data, int size)
  20. {
  21. time_t tt;
  22. time( &tt );
  23. tt = tt + 8*3600; // transform the time zone
  24. tm* t= gmtime( &tt );
  25. char buf[255]={0};
  26. sprintf(buf,"./%d%02d%02d-%02d%02d%02d-dump.txt",
  27. t->tm_year + 1900,
  28. t->tm_mon + 1,
  29. t->tm_mday,
  30. t->tm_hour,
  31. t->tm_min,
  32. t->tm_sec);
  33. FILE* tp_file=fopen(buf,"w");
  34. fprintf(tp_file,data,strlen(data));
  35. fclose(tp_file);
  36. }
  37. #include <chrono>
  38. using namespace std;
  39. #define MAIN_TEST 1
  40. int main(int argc,char* argv[])
  41. {
  42. Error_manager t_error;
  43. const char* logPath = "./";
  44. google::InitGoogleLogging("LidarMeasurement");
  45. google::SetStderrLogging(google::INFO);
  46. google::SetLogDestination(0, logPath);
  47. google::SetLogFilenameExtension("zxlog");
  48. google::InstallFailureSignalHandler();
  49. google::InstallFailureWriter(&shut_down_logging);
  50. FLAGS_colorlogtostderr = true; // Set log color
  51. FLAGS_logbufsecs = 0; // Set log output speed(s)
  52. FLAGS_max_log_size = 1024; // Set max log file size(GB)
  53. FLAGS_stop_logging_if_full_disk = true;
  54. #ifdef MAIN_TEST
  55. t_error = Dispatch_coordinates::get_instance_references().dispatch_coordinates_init();
  56. std::cout << " huli test :::: " << " t_error.to = " << t_error.to_string() << std::endl;
  57. t_error = Dispatch_communication::get_instance_references().communication_init();
  58. std::cout << " huli test :::: " << " t_error.to = " << t_error.to_string() << std::endl;
  59. std::cout << "Dispatch_communication = " << Dispatch_communication::get_instance_references().get_status() << std::endl;
  60. t_error = Dispatch_manager::get_instance_references().dispatch_manager_init(0);
  61. std::cout << " huli test :::: " << " t_error.to = " << t_error.to_string() << std::endl;
  62. std::cout << "Dispatch_manager = " << Dispatch_manager::get_instance_references().get_dispatch_manager_status() << std::endl;
  63. System_executor::get_instance_references().system_executor_init(10);
  64. std::cout << "System_executor = " << System_executor::get_instance_references().get_system_executor_status() << std::endl;
  65. System_communication::get_instance_references().communication_init();
  66. System_communication::get_instance_references().set_encapsulate_cycle_time(1000);
  67. while (1)
  68. {
  69. }
  70. return 0;
  71. #endif
  72. // Error_manager t_error;
  73. t_error = Dispatch_communication::get_instance_references().communication_init();
  74. std::cout << " huli test :::: " << " t_error = " << t_error << std::endl;
  75. std::cout << "Dispatch_communication = " << Dispatch_communication::get_instance_references().get_status() << std::endl;
  76. std::this_thread::sleep_for(std::chrono::seconds(2));
  77. std::cout << " huli test :::: " << " t_error = " << t_error << std::endl;
  78. std::cout << "Dispatch_communication = " << Dispatch_communication::get_instance_references().get_status() << std::endl;
  79. std::cout << " ---------------------------------------------------" << std::endl;
  80. std::cout << " ---------------------------------------------------" << std::endl;
  81. Catcher t_catcher;
  82. t_error = t_catcher.dispatch_device_base_init(1);
  83. std::cout << " huli test :::: " << " t_error = " << t_error << std::endl;
  84. std::this_thread::sleep_for(std::chrono::seconds(2));
  85. std::shared_ptr<Task_Base> tp_task_Base1(new Catcher_task);
  86. Catcher_task * tp_catcher_task1 = (Catcher_task *)tp_task_Base1.get();
  87. tp_catcher_task1->task_init(NULL,std::chrono::milliseconds(15000));
  88. tp_catcher_task1->m_request_key = "x23456789012345678901234567890r1";
  89. tp_catcher_task1->m_request_x = 11055;
  90. tp_catcher_task1->m_request_y = 3000;
  91. tp_catcher_task1->m_request_b = 90;
  92. tp_catcher_task1->m_request_z = 5410;
  93. tp_catcher_task1->m_request_d1 = 355;
  94. tp_catcher_task1->m_request_d2 = 455;
  95. tp_catcher_task1->m_request_wheelbase = 2800;
  96. tp_catcher_task1->m_request_clamp_motion = Catcher_task::E_CLAMP_LOOSE;
  97. t_error = t_catcher.execute_task(tp_task_Base1, Dispatch_device_base::DISPATCH_TASK_ONE_LEVEL);
  98. std::cout << " huli test :::: " << " t_error = " << t_error << std::endl;
  99. std::cout << " ---------------------------------------------------" << std::endl;
  100. /*
  101. char zxczxcxzc1 ;
  102. std::cin >> zxczxcxzc1 ;
  103. while ( 1 )
  104. {
  105. std::cout << " huli test :::: " << " ===================================== " << std::endl;
  106. std::cout << " huli test :::: " << " tp_catcher_task->get_task_statu = " << tp_catcher_task->get_task_statu() << std::endl;
  107. std::cout << " huli test :::: " << " tp_catcher_task->m_respons_status = " << tp_catcher_task->m_respons_status << std::endl;
  108. std::cout << " huli test :::: " << " m_respons_key = " << tp_catcher_task->m_respons_key << std::endl;
  109. std::cout << " huli test :::: " << " m_respons_status = " << tp_catcher_task->m_respons_status << std::endl;
  110. std::cout << " huli test :::: " << " m_respons_x = " << tp_catcher_task->m_respons_x << std::endl;
  111. std::cout << " huli test :::: " << " m_respons_y = " << tp_catcher_task->m_respons_y << std::endl;
  112. std::cout << " huli test :::: " << " m_respons_b = " << tp_catcher_task->m_respons_b << std::endl;
  113. std::cout << " huli test :::: " << " m_respons_z = " << tp_catcher_task->m_respons_z << std::endl;
  114. std::cout << " huli test :::: " << " m_respons_d1 = " << tp_catcher_task->m_respons_d1 << std::endl;
  115. std::cout << " huli test :::: " << " m_respons_d2 = " << tp_catcher_task->m_respons_d2 << std::endl;
  116. std::cout << " huli test :::: " << " m_respons_wheelbase = " << tp_catcher_task->m_respons_wheelbase << std::endl;
  117. std::cout << " huli test :::: " << " m_respons_clamp_motion = " << tp_catcher_task->m_respons_clamp_motion << std::endl;
  118. std::cout << " ---------------------------------------------------" << std::endl;
  119. std::cout << " huli test :::: " << " *********************************************** = " << std::endl;
  120. std::cout << " huli test :::: " << " t_carrier_base.get_carrier_status() = " << t_catcher.get_dispatch_device_status() << std::endl;
  121. int heat = t_catcher.m_last_heartbeat;
  122. std::cout << " huli test :::: " << " m_last_heartbeat = " << heat << std::endl;
  123. std::cout << " huli test :::: " << " m_actual_device_status = " << t_catcher.m_actual_device_status << std::endl;
  124. std::cout << " huli test :::: " << " m_actual_load_status = " << t_catcher.m_actual_load_status << std::endl;
  125. std::cout << " huli test :::: " << " m_actual_x = " << t_catcher.m_actual_x << std::endl;
  126. std::cout << " huli test :::: " << " m_actual_y = " << t_catcher.m_actual_y << std::endl;
  127. std::cout << " huli test :::: " << " m_actual_b = " << t_catcher.m_actual_b << std::endl;
  128. std::cout << " huli test :::: " << " m_actual_z = " << t_catcher.m_actual_z << std::endl;
  129. std::cout << " huli test :::: " << " m_actual_d1 = " << t_catcher.m_actual_d1 << std::endl;
  130. std::cout << " huli test :::: " << " m_actual_d2 = " << t_catcher.m_actual_d2 << std::endl;
  131. std::cout << " huli test :::: " << " m_actual_clamp_motion1 = " << t_catcher.m_actual_clamp_motion1 << std::endl;
  132. std::cout << " huli test :::: " << " m_actual_clamp_motion2 = " << t_catcher.m_actual_clamp_motion2 << std::endl;
  133. std::cout << " huli test :::: " << " m_actual_clamp_motion3 = " << t_catcher.m_actual_clamp_motion3 << std::endl;
  134. std::cout << " huli test :::: " << " m_actual_clamp_motion4 = " << t_catcher.m_actual_clamp_motion4 << std::endl;
  135. std::cout << " huli test :::: " << " m_actual_error_code = " << std::endl;
  136. for (int i = 0; i < 50; ++i)
  137. {
  138. printf("0x%x ", t_catcher.m_actual_error_code[i]);
  139. }
  140. std::cout << std::endl;
  141. std::cout << " huli test :::: " << " m_actual_warning_code = " << std::endl;
  142. for (int i = 0; i < 50; ++i)
  143. {
  144. printf("0x%x ", t_catcher.m_actual_warning_code[i]);
  145. }
  146. std::cout << std::endl;
  147. std::cout << " huli test :::: " << " m_actual_error_description = " << t_catcher.m_actual_error_description << std::endl;
  148. std::cout << " huli test :::: " << " *********************************************** = " << std::endl;
  149. std::this_thread::sleep_for(std::chrono::milliseconds(1000));
  150. }
  151. */
  152. Carrier t_carrier20;
  153. t_error = t_carrier20.dispatch_device_base_init(0);
  154. std::cout << " huli test :::: " << " t_error = " << t_error << std::endl;
  155. std::this_thread::sleep_for(std::chrono::seconds(2));
  156. std::shared_ptr<Task_Base> tp_task_Base20(new Carrier_task);
  157. Carrier_task * tp_carrier_task20 = (Carrier_task *)tp_task_Base20.get();
  158. tp_carrier_task20->task_init(NULL,std::chrono::milliseconds(15000));
  159. tp_carrier_task20->m_request_key = "x23456789012345678901234567890c0";
  160. tp_carrier_task20->m_request_x = 1;
  161. // tp_carrier_task20->m_request_x = 32600;
  162. tp_carrier_task20->m_request_y = 3000;
  163. tp_carrier_task20->m_request_z = 2525;
  164. tp_carrier_task20->m_request_y1 = 4500;
  165. tp_carrier_task20->m_request_y2 = 1700;
  166. tp_carrier_task20->m_request_clamp_motion = Carrier_task::E_CLAMP_LOOSE;
  167. tp_carrier_task20->m_request_joint_motion_x = Carrier_task::E_JOINT_HOLD_OUT;
  168. tp_carrier_task20->m_request_joint_motion_y = Carrier_task::E_JOINT_HOLD_OUT;
  169. tp_carrier_task20->m_request_space_id = 555;
  170. tp_carrier_task20->m_request_floor_id = 555;
  171. tp_carrier_task20->m_request_wheelbase = 555;
  172. t_error = t_carrier20.execute_task(tp_task_Base20, Dispatch_device_base::DISPATCH_TASK_ONE_LEVEL);
  173. std::cout << " huli test :::: " << " t_error = " << t_error << std::endl;
  174. std::cout << " ---------------------------------------------------" << std::endl;
  175. /*
  176. char zxczxcxzc20 ;
  177. std::cin >> zxczxcxzc20 ;
  178. while ( 1 )
  179. {
  180. std::cout << " huli test :::: " << " ===================================== " << std::endl;
  181. std::cout << " huli test :::: " << " tp_carrier_task->get_task_statu = " << tp_carrier_task->get_task_statu() << std::endl;
  182. std::cout << " huli test :::: " << " tp_carrier_task->m_respons_status = " << tp_carrier_task->m_respons_status << std::endl;
  183. std::cout << " huli test :::: " << " m_respons_key = " << tp_carrier_task->m_respons_key << std::endl;
  184. std::cout << " huli test :::: " << " m_respons_status = " << tp_carrier_task->m_respons_status << std::endl;
  185. std::cout << " huli test :::: " << " m_respons_x = " << tp_carrier_task->m_respons_x << std::endl;
  186. std::cout << " huli test :::: " << " m_respons_y = " << tp_carrier_task->m_respons_y << std::endl;
  187. std::cout << " huli test :::: " << " m_respons_z = " << tp_carrier_task->m_respons_z << std::endl;
  188. std::cout << " huli test :::: " << " m_respons_y1 = " << tp_carrier_task->m_respons_y1 << std::endl;
  189. std::cout << " huli test :::: " << " m_respons_y2 = " << tp_carrier_task->m_respons_y2 << std::endl;
  190. std::cout << " huli test :::: " << " m_respons_clamp_motion = " << tp_carrier_task->m_respons_clamp_motion << std::endl;
  191. std::cout << " huli test :::: " << " m_respons_joint_motion_x = " << tp_carrier_task->m_respons_joint_motion_x << std::endl;
  192. std::cout << " huli test :::: " << " m_respons_joint_motion_y = " << tp_carrier_task->m_respons_joint_motion_y << std::endl;
  193. std::cout << " huli test :::: " << " m_respons_space_id = " << tp_carrier_task->m_respons_space_id << std::endl;
  194. std::cout << " huli test :::: " << " m_respons_floor_id = " << tp_carrier_task->m_respons_floor_id << std::endl;
  195. std::cout << " huli test :::: " << " m_respons_wheelbase = " << tp_carrier_task->m_respons_wheelbase << std::endl;
  196. std::cout << " ---------------------------------------------------" << std::endl;
  197. std::cout << " huli test :::: " << " *********************************************** = " << std::endl;
  198. std::cout << " huli test :::: " << " t_carrier_base.get_carrier_status() = " << t_carrier.get_dispatch_device_status() << std::endl;
  199. int heat = t_carrier.m_last_heartbeat;
  200. std::cout << " huli test :::: " << " m_last_heartbeat = " << heat << std::endl;
  201. std::cout << " huli test :::: " << " m_actual_device_status = " << t_carrier.m_actual_device_status << std::endl;
  202. std::cout << " huli test :::: " << " m_actual_load_status = " << t_carrier.m_actual_load_status << std::endl;
  203. std::cout << " huli test :::: " << " m_actual_x = " << t_carrier.m_actual_x << std::endl;
  204. std::cout << " huli test :::: " << " m_actual_y = " << t_carrier.m_actual_y << std::endl;
  205. std::cout << " huli test :::: " << " m_actual_z = " << t_carrier.m_actual_z << std::endl;
  206. std::cout << " huli test :::: " << " m_actual_y1 = " << t_carrier.m_actual_y1 << std::endl;
  207. std::cout << " huli test :::: " << " m_actual_y2 = " << t_carrier.m_actual_y2 << std::endl;
  208. std::cout << " huli test :::: " << " m_actual_clamp_motion1 = " << t_carrier.m_actual_clamp_motion1 << std::endl;
  209. std::cout << " huli test :::: " << " m_actual_clamp_motion2 = " << t_carrier.m_actual_clamp_motion2 << std::endl;
  210. std::cout << " huli test :::: " << " m_actual_small_sports_car_motion = " << t_carrier.m_actual_small_sports_car_motion << std::endl;
  211. std::cout << " huli test :::: " << " m_actual_joint_motion_x1 = " << t_carrier.m_actual_joint_motion_x1 << std::endl;
  212. std::cout << " huli test :::: " << " m_actual_joint_motion_x2 = " << t_carrier.m_actual_joint_motion_x2 << std::endl;
  213. std::cout << " huli test :::: " << " m_actual_error_code = " << std::endl;
  214. for (int i = 0; i < 50; ++i)
  215. {
  216. printf("0x%x ", t_carrier.m_actual_error_code[i]);
  217. }
  218. std::cout << std::endl;
  219. std::cout << " huli test :::: " << " m_actual_warning_code = " << std::endl;
  220. for (int i = 0; i < 50; ++i)
  221. {
  222. printf("0x%x ", t_carrier.m_actual_warning_code[i]);
  223. }
  224. std::cout << std::endl;
  225. std::cout << " huli test :::: " << " m_actual_error_description = " << t_carrier.m_actual_error_description << std::endl;
  226. std::cout << " huli test :::: " << " *********************************************** = " << std::endl;
  227. std::this_thread::sleep_for(std::chrono::milliseconds(1000));
  228. }
  229. */
  230. Carrier t_carrier21;
  231. t_error = t_carrier21.dispatch_device_base_init(1);
  232. std::cout << " huli test :::: " << " t_error = " << t_error << std::endl;
  233. std::this_thread::sleep_for(std::chrono::seconds(2));
  234. std::shared_ptr<Task_Base> tp_task_Base21(new Carrier_task);
  235. Carrier_task * tp_carrier_task21 = (Carrier_task *)tp_task_Base21.get();
  236. tp_carrier_task21->task_init(NULL,std::chrono::milliseconds(15000));
  237. tp_carrier_task21->m_request_key = "x23456789012345678901234567890c1";
  238. // tp_carrier_task21->m_request_x = 1;
  239. tp_carrier_task21->m_request_x = 32600;
  240. tp_carrier_task21->m_request_y = 3000;
  241. tp_carrier_task21->m_request_z = 2525;
  242. tp_carrier_task21->m_request_y1 = 4500;
  243. tp_carrier_task21->m_request_y2 = 1700;
  244. tp_carrier_task21->m_request_clamp_motion = Carrier_task::E_CLAMP_LOOSE;
  245. tp_carrier_task21->m_request_joint_motion_x = Carrier_task::E_JOINT_HOLD_OUT;
  246. tp_carrier_task21->m_request_joint_motion_y = Carrier_task::E_JOINT_HOLD_OUT;
  247. tp_carrier_task21->m_request_space_id = 555;
  248. tp_carrier_task21->m_request_floor_id = 555;
  249. tp_carrier_task21->m_request_wheelbase = 555;
  250. t_error = t_carrier21.execute_task(tp_task_Base21, Dispatch_device_base::DISPATCH_TASK_ONE_LEVEL);
  251. std::cout << " huli test :::: " << " t_error = " << t_error << std::endl;
  252. std::cout << " ---------------------------------------------------" << std::endl;
  253. /*
  254. char zxczxcxzc21 ;
  255. std::cin >> zxczxcxzc21 ;
  256. while ( 1 )
  257. {
  258. std::cout << " huli test :::: " << " ===================================== " << std::endl;
  259. std::cout << " huli test :::: " << " tp_carrier_task->get_task_statu = " << tp_carrier_task->get_task_statu() << std::endl;
  260. std::cout << " huli test :::: " << " tp_carrier_task->m_respons_status = " << tp_carrier_task->m_respons_status << std::endl;
  261. std::cout << " huli test :::: " << " m_respons_key = " << tp_carrier_task->m_respons_key << std::endl;
  262. std::cout << " huli test :::: " << " m_respons_status = " << tp_carrier_task->m_respons_status << std::endl;
  263. std::cout << " huli test :::: " << " m_respons_x = " << tp_carrier_task->m_respons_x << std::endl;
  264. std::cout << " huli test :::: " << " m_respons_y = " << tp_carrier_task->m_respons_y << std::endl;
  265. std::cout << " huli test :::: " << " m_respons_z = " << tp_carrier_task->m_respons_z << std::endl;
  266. std::cout << " huli test :::: " << " m_respons_y1 = " << tp_carrier_task->m_respons_y1 << std::endl;
  267. std::cout << " huli test :::: " << " m_respons_y2 = " << tp_carrier_task->m_respons_y2 << std::endl;
  268. std::cout << " huli test :::: " << " m_respons_clamp_motion = " << tp_carrier_task->m_respons_clamp_motion << std::endl;
  269. std::cout << " huli test :::: " << " m_respons_joint_motion_x = " << tp_carrier_task->m_respons_joint_motion_x << std::endl;
  270. std::cout << " huli test :::: " << " m_respons_joint_motion_y = " << tp_carrier_task->m_respons_joint_motion_y << std::endl;
  271. std::cout << " huli test :::: " << " m_respons_space_id = " << tp_carrier_task->m_respons_space_id << std::endl;
  272. std::cout << " huli test :::: " << " m_respons_floor_id = " << tp_carrier_task->m_respons_floor_id << std::endl;
  273. std::cout << " huli test :::: " << " m_respons_wheelbase = " << tp_carrier_task->m_respons_wheelbase << std::endl;
  274. std::cout << " ---------------------------------------------------" << std::endl;
  275. std::cout << " huli test :::: " << " *********************************************** = " << std::endl;
  276. std::cout << " huli test :::: " << " t_carrier_base.get_carrier_status() = " << t_carrier.get_dispatch_device_status() << std::endl;
  277. int heat = t_carrier.m_last_heartbeat;
  278. std::cout << " huli test :::: " << " m_last_heartbeat = " << heat << std::endl;
  279. std::cout << " huli test :::: " << " m_actual_device_status = " << t_carrier.m_actual_device_status << std::endl;
  280. std::cout << " huli test :::: " << " m_actual_load_status = " << t_carrier.m_actual_load_status << std::endl;
  281. std::cout << " huli test :::: " << " m_actual_x = " << t_carrier.m_actual_x << std::endl;
  282. std::cout << " huli test :::: " << " m_actual_y = " << t_carrier.m_actual_y << std::endl;
  283. std::cout << " huli test :::: " << " m_actual_z = " << t_carrier.m_actual_z << std::endl;
  284. std::cout << " huli test :::: " << " m_actual_y1 = " << t_carrier.m_actual_y1 << std::endl;
  285. std::cout << " huli test :::: " << " m_actual_y2 = " << t_carrier.m_actual_y2 << std::endl;
  286. std::cout << " huli test :::: " << " m_actual_clamp_motion1 = " << t_carrier.m_actual_clamp_motion1 << std::endl;
  287. std::cout << " huli test :::: " << " m_actual_clamp_motion2 = " << t_carrier.m_actual_clamp_motion2 << std::endl;
  288. std::cout << " huli test :::: " << " m_actual_small_sports_car_motion = " << t_carrier.m_actual_small_sports_car_motion << std::endl;
  289. std::cout << " huli test :::: " << " m_actual_joint_motion_x1 = " << t_carrier.m_actual_joint_motion_x1 << std::endl;
  290. std::cout << " huli test :::: " << " m_actual_joint_motion_x2 = " << t_carrier.m_actual_joint_motion_x2 << std::endl;
  291. std::cout << " huli test :::: " << " m_actual_error_code = " << std::endl;
  292. for (int i = 0; i < 50; ++i)
  293. {
  294. printf("0x%x ", t_carrier.m_actual_error_code[i]);
  295. }
  296. std::cout << std::endl;
  297. std::cout << " huli test :::: " << " m_actual_warning_code = " << std::endl;
  298. for (int i = 0; i < 50; ++i)
  299. {
  300. printf("0x%x ", t_carrier.m_actual_warning_code[i]);
  301. }
  302. std::cout << std::endl;
  303. std::cout << " huli test :::: " << " m_actual_error_description = " << t_carrier.m_actual_error_description << std::endl;
  304. std::cout << " huli test :::: " << " *********************************************** = " << std::endl;
  305. std::this_thread::sleep_for(std::chrono::milliseconds(1000));
  306. }
  307. */
  308. Carrier t_carrier22;
  309. t_error = t_carrier22.dispatch_device_base_init(2);
  310. std::cout << " huli test :::: " << " t_error = " << t_error << std::endl;
  311. std::this_thread::sleep_for(std::chrono::seconds(2));
  312. std::shared_ptr<Task_Base> tp_task_Base22(new Carrier_task);
  313. Carrier_task * tp_carrier_task22 = (Carrier_task *)tp_task_Base22.get();
  314. tp_carrier_task22->task_init(NULL,std::chrono::milliseconds(15000));
  315. tp_carrier_task22->m_request_key = "x23456789012345678901234567890c2";
  316. tp_carrier_task22->m_request_x = 24855;
  317. // tp_carrier_task22->m_request_x = 4700;
  318. tp_carrier_task22->m_request_y = 3000;
  319. tp_carrier_task22->m_request_z = 5125;
  320. tp_carrier_task22->m_request_y1 = 4500;
  321. tp_carrier_task22->m_request_y2 = 1700;
  322. tp_carrier_task22->m_request_clamp_motion = Carrier_task::E_CLAMP_LOOSE;
  323. tp_carrier_task22->m_request_joint_motion_x = Carrier_task::E_JOINT_HOLD_OUT;
  324. tp_carrier_task22->m_request_joint_motion_y = Carrier_task::E_JOINT_HOLD_OUT;
  325. tp_carrier_task22->m_request_space_id = 555;
  326. tp_carrier_task22->m_request_floor_id = 555;
  327. tp_carrier_task22->m_request_wheelbase = 555;
  328. t_error = t_carrier22.execute_task(tp_task_Base22, Dispatch_device_base::DISPATCH_TASK_ONE_LEVEL);
  329. std::cout << " huli test :::: " << " t_error = " << t_error << std::endl;
  330. std::cout << " ---------------------------------------------------" << std::endl;
  331. /*
  332. char zxczxcxzc22 ;
  333. std::cin >> zxczxcxzc22 ;
  334. while ( 1 )
  335. {
  336. std::cout << " huli test :::: " << " ===================================== " << std::endl;
  337. std::cout << " huli test :::: " << " tp_carrier_task->get_task_statu = " << tp_carrier_task->get_task_statu() << std::endl;
  338. std::cout << " huli test :::: " << " tp_carrier_task->m_respons_status = " << tp_carrier_task->m_respons_status << std::endl;
  339. std::cout << " huli test :::: " << " m_respons_key = " << tp_carrier_task->m_respons_key << std::endl;
  340. std::cout << " huli test :::: " << " m_respons_status = " << tp_carrier_task->m_respons_status << std::endl;
  341. std::cout << " huli test :::: " << " m_respons_x = " << tp_carrier_task->m_respons_x << std::endl;
  342. std::cout << " huli test :::: " << " m_respons_y = " << tp_carrier_task->m_respons_y << std::endl;
  343. std::cout << " huli test :::: " << " m_respons_z = " << tp_carrier_task->m_respons_z << std::endl;
  344. std::cout << " huli test :::: " << " m_respons_y1 = " << tp_carrier_task->m_respons_y1 << std::endl;
  345. std::cout << " huli test :::: " << " m_respons_y2 = " << tp_carrier_task->m_respons_y2 << std::endl;
  346. std::cout << " huli test :::: " << " m_respons_clamp_motion = " << tp_carrier_task->m_respons_clamp_motion << std::endl;
  347. std::cout << " huli test :::: " << " m_respons_joint_motion_x = " << tp_carrier_task->m_respons_joint_motion_x << std::endl;
  348. std::cout << " huli test :::: " << " m_respons_joint_motion_y = " << tp_carrier_task->m_respons_joint_motion_y << std::endl;
  349. std::cout << " huli test :::: " << " m_respons_space_id = " << tp_carrier_task->m_respons_space_id << std::endl;
  350. std::cout << " huli test :::: " << " m_respons_floor_id = " << tp_carrier_task->m_respons_floor_id << std::endl;
  351. std::cout << " huli test :::: " << " m_respons_wheelbase = " << tp_carrier_task->m_respons_wheelbase << std::endl;
  352. std::cout << " ---------------------------------------------------" << std::endl;
  353. std::cout << " huli test :::: " << " *********************************************** = " << std::endl;
  354. std::cout << " huli test :::: " << " t_carrier_base.get_carrier_status() = " << t_carrier.get_dispatch_device_status() << std::endl;
  355. int heat = t_carrier.m_last_heartbeat;
  356. std::cout << " huli test :::: " << " m_last_heartbeat = " << heat << std::endl;
  357. std::cout << " huli test :::: " << " m_actual_device_status = " << t_carrier.m_actual_device_status << std::endl;
  358. std::cout << " huli test :::: " << " m_actual_load_status = " << t_carrier.m_actual_load_status << std::endl;
  359. std::cout << " huli test :::: " << " m_actual_x = " << t_carrier.m_actual_x << std::endl;
  360. std::cout << " huli test :::: " << " m_actual_y = " << t_carrier.m_actual_y << std::endl;
  361. std::cout << " huli test :::: " << " m_actual_z = " << t_carrier.m_actual_z << std::endl;
  362. std::cout << " huli test :::: " << " m_actual_y1 = " << t_carrier.m_actual_y1 << std::endl;
  363. std::cout << " huli test :::: " << " m_actual_y2 = " << t_carrier.m_actual_y2 << std::endl;
  364. std::cout << " huli test :::: " << " m_actual_clamp_motion1 = " << t_carrier.m_actual_clamp_motion1 << std::endl;
  365. std::cout << " huli test :::: " << " m_actual_clamp_motion2 = " << t_carrier.m_actual_clamp_motion2 << std::endl;
  366. std::cout << " huli test :::: " << " m_actual_small_sports_car_motion = " << t_carrier.m_actual_small_sports_car_motion << std::endl;
  367. std::cout << " huli test :::: " << " m_actual_joint_motion_x1 = " << t_carrier.m_actual_joint_motion_x1 << std::endl;
  368. std::cout << " huli test :::: " << " m_actual_joint_motion_x2 = " << t_carrier.m_actual_joint_motion_x2 << std::endl;
  369. std::cout << " huli test :::: " << " m_actual_error_code = " << std::endl;
  370. for (int i = 0; i < 50; ++i)
  371. {
  372. printf("0x%x ", t_carrier.m_actual_error_code[i]);
  373. }
  374. std::cout << std::endl;
  375. std::cout << " huli test :::: " << " m_actual_warning_code = " << std::endl;
  376. for (int i = 0; i < 50; ++i)
  377. {
  378. printf("0x%x ", t_carrier.m_actual_warning_code[i]);
  379. }
  380. std::cout << std::endl;
  381. std::cout << " huli test :::: " << " m_actual_error_description = " << t_carrier.m_actual_error_description << std::endl;
  382. std::cout << " huli test :::: " << " *********************************************** = " << std::endl;
  383. std::this_thread::sleep_for(std::chrono::milliseconds(1000));
  384. }
  385. */
  386. /*
  387. Passageway t_passageway;
  388. t_error = t_passageway.dispatch_device_base_init(1);
  389. std::cout << " huli test :::: " << " t_error = " << t_error << std::endl;
  390. std::this_thread::sleep_for(std::chrono::seconds(2));
  391. std::shared_ptr<Task_Base> tp_task_Base3(new Passageway_task);
  392. Passageway_task * tp_passageway_task = (Passageway_task *)tp_task_Base3.get();
  393. tp_passageway_task->task_init(NULL,std::chrono::milliseconds(15000));
  394. tp_passageway_task->m_request_key = "ABCDEF";
  395. tp_passageway_task->m_request_inside_door_motion = Passageway_task::DOOR_OPEN;
  396. tp_passageway_task->m_request_outside_door_motion = Passageway_task::DOOR_CLOSE;
  397. tp_passageway_task->m_request_turntable_direction = Passageway_task::TURNTABLE_DIRECTION_OUTSIDE;
  398. t_error = t_passageway.execute_task(tp_task_Base3, Dispatch_device_base::E_ONE_LEVEL);
  399. std::cout << " huli test :::: " << " t_error = " << t_error << std::endl;
  400. std::cout << " ---------------------------------------------------" << std::endl;
  401. char zxczxcxzc3 ;
  402. std::cin >> zxczxcxzc3 ;
  403. while ( 1 )
  404. {
  405. std::cout << " huli test :::: " << " ===================================== " << std::endl;
  406. std::cout << " huli test :::: " << " tp_passageway_task->get_task_statu = " << tp_passageway_task->get_task_statu() << std::endl;
  407. std::cout << " huli test :::: " << " tp_passageway_task->m_respons_status = " << tp_passageway_task->m_respons_status << std::endl;
  408. std::cout << " huli test :::: " << " m_respons_key = " << tp_passageway_task->m_respons_key << std::endl;
  409. std::cout << " huli test :::: " << " m_respons_status = " << tp_passageway_task->m_respons_status << std::endl;
  410. std::cout << " huli test :::: " << " m_respons_inside_door_motion = " << tp_passageway_task->m_respons_inside_door_motion << std::endl;
  411. std::cout << " huli test :::: " << " m_respons_outside_door_motion = " << tp_passageway_task->m_respons_outside_door_motion << std::endl;
  412. std::cout << " huli test :::: " << " m_respons_turntable_direction = " << tp_passageway_task->m_respons_turntable_direction << std::endl;
  413. std::cout << " ---------------------------------------------------" << std::endl;
  414. std::cout << " huli test :::: " << " *********************************************** = " << std::endl;
  415. std::cout << " huli test :::: " << " t_passageway_base.get_passageway_status() = " << t_passageway.get_dispatch_device_status() << std::endl;
  416. int heat = t_passageway.m_last_heartbeat;
  417. std::cout << " huli test :::: " << " m_last_heartbeat = " << heat << std::endl;
  418. std::cout << " huli test :::: " << " m_actual_device_status = " << t_passageway.m_actual_device_status << std::endl;
  419. std::cout << " huli test :::: " << " m_actual_inside_load_status = " << t_passageway.m_actual_inside_load_status << std::endl;
  420. std::cout << " huli test :::: " << " m_actual_outside_load_status = " << t_passageway.m_actual_outside_load_status << std::endl;
  421. std::cout << " huli test :::: " << " m_actual_front_overstep_the_boundary = " << t_passageway.m_actual_front_overstep_the_boundary << std::endl;
  422. std::cout << " huli test :::: " << " m_actual_back_overstep_the_boundary = " << t_passageway.m_actual_back_overstep_the_boundary << std::endl;
  423. std::cout << " huli test :::: " << " m_actual_height_overstep_the_boundary = " << t_passageway.m_actual_height_overstep_the_boundary << std::endl;
  424. std::cout << " huli test :::: " << " m_actual_outside_door_sensor = " << t_passageway.m_actual_outside_door_sensor << std::endl;
  425. std::cout << " huli test :::: " << " m_actual_inside_door_motion = " << t_passageway.m_actual_inside_door_motion << std::endl;
  426. std::cout << " huli test :::: " << " m_actual_outside_door_motion = " << t_passageway.m_actual_outside_door_motion << std::endl;
  427. std::cout << " huli test :::: " << " m_actual_turntable_load_status = " << t_passageway.m_actual_turntable_load_status << std::endl;
  428. std::cout << " huli test :::: " << " m_actual_turntable_direction = " << t_passageway.m_actual_turntable_direction << std::endl;
  429. std::cout << " huli test :::: " << " m_actual_error_code = " << std::endl;
  430. for (int i = 0; i < 50; ++i)
  431. {
  432. printf("0x%x ", t_passageway.m_actual_error_code[i]);
  433. }
  434. std::cout << std::endl;
  435. std::cout << " huli test :::: " << " m_actual_warning_code = " << std::endl;
  436. for (int i = 0; i < 50; ++i)
  437. {
  438. printf("0x%x ", t_passageway.m_actual_warning_code[i]);
  439. }
  440. std::cout << std::endl;
  441. std::cout << " huli test :::: " << " m_actual_error_description = " << t_passageway.m_actual_error_description << std::endl;
  442. std::cout << " huli test :::: " << " *********************************************** = " << std::endl;
  443. std::this_thread::sleep_for(std::chrono::milliseconds(1000));
  444. }
  445. */
  446. while (1)
  447. {
  448. }
  449. char ch123 ;
  450. std::cin >> ch123 ;
  451. Dispatch_communication::get_instance_references().communication_uninit();
  452. return 0;
  453. int t_dispatch_id = 0;
  454. // std::cin >> t_dispatch_id ;
  455. if ( argc == 2 )
  456. {
  457. std::cout << " huli test :::: " << " argv[1] = " << argv[1] << std::endl;
  458. t_dispatch_id = atoi(argv[1]);
  459. }
  460. std::cout << " huli test :::: " << " t_dispatch_id = " << t_dispatch_id << std::endl;
  461. Dispatch_manager::get_instance_references().dispatch_manager_init(t_dispatch_id);
  462. std::cout << "Dispatch_manager = " << Dispatch_manager::get_instance_references().get_dispatch_manager_status() << std::endl;
  463. System_executor::get_instance_references().system_executor_init(8);
  464. std::cout << "System_executor = " << System_executor::get_instance_references().get_system_executor_status() << std::endl;
  465. System_communication::get_instance_references().communication_init();
  466. char ch ;
  467. std::cin >> ch ;
  468. System_communication::get_instance_references().communication_uninit();
  469. System_executor::get_instance_references().system_executor_uninit();
  470. Dispatch_manager::get_instance_references().dispatch_manager_uninit();
  471. return 0;
  472. }