From 83c0ee97ce842083453f8984ec4550dc7d2df138 Mon Sep 17 00:00:00 2001 From: iabdalkader Date: Tue, 24 Aug 2021 23:00:46 +0200 Subject: [PATCH] Fix set_framerate. --- src/omv/common/sensor_utils.c | 15 ++++++--------- 1 file changed, 6 insertions(+), 9 deletions(-) diff --git a/src/omv/common/sensor_utils.c b/src/omv/common/sensor_utils.c index 8c26dcdac..0ca8e0aeb 100644 --- a/src/omv/common/sensor_utils.c +++ b/src/omv/common/sensor_utils.c @@ -620,17 +620,14 @@ __weak int sensor_set_framerate(int framerate) return SENSOR_ERROR_INVALID_ARGUMENT; } - // Call the sensor specific function (does not fail if function is not set) - if (sensor.set_framerate != NULL) { - return SENSOR_ERROR_CTL_UNSUPPORTED; - } - - if (sensor.set_framerate(&sensor, framerate) != 0) { + // If the sensor implements framerate control use it. + if (sensor.set_framerate != NULL + && sensor.set_framerate(&sensor, framerate) != 0) { return SENSOR_ERROR_CTL_FAILED; + } else { + // Otherwise use software framerate control. + sensor.framerate = framerate; } - - // Set framerate - sensor.framerate = framerate; return 0; }