|
@@ -19,11 +19,11 @@ VehicleControlClient::VehicleControlClient(std::shared_ptr<Channel> channel)
|
|
|
stub_ = VehicleControl::NewStub(channel);
|
|
|
|
|
|
controlTimer = new QTimer();
|
|
|
- connect(controlTimer,SIGNAL(timeout()),this,SLOT(controlTimeout()));
|
|
|
-// controlTimer->start(std::atoi(gstrcontrolInterval.c_str()));
|
|
|
+ connect(controlTimer,&QTimer::timeout,this,&VehicleControlClient::controlTimeout);
|
|
|
+ controlTimer->start(std::atoi(gstrcontrolInterval.c_str()));
|
|
|
|
|
|
uploadMapTimer = new QTimer();
|
|
|
- connect(uploadMapTimer,SIGNAL(timeout()),this,SLOT(uploadMapTimeout()));
|
|
|
+ connect(uploadMapTimer,&QTimer::timeout,this,&VehicleControlClient::uploadMapTimeout);
|
|
|
uploadMapTimer->start(std::atoi(gstruploadMapInterval.c_str()));
|
|
|
}
|
|
|
|
|
@@ -56,8 +56,17 @@ std::string VehicleControlClient::vehicleControl(void)
|
|
|
shiftCMD = reply.shiftcmd();
|
|
|
steeringWheelAngleCMD = reply.steeringwheelanglecmd();
|
|
|
throttleCMD = reply.throttlecmd();
|
|
|
+ std::cout<<"throttle:"<<reply.throttlecmd()<<std::endl;
|
|
|
brakeCMD = reply.brakecmd();
|
|
|
}
|
|
|
+ else
|
|
|
+ {
|
|
|
+// std::cout<<"id:"<<reply.id()<<std::endl;
|
|
|
+// if(throttleCMD > 0)throttleCMD -= 1.5;
|
|
|
+// if(throttleCMD <= 0)throttleCMD = 0;
|
|
|
+// if(brakeCMD > 0)brakeCMD -= 1.5;
|
|
|
+// if(brakeCMD <= 0)brakeCMD = 0;
|
|
|
+ }
|
|
|
return "vehicleControl RPC successed";
|
|
|
} else {
|
|
|
std::cout << status.error_code() << ": " << status.error_message()
|
|
@@ -86,19 +95,19 @@ std::string VehicleControlClient::uploadMap(void)
|
|
|
if (status.ok()) {
|
|
|
if(reply.id() == gstrid)
|
|
|
{
|
|
|
- std::cout<<reply.id()<<std::endl;
|
|
|
+// std::cout<<reply.id()<<std::endl;
|
|
|
isNeedMap = false;
|
|
|
patrolPathID = "noPath";
|
|
|
POIPoints.clear();
|
|
|
|
|
|
isNeedMap = reply.isneedmap();
|
|
|
- std::cout<<reply.isneedmap()<<std::endl;
|
|
|
+// std::cout<<reply.isneedmap()<<std::endl;
|
|
|
patrolPathID = reply.patrolpathid();
|
|
|
- std::cout<<reply.patrolpathid()<<std::endl;
|
|
|
+// std::cout<<reply.patrolpathid()<<std::endl;
|
|
|
for(int i = 0;i < reply.mappoints_size();i++)
|
|
|
{
|
|
|
POIPoints.append(reply.mappoints(i));
|
|
|
- std::cout<<reply.mappoints(i).index()<<std::endl;
|
|
|
+// std::cout<<reply.mappoints(i).index()<<std::endl;
|
|
|
}
|
|
|
}
|
|
|
return "UploadMap RPC successed";
|
|
@@ -141,10 +150,10 @@ std::string VehicleControlClient::changeCtrlMode(void)
|
|
|
|
|
|
void VehicleControlClient::updateControlData(void)
|
|
|
{
|
|
|
- std::cout<<"shift:"<<shiftCMD<<std::endl;
|
|
|
- std::cout<<"steeringWheelAngle:"<<steeringWheelAngleCMD<<std::endl;
|
|
|
+// std::cout<<"shift:"<<shiftCMD<<std::endl;
|
|
|
+// std::cout<<"steeringWheelAngle:"<<steeringWheelAngleCMD<<std::endl;
|
|
|
std::cout<<"throttle:"<<throttleCMD<<std::endl;
|
|
|
- std::cout<<"brake:"<<brakeCMD<<std::endl;
|
|
|
+// std::cout<<"brake:"<<brakeCMD<<std::endl;
|
|
|
}
|
|
|
|
|
|
void VehicleControlClient::updateMapPOIData(void)
|
|
@@ -155,18 +164,18 @@ void VehicleControlClient::updateMapPOIData(void)
|
|
|
|
|
|
void VehicleControlClient::updateCtrolMode(void)
|
|
|
{
|
|
|
- std::cout<<"modeCMD:"<<modeCMD<<std::endl;
|
|
|
+// std::cout<<"modeCMD:"<<modeCMD<<std::endl;
|
|
|
}
|
|
|
|
|
|
void VehicleControlClient::controlTimeout(void)
|
|
|
{
|
|
|
std::string reply = changeCtrlMode();
|
|
|
- std::cout<< reply <<std::endl;
|
|
|
+// std::cout<< reply <<std::endl;
|
|
|
updateCtrolMode();
|
|
|
|
|
|
reply = vehicleControl();
|
|
|
- std::cout<< reply <<std::endl;
|
|
|
- if(modeCMD == CtrlMode::CMD_REMOTE)
|
|
|
+// std::cout<< reply <<std::endl;
|
|
|
+ if(modeCMD == CtrlMode::CMD_REMOTE || modeCMD == CtrlMode::CMD_CLOUD_PLATFORM)
|
|
|
{
|
|
|
updateControlData();
|
|
|
}
|
|
@@ -177,7 +186,7 @@ void VehicleControlClient::uploadMapTimeout(void)
|
|
|
if(isNeedMap == false)
|
|
|
{
|
|
|
std::string reply = uploadMap();
|
|
|
- std::cout<< reply <<std::endl;
|
|
|
+// std::cout<< reply <<std::endl;
|
|
|
if(isNeedMap == true)
|
|
|
{
|
|
|
updateMapPOIData();
|