diff --git a/selfdrive/camerad/imgproc/utils.cc b/selfdrive/camerad/imgproc/utils.cc index 5e04a27cd3..7dd0ab97a2 100644 --- a/selfdrive/camerad/imgproc/utils.cc +++ b/selfdrive/camerad/imgproc/utils.cc @@ -16,7 +16,7 @@ uint16_t get_lapmap_one(const int16_t *lap, int x_pitch, int y_pitch) { int16_t max = 0; int sum = 0; for (int i = 0; i < size; ++i) { - const int16_t v = lap[i % x_pitch + (i / x_pitch) * x_pitch]; + const int16_t v = lap[i]; sum += v; if (v > max) max = v; } @@ -26,7 +26,7 @@ uint16_t get_lapmap_one(const int16_t *lap, int x_pitch, int y_pitch) { // var of roi int var = 0; for (int i = 0; i < size; ++i) { - var += std::pow(lap[i % x_pitch + (i / x_pitch) * x_pitch] - mean, 2); + var += std::pow(lap[i] - mean, 2); } const float fvar = (float)var / size;