adding condition to read messages bigger than 0

src/dynamixel_can.cpp

@@ -207,7 +207,7 @@ unsigned char CDynamixelCAN::receive_status_packet_v2(unsigned char **data,unsig
       do{
         if((num=((CCAN *)this->comm_dev)->get_num_data(this->rx_frame_id))==0)
         {
-          this->event_server->wait_all(events,100);
+          this->event_server->wait_all(events,300);
           num=((CCAN *)this->comm_dev)->get_num_data(this->rx_frame_id);
         }
         if((read+num)>1024)
@@ -217,7 +217,9 @@ unsigned char CDynamixelCAN::receive_status_packet_v2(unsigned char **data,unsig
         }
         else
         {
-          ((CCAN *)this->comm_dev)->read(this->rx_frame_id,&data_int[read],num);
+          
+          if(num!=0)
+            ((CCAN *)this->comm_dev)->read(this->rx_frame_id,&data_int[read],num); 
           read+=num;
         }
         this->sync_packet_v2(data_int,read,&start);

src/dynamixelserver_can.cpp

@@ -253,7 +253,8 @@ unsigned char CDynamixelServerCAN::receive_status_packet_v2(unsigned char **data
         }
         else
         {
-          ((CCAN *)this->comm_dev)->read(this->bus_info.rx_frame_id,&data_int[read],num);
+          if(num != 0)
+            ((CCAN *)this->comm_dev)->read(this->bus_info.rx_frame_id,&data_int[read],num);
           read+=num;
         }
         this->sync_packet_v2(data_int,read,&start);