Fix set_framerate.

This commit is contained in:
iabdalkader 2021-08-24 23:00:46 +02:00
parent 7912ee8542
commit 83c0ee97ce

View File

@ -620,17 +620,14 @@ __weak int sensor_set_framerate(int framerate)
return SENSOR_ERROR_INVALID_ARGUMENT; return SENSOR_ERROR_INVALID_ARGUMENT;
} }
// Call the sensor specific function (does not fail if function is not set) // If the sensor implements framerate control use it.
if (sensor.set_framerate != NULL) { if (sensor.set_framerate != NULL
return SENSOR_ERROR_CTL_UNSUPPORTED; && sensor.set_framerate(&sensor, framerate) != 0) {
}
if (sensor.set_framerate(&sensor, framerate) != 0) {
return SENSOR_ERROR_CTL_FAILED; return SENSOR_ERROR_CTL_FAILED;
} else {
// Otherwise use software framerate control.
sensor.framerate = framerate;
} }
// Set framerate
sensor.framerate = framerate;
return 0; return 0;
} }