|
|
|
@ -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; |
|
|
|
|