main.cpp 7.3 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218
  1. #include <QCoreApplication>
  2. #include <QFile>
  3. #include <QString>
  4. #include <QStringList>
  5. #include <QMetaType>
  6. #include <yaml-cpp/yaml.h>
  7. #include "vehicle_upload.h"
  8. #include "vehicle_control.h"
  9. #include "vehicle_patrol.h"
  10. #include "fsm_unit.h"
  11. #include "ivversion.h"
  12. #include "modulecomm.h"
  13. #ifndef IV_MSGUNIT
  14. #define IV_MSGUNIT
  15. namespace iv {
  16. struct msgunit
  17. {
  18. char mstrmsgname[256];
  19. int mnBufferSize = 10000;
  20. int mnBufferCount = 1;
  21. void * mpa = nullptr;
  22. std::shared_ptr<char> mpstrmsgdata;
  23. int mndatasize = 0;
  24. bool mbRefresh = false;
  25. bool mbImportant = false;
  26. int mnkeeptime = 100;
  27. };
  28. }
  29. #endif
  30. #ifndef GLOBAL_GPS_POINT
  31. #define GLOBAL_GPS_POINT
  32. struct gGPSPoint
  33. {
  34. double latitude = 0.0;
  35. double longitude = 0.0;
  36. double height = 0.0;
  37. };
  38. #endif
  39. QVector<gGPSPoint> gPOIPoints;
  40. uint8_t gShift_Status = 3; //3 p 4 r 5 n 6 d
  41. uint8_t gCtrlMode_Status = 0; //0 auto 1 remote 2 stop 3 platform
  42. uint8_t gNavagationSwitch = 0;
  43. std::string gstrserverip = "111.33.136.150";//"123.57.212.138";
  44. std::string gstruploadPort = "10591";//"9000";
  45. std::string gstrpatrolPort = "10592";//"9000";
  46. std::string gstrcontrolPort = "20591";//"9000";
  47. std::string gstruploadInterval = "100";
  48. std::string gstrpatrolInterval = "1000";
  49. std::string gstrcontrolInterval = "100";
  50. std::string gstruploadMapInterval = "1000";
  51. std::string gstrid = "1234567890123456789H";
  52. std::string gstrplateNumber = "津A123456";
  53. std::string gvehicleType = "0"; //0 delevery 1 guid 2 clear
  54. double gspeedWantAvg = 4.1; // m/s
  55. double gwaitTime = 600; // s
  56. char stryamlpath[256];
  57. void dec_yaml(const char * stryamlpath)
  58. {
  59. YAML::Node config;
  60. try
  61. {
  62. config = YAML::LoadFile(stryamlpath);
  63. }
  64. catch(YAML::BadFile &e)
  65. {
  66. std::cout<<e.what()<<std::endl;
  67. std::cout<<"yaml file load fail."<<std::endl;
  68. return;
  69. }
  70. catch(YAML::ParserException &e)
  71. {
  72. std::cout<<e.what()<<std::endl;
  73. std::cout<<"yaml file is malformed."<<std::endl;
  74. return;
  75. }
  76. if(config["server"])
  77. {
  78. gstrserverip = config["server"].as<std::string>();
  79. std::cout<<"server:"<<gstrserverip<<std::endl;
  80. }
  81. if(config["upload_port"])
  82. {
  83. gstruploadPort = config["upload_port"].as<std::string>();
  84. std::cout<<"upload_port:"<<gstruploadPort<<std::endl;
  85. }
  86. if(config["patrol_port"])
  87. {
  88. gstrpatrolPort = config["patrol_port"].as<std::string>();
  89. std::cout<<"patrol_port:"<<gstrpatrolPort<<std::endl;
  90. }
  91. if(config["control_port"])
  92. {
  93. gstrcontrolPort = config["control_port"].as<std::string>();
  94. std::cout<<"control_port:"<<gstrcontrolPort<<std::endl;
  95. }
  96. if(config["uploadinterval"])
  97. {
  98. gstruploadInterval = config["uploadinterval"].as<std::string>();
  99. std::cout<<"uploadinterval:"<<gstruploadInterval<<"ms"<<std::endl;
  100. }
  101. if(config["patrolinterval"])
  102. {
  103. gstrpatrolInterval = config["patrolinterval"].as<std::string>();
  104. std::cout<<"patrolinterval:"<<gstrpatrolInterval<<"ms"<<std::endl;
  105. }
  106. if(config["controlinterval"])
  107. {
  108. gstrcontrolInterval = config["controlinterval"].as<std::string>();
  109. std::cout<<"controlinterval:"<<gstrcontrolInterval<<"ms"<<std::endl;
  110. }
  111. if(config["uploadmapinterval"])
  112. {
  113. gstruploadMapInterval = config["uploadmapinterval"].as<std::string>();
  114. std::cout<<"uploadmapinterval:"<<gstruploadMapInterval<<"ms"<<std::endl;
  115. }
  116. if(config["id"])
  117. {
  118. gstrid = config["id"].as<std::string>();
  119. std::cout<<"id:"<<gstrid<<std::endl;
  120. }
  121. if(config["plateNumber"])
  122. {
  123. gstrplateNumber = config["plateNumber"].as<std::string>();
  124. std::cout<<"plateNumber:"<<gstrplateNumber<<std::endl;
  125. }
  126. if(config["vehicleType"])
  127. {
  128. gvehicleType = config["vehicleType"].as<std::string>();
  129. std::cout<<"vehicleType:"<<gstrplateNumber<<std::endl;
  130. }
  131. if(config["speedWantAvg"])
  132. {
  133. gspeedWantAvg = config["speedWantAvg"].as<double>();
  134. std::cout<<"speedWantAvg: "<<gspeedWantAvg<<" m/s"<<std::endl;
  135. }
  136. if(config["waitTime"])
  137. {
  138. gwaitTime = config["waitTime"].as<double>();
  139. std::cout<<"waitTime: "<<gwaitTime<<std::endl;
  140. }
  141. return;
  142. }
  143. int main(int argc, char *argv[])
  144. {
  145. showversion("driver_cloud_grpc_client_BS");
  146. QCoreApplication a(argc, argv);
  147. if(argc<2)
  148. {
  149. snprintf(stryamlpath,255,"driver_cloud_grpc_client_BS.yaml");
  150. }
  151. else
  152. {
  153. strncpy(stryamlpath,argv[1],255);
  154. }
  155. dec_yaml(stryamlpath);
  156. std::string control_str = gstrserverip+":";
  157. control_str = control_str + gstrcontrolPort ;
  158. std::string patrol_str = gstrserverip+":";
  159. patrol_str = patrol_str + gstrpatrolPort;
  160. std::string upload_str = gstrserverip+":";
  161. upload_str = upload_str + gstruploadPort ;
  162. // std::cout<<upload_str<<std::endl;
  163. DataExchangeClient *vehicleuploaddata = new DataExchangeClient(grpc::CreateChannel(upload_str, grpc::InsecureChannelCredentials()));
  164. vehicleuploaddata->start();
  165. // std::cout<<control_str<<std::endl;
  166. VehicleChangeCtrlModeClient *vehiclechangectrlmode = new VehicleChangeCtrlModeClient(grpc::CreateChannel(control_str, grpc::InsecureChannelCredentials()));
  167. VehicleControlClient *vehiclecontrol = new VehicleControlClient(grpc::CreateChannel(control_str, grpc::InsecureChannelCredentials()));
  168. qRegisterMetaType<org::jeecg::defsControl::grpc::CtrlMode>("org::jeecg::defsControl::grpc::CtrlMode"); //< to solve the problem of signal and slot being in different threads
  169. QObject::connect(vehiclechangectrlmode,&VehicleChangeCtrlModeClient::ctrlMode_Changed,vehiclecontrol,&VehicleControlClient::ctrlMode_Changed_Slot);
  170. vehiclechangectrlmode->start();
  171. vehiclecontrol->start();
  172. VehicleUploadMapClient *vehicleuploadmap = new VehicleUploadMapClient(grpc::CreateChannel(control_str, grpc::InsecureChannelCredentials()));
  173. qRegisterMetaType<std::string>("std::string");
  174. QObject::connect(vehicleuploadmap,&VehicleUploadMapClient::patrolPOI_Recieved,vehicleuploaddata,&DataExchangeClient::patrolPOI_Recieved_Slot);
  175. QObject::connect(vehicleuploaddata,&DataExchangeClient::uploadPath_Finished,vehicleuploadmap,&VehicleUploadMapClient::uploadPath_Finished_Slot);
  176. vehicleuploadmap->start();
  177. // std::cout<<patrol_str<<std::endl;
  178. // VehiclePatrolExceptionClient vehiclepatrol(grpc::CreateChannel(patrol_str, grpc::InsecureChannelCredentials()));
  179. // vehiclepatrol.start();
  180. FSMUnit *fsmunit = new FSMUnit();
  181. QObject::connect(fsmunit,&FSMUnit::setAllowPlan,vehicleuploadmap,&VehicleUploadMapClient::setAllowPlan_Slot);
  182. QObject::connect(fsmunit,&FSMUnit::useStatusChanged,vehicleuploaddata,&DataExchangeClient::useStatusChanged_Slot);
  183. QObject::connect(vehicleuploaddata,&DataExchangeClient::setFSMDestination,fsmunit,&FSMUnit::setFSMDestination_Slot);
  184. QObject::connect(vehicleuploaddata,&DataExchangeClient::setMissionFinished,fsmunit,&FSMUnit::setMissionFinished_Slot);
  185. QObject::connect(vehiclechangectrlmode,&VehicleChangeCtrlModeClient::remoteCtrlModeChanged,fsmunit,&FSMUnit::remoteCtrlModeChanged_Slot);
  186. QObject::connect(vehiclechangectrlmode,&VehicleChangeCtrlModeClient::navagationSwitchChanged,fsmunit,&FSMUnit::navagationSwitchChanged_Slot);
  187. QObject::connect(vehiclechangectrlmode,&VehicleChangeCtrlModeClient::useStatusCMDChanged,fsmunit,&FSMUnit::useStatusCMDChanged_Slot);
  188. return a.exec();
  189. }