فهرست منبع

change adc_can_nvidia_agx. fix bug in open state.

yuchuli 1 سال پیش
والد
کامیت
9f9845bad1
1فایلهای تغییر یافته به همراه5 افزوده شده و 2 حذف شده
  1. 5 2
      src/ros2/src/adc_can_nvidia_agx/src/canctrl.cpp

+ 5 - 2
src/ros2/src/adc_can_nvidia_agx/src/canctrl.cpp

@@ -48,15 +48,18 @@ void canctrl::run()
 
     static bool bTip = false;
 
+    std::this_thread::sleep_for(std::chrono::milliseconds(300));
+
 
     while(mbthreadrun)
     {
+        mbCANOpen = mpcan->IsOpen();
         if(mbCANOpen)
         {
             if(bTip == true)
             {
                 bTip = false;
-                std::cout<<" Open CAN SuccessFully."<<std::endl;
+                std::cout<<std::chrono::system_clock::now().time_since_epoch().count()<<" Open CAN SuccessFully."<<std::endl;
             }
             basecan_msg xmsg[2500];
             int nRec1,nRec2,nSend1,nSend2;
@@ -105,7 +108,7 @@ void canctrl::run()
             if(bTip == false)
             {
                 bTip = true;
-                std::cout<<" open can fail."<<std::endl;
+                std::cout<<std::chrono::system_clock::now().time_since_epoch().count()<<" open can fail."<<std::endl;
             }