|
@@ -186,6 +186,8 @@ void ProcCANMsg(iv::can::canraw xmsg)
|
|
// ServiceCarStatus.obstacleStatus.failsafe = (xdata[5] >> 1) & 0xf;
|
|
// ServiceCarStatus.obstacleStatus.failsafe = (xdata[5] >> 1) & 0xf;
|
|
gmobileye.set_numobstacles(num_obstacles);
|
|
gmobileye.set_numobstacles(num_obstacles);
|
|
gmobileye.set_xmsgtime(QDateTime::currentMSecsSinceEpoch());
|
|
gmobileye.set_xmsgtime(QDateTime::currentMSecsSinceEpoch());
|
|
|
|
+
|
|
|
|
+ glane_sig = glane_sig | 0x02;
|
|
}
|
|
}
|
|
/**************************************************** mobileye obstacle data a ****************************************************************************
|
|
/**************************************************** mobileye obstacle data a ****************************************************************************
|
|
* message ID:0x739
|
|
* message ID:0x739
|
|
@@ -426,7 +428,6 @@ void ProcCANMsg(iv::can::canraw xmsg)
|
|
tmp <<= 20;
|
|
tmp <<= 20;
|
|
tmp >>= 20;
|
|
tmp >>= 20;
|
|
glane.set_distolaneright(tmp * 0.02);
|
|
glane.set_distolaneright(tmp * 0.02);
|
|
- glane_sig = glane_sig | 0x02;
|
|
|
|
gMobEyeIvlog->verbose("mobileye",\
|
|
gMobEyeIvlog->verbose("mobileye",\
|
|
"aftermark lane:\n con_l:%d, ldw_avai_l:%d,type_l:%d, dist_to_l:%f \n con_r:%d, ldw_avai_r:%d, type_r:%d, dist_to_r:%f", \
|
|
"aftermark lane:\n con_l:%d, ldw_avai_l:%d,type_l:%d, dist_to_l:%f \n con_r:%d, ldw_avai_r:%d, type_r:%d, dist_to_r:%f", \
|
|
glane.laneconfleft(), glane.isldwavaileft(), glane.lanetypeleft(), glane.disttolaneleft(), \
|
|
glane.laneconfleft(), glane.isldwavaileft(), glane.lanetypeleft(), glane.disttolaneleft(), \
|