no random factors

pull/1117/head
ZwX1616 5 years ago committed by GitHub
parent 50944d305f
commit bba7fbb490
No known key found for this signature in database
GPG Key ID: 4AEE18F83AFDEB23
  1. 8
      selfdrive/camerad/cameras/camera_qcom.c

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

Loading…
Cancel
Save