|
@@ -189,6 +189,7 @@ void Radio::heartBeat()
|
|
|
openSerial();
|
|
|
} else {
|
|
|
decodeData();
|
|
|
+ testWarningSpeedLimit();
|
|
|
upDataStream();
|
|
|
//if no answer,shake hands three times
|
|
|
if(m_iResponse!=-1) {
|
|
@@ -722,4 +723,17 @@ void Radio::ReceiveDecode(QByteArray &data)
|
|
|
data.remove(0, sizeof(packageDataHead) + dataLen + 1);
|
|
|
}
|
|
|
}
|
|
|
-
|
|
|
+void Radio::testWarningSpeedLimit()
|
|
|
+{
|
|
|
+ collisionEarlyWarningMessage warning;
|
|
|
+ warning.warningType=0x01;
|
|
|
+ warning.speedLimit=2;
|
|
|
+ outCollisionWarning(warning);
|
|
|
+}
|
|
|
+void Radio::testWarningStop()
|
|
|
+{
|
|
|
+ collisionEarlyWarningMessage warning;
|
|
|
+ warning.warningType=0x02;
|
|
|
+ warning.speedLimit=0;
|
|
|
+ outCollisionWarning(warning);
|
|
|
+}
|