File tree Expand file tree Collapse file tree 1 file changed +27
-3
lines changed
Expand file tree Collapse file tree 1 file changed +27
-3
lines changed Original file line number Diff line number Diff line change @@ -32,10 +32,34 @@ def _respone(self):
3232 data = None
3333 if self ._serial_port .inWaiting () > 0 :
3434 data = self ._serial_port .read (self ._serial_port .inWaiting ())
35+ queue_size = self ._get_queue_size ()
3536 if data != None :
36- data = str (data .decode ())
37- if self .debug :
38- print (data )
37+ if 70 <= queue_size <= 139 :
38+ data = str (data .decode ())
39+ if self .debug :
40+ print (data )
41+ elif 0 <= queue_size < 70 :
42+ data = str (data .decode ())
43+ if self .debug :
44+ print (data )
45+ else :
46+ qs = 0
47+ while True :
48+ try :
49+ time .sleep (2 )
50+ qs = self ._get_queue_size ()
51+ if self .debug :
52+ print ('respone_size1:' , qs )
53+ if qs < 70 :
54+ time .sleep (1 )
55+ qsize = self ._get_queue_size ()
56+ print ('respone_size2:' , qsize )
57+ break
58+
59+ except Exception as e :
60+ print (e )
61+
62+
3963
4064 def _request (self , flag = "" ):
4165 """Get data from the robot"""
You can’t perform that action at this time.
0 commit comments