|  |  |  | @ -1738,7 +1738,7 @@ static void parse_autofocus(CameraState *s, uint8_t *d) { | 
			
		
	
		
			
				
					|  |  |  |  |     s->focus_err = nan(""); | 
			
		
	
		
			
				
					|  |  |  |  |     nan_cnt += 1; | 
			
		
	
		
			
				
					|  |  |  |  |     if (nan_cnt > patience_cnt) { | 
			
		
	
		
			
				
					|  |  |  |  |       s->focus_err = 16*8.0; | 
			
		
	
		
			
				
					|  |  |  |  |       s->focus_err = 16; | 
			
		
	
		
			
				
					|  |  |  |  |       nan_cnt = 0; | 
			
		
	
		
			
				
					|  |  |  |  |     } | 
			
		
	
		
			
				
					|  |  |  |  |     return; | 
			
		
	
	
		
			
				
					|  |  |  | @ -1752,12 +1752,12 @@ static void parse_autofocus(CameraState *s, uint8_t *d) { | 
			
		
	
		
			
				
					|  |  |  |  |       nan_cnt += 1; | 
			
		
	
		
			
				
					|  |  |  |  |       return; | 
			
		
	
		
			
				
					|  |  |  |  |     } else { | 
			
		
	
		
			
				
					|  |  |  |  |       s->focus_err = 16*8.0; | 
			
		
	
		
			
				
					|  |  |  |  |       s->focus_err = 16; | 
			
		
	
		
			
				
					|  |  |  |  |       // s->focus_err = max_focus*8.0;
 | 
			
		
	
		
			
				
					|  |  |  |  |       nan_cnt = 0; | 
			
		
	
		
			
				
					|  |  |  |  |     } | 
			
		
	
		
			
				
					|  |  |  |  |   } else { | 
			
		
	
		
			
				
					|  |  |  |  |     s->focus_err = avg_focus*8.0; | 
			
		
	
		
			
				
					|  |  |  |  |     s->focus_err = avg_focus; | 
			
		
	
		
			
				
					|  |  |  |  |     nan_cnt = 0; | 
			
		
	
		
			
				
					|  |  |  |  |   } | 
			
		
	
		
			
				
					|  |  |  |  |   // printf("fe=%f\n", s->focus_err);
 | 
			
		
	
	
		
			
				
					|  |  |  | @ -1769,7 +1769,7 @@ static void do_autofocus(CameraState *s) { | 
			
		
	
		
			
				
					|  |  |  |  | 
 | 
			
		
	
		
			
				
					|  |  |  |  |   float err = s->focus_err; | 
			
		
	
		
			
				
					|  |  |  |  |   // don't allow big change
 | 
			
		
	
		
			
				
					|  |  |  |  |   err = clamp(err, -128, 128); | 
			
		
	
		
			
				
					|  |  |  |  |   err = clamp(err, -16, 16); | 
			
		
	
		
			
				
					|  |  |  |  |   float sag = (s->last_sag_acc_z/9.8) * 128; | 
			
		
	
		
			
				
					|  |  |  |  | 
 | 
			
		
	
		
			
				
					|  |  |  |  |   const int dac_up = s->device == DEVICE_LP3? 634:456; | 
			
		
	
	
		
			
				
					|  |  |  | 
 |