main.cpp 31 KB

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