|
@@ -135,13 +135,14 @@ void signalHandler(int num)
|
|
|
canData4f0.bit.canYawRateL = yawRate & 0xFF;
|
|
|
canData4f0.bit.canRadiusCurvatureH = CAN_Radius_Curvature >> 8;
|
|
|
canData4f0.bit.canRadiusCurvatureL = CAN_Radius_Curvature & 0x3F;
|
|
|
- ExecSend1(0x4f0,canData4f0.byte,8);
|
|
|
+ ExecSend1(0x4F0,canData4f0.byte,8);
|
|
|
|
|
|
canData4f1.bit.canScanIndexAckH = CAN_Scan_Index >> 8;
|
|
|
canData4f1.bit.canScanIndexAckL = CAN_Scan_Index & 0xFF;
|
|
|
- ExecSend1(0x4f1,canData4f1.byte,8);
|
|
|
- ExecSend1(0x5f2,canData5f2.byte,8);
|
|
|
- ExecSend1(0x5f4,canData5f4.byte,8);
|
|
|
+ ExecSend1(0x4F1,canData4f1.byte,8);
|
|
|
+ ExecSend1(0x5F2,canData5f2.byte,8);
|
|
|
+ ExecSend1(0x5F4,canData5f4.byte,8);
|
|
|
+ qDebug()<<QTime::currentTime();
|
|
|
}
|
|
|
|
|
|
/*****************************************/
|
|
@@ -312,7 +313,7 @@ void DecodeRadar(iv::can::canmsg xmsg)
|
|
|
iv::radar::radarobject * pobj = gobj.mutable_obj(i + group_id * 7);
|
|
|
int8_t power = cdata[i+1] & 0x1F;
|
|
|
pobj->set_power(power - 10);
|
|
|
- qDebug()<<power;
|
|
|
+// qDebug()<<power;
|
|
|
pobj->set_moving((cdata[i+1] >> 5) & 0x01);
|
|
|
pobj->set_fast_movable((cdata[i+1] >> 7) & 0x01);
|
|
|
pobj->set_slow_movable((cdata[i+1] >> 6) & 0x01);
|
|
@@ -423,7 +424,7 @@ void Listencan0(const char * strdata,const unsigned int nSize,const unsigned int
|
|
|
|
|
|
DecodeRadar(xmsg);
|
|
|
|
|
|
- qDebug("can size is %d",xmsg.rawmsg_size());
|
|
|
+// qDebug("can size is %d",xmsg.rawmsg_size());
|
|
|
// xt = QDateTime::currentMSecsSinceEpoch();
|
|
|
// qDebug("latence = %ld ",xt-pic.time());
|
|
|
|