|  |  | @ -147,6 +147,11 @@ def calibrationd_thread(sm=None, pm=None): | 
			
		
	
		
		
			
				
					
					|  |  |  |   while 1: |  |  |  |   while 1: | 
			
		
	
		
		
			
				
					
					|  |  |  |     sm.update() |  |  |  |     sm.update() | 
			
		
	
		
		
			
				
					
					|  |  |  | 
 |  |  |  | 
 | 
			
		
	
		
		
			
				
					
					|  |  |  |  |  |  |  |     # if no inputs still publish calibration | 
			
		
	
		
		
			
				
					
					|  |  |  |  |  |  |  |     if not sm.updated['carState'] and not sm.updated['cameraOdometry']: | 
			
		
	
		
		
			
				
					
					|  |  |  |  |  |  |  |       calibrator.send_data(pm) | 
			
		
	
		
		
			
				
					
					|  |  |  |  |  |  |  |       continue | 
			
		
	
		
		
			
				
					
					|  |  |  |  |  |  |  | 
 | 
			
		
	
		
		
			
				
					
					|  |  |  |     if sm.updated['carState']: |  |  |  |     if sm.updated['carState']: | 
			
		
	
		
		
			
				
					
					|  |  |  |       calibrator.handle_v_ego(sm['carState'].vEgo) |  |  |  |       calibrator.handle_v_ego(sm['carState'].vEgo) | 
			
		
	
		
		
			
				
					
					|  |  |  |       if send_counter % 25 == 0: |  |  |  |       if send_counter % 25 == 0: | 
			
		
	
	
		
		
			
				
					|  |  | @ -159,6 +164,7 @@ def calibrationd_thread(sm=None, pm=None): | 
			
		
	
		
		
			
				
					
					|  |  |  |                                           sm['cameraOdometry'].transStd, |  |  |  |                                           sm['cameraOdometry'].transStd, | 
			
		
	
		
		
			
				
					
					|  |  |  |                                           sm['cameraOdometry'].rotStd) |  |  |  |                                           sm['cameraOdometry'].rotStd) | 
			
		
	
		
		
			
				
					
					|  |  |  | 
 |  |  |  | 
 | 
			
		
	
		
		
			
				
					
					|  |  |  |  |  |  |  | 
 | 
			
		
	
		
		
			
				
					
					|  |  |  |       if DEBUG and new_vp is not None: |  |  |  |       if DEBUG and new_vp is not None: | 
			
		
	
		
		
			
				
					
					|  |  |  |         print('got new vp', new_vp) |  |  |  |         print('got new vp', new_vp) | 
			
		
	
		
		
			
				
					
					|  |  |  | 
 |  |  |  | 
 | 
			
		
	
	
		
		
			
				
					|  |  | 
 |