no random factors

old-commit-hash: bba7fbb490
commatwo_master
ZwX1616 5 years ago committed by GitHub
parent 8c4d5e274b
commit 274edbb8a4
  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(""); s->focus_err = nan("");
nan_cnt += 1; nan_cnt += 1;
if (nan_cnt > patience_cnt) { if (nan_cnt > patience_cnt) {
s->focus_err = 16*8.0; s->focus_err = 16;
nan_cnt = 0; nan_cnt = 0;
} }
return; return;
@ -1752,12 +1752,12 @@ static void parse_autofocus(CameraState *s, uint8_t *d) {
nan_cnt += 1; nan_cnt += 1;
return; return;
} else { } else {
s->focus_err = 16*8.0; s->focus_err = 16;
// s->focus_err = max_focus*8.0; // s->focus_err = max_focus*8.0;
nan_cnt = 0; nan_cnt = 0;
} }
} else { } else {
s->focus_err = avg_focus*8.0; s->focus_err = avg_focus;
nan_cnt = 0; nan_cnt = 0;
} }
// printf("fe=%f\n", s->focus_err); // printf("fe=%f\n", s->focus_err);
@ -1769,7 +1769,7 @@ static void do_autofocus(CameraState *s) {
float err = s->focus_err; float err = s->focus_err;
// don't allow big change // 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; float sag = (s->last_sag_acc_z/9.8) * 128;
const int dac_up = s->device == DEVICE_LP3? 634:456; const int dac_up = s->device == DEVICE_LP3? 634:456;

Loading…
Cancel
Save