blob: 04b05f2261e7229ba2615fce510b5608c466f799 [file] [log] [blame]
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -08001/*
2 * Copyright (C) 2019 The Android Open Source Project
3 *
4 * Licensed under the Apache License, Version 2.0 (the "License");
5 * you may not use this file except in compliance with the License.
6 * You may obtain a copy of the License at
7 *
8 * http://www.apache.org/licenses/LICENSE-2.0
9 *
10 * Unless required by applicable law or agreed to in writing, software
11 * distributed under the License is distributed on an "AS IS" BASIS,
12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
13 * See the License for the specific language governing permissions and
14 * limitations under the License.
15 */
16
17#define LOG_TAG "Camera3-OutputUtils"
18#define ATRACE_TAG ATRACE_TAG_CAMERA
19//#define LOG_NDEBUG 0
20//#define LOG_NNDEBUG 0 // Per-frame verbose logging
21
22#ifdef LOG_NNDEBUG
23#define ALOGVV(...) ALOGV(__VA_ARGS__)
24#else
25#define ALOGVV(...) ((void)0)
26#endif
27
28// Convenience macros for transitioning to the error state
29#define SET_ERR(fmt, ...) states.setErrIntf.setErrorState( \
30 "%s: " fmt, __FUNCTION__, \
31 ##__VA_ARGS__)
32
33#include <inttypes.h>
34
35#include <utils/Log.h>
36#include <utils/SortedVector.h>
37#include <utils/Trace.h>
38
39#include <android/hardware/camera2/ICameraDeviceCallbacks.h>
40
41#include <android/hardware/camera/device/3.4/ICameraDeviceCallback.h>
42#include <android/hardware/camera/device/3.5/ICameraDeviceCallback.h>
43#include <android/hardware/camera/device/3.5/ICameraDeviceSession.h>
44
Emilian Peev5104fe92021-10-21 14:27:09 -070045#include <camera/CameraUtils.h>
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -080046#include <camera_metadata_hidden.h>
47
48#include "device3/Camera3OutputUtils.h"
49
Emilian Peev5104fe92021-10-21 14:27:09 -070050#include "system/camera_metadata.h"
51
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -080052using namespace android::camera3;
53using namespace android::hardware::camera;
54
55namespace android {
56namespace camera3 {
57
58status_t fixupMonochromeTags(
59 CaptureOutputStates& states,
60 const CameraMetadata& deviceInfo,
61 CameraMetadata& resultMetadata) {
62 status_t res = OK;
63 if (!states.needFixupMonoChrome) {
64 return res;
65 }
66
67 // Remove tags that are not applicable to monochrome camera.
68 int32_t tagsToRemove[] = {
69 ANDROID_SENSOR_GREEN_SPLIT,
70 ANDROID_SENSOR_NEUTRAL_COLOR_POINT,
71 ANDROID_COLOR_CORRECTION_MODE,
72 ANDROID_COLOR_CORRECTION_TRANSFORM,
73 ANDROID_COLOR_CORRECTION_GAINS,
74 };
75 for (auto tag : tagsToRemove) {
76 res = resultMetadata.erase(tag);
77 if (res != OK) {
78 ALOGE("%s: Failed to remove tag %d for monochrome camera", __FUNCTION__, tag);
79 return res;
80 }
81 }
82
83 // ANDROID_SENSOR_DYNAMIC_BLACK_LEVEL
84 camera_metadata_entry blEntry = resultMetadata.find(ANDROID_SENSOR_DYNAMIC_BLACK_LEVEL);
85 for (size_t i = 1; i < blEntry.count; i++) {
86 blEntry.data.f[i] = blEntry.data.f[0];
87 }
88
89 // ANDROID_SENSOR_NOISE_PROFILE
90 camera_metadata_entry npEntry = resultMetadata.find(ANDROID_SENSOR_NOISE_PROFILE);
91 if (npEntry.count > 0 && npEntry.count % 2 == 0) {
92 double np[] = {npEntry.data.d[0], npEntry.data.d[1]};
93 res = resultMetadata.update(ANDROID_SENSOR_NOISE_PROFILE, np, 2);
94 if (res != OK) {
95 ALOGE("%s: Failed to update SENSOR_NOISE_PROFILE: %s (%d)",
96 __FUNCTION__, strerror(-res), res);
97 return res;
98 }
99 }
100
101 // ANDROID_STATISTICS_LENS_SHADING_MAP
102 camera_metadata_ro_entry lsSizeEntry = deviceInfo.find(ANDROID_LENS_INFO_SHADING_MAP_SIZE);
103 camera_metadata_entry lsEntry = resultMetadata.find(ANDROID_STATISTICS_LENS_SHADING_MAP);
104 if (lsSizeEntry.count == 2 && lsEntry.count > 0
105 && (int32_t)lsEntry.count == 4 * lsSizeEntry.data.i32[0] * lsSizeEntry.data.i32[1]) {
106 for (int32_t i = 0; i < lsSizeEntry.data.i32[0] * lsSizeEntry.data.i32[1]; i++) {
107 lsEntry.data.f[4*i+1] = lsEntry.data.f[4*i];
108 lsEntry.data.f[4*i+2] = lsEntry.data.f[4*i];
109 lsEntry.data.f[4*i+3] = lsEntry.data.f[4*i];
110 }
111 }
112
113 // ANDROID_TONEMAP_CURVE_BLUE
114 // ANDROID_TONEMAP_CURVE_GREEN
115 // ANDROID_TONEMAP_CURVE_RED
116 camera_metadata_entry tcbEntry = resultMetadata.find(ANDROID_TONEMAP_CURVE_BLUE);
117 camera_metadata_entry tcgEntry = resultMetadata.find(ANDROID_TONEMAP_CURVE_GREEN);
118 camera_metadata_entry tcrEntry = resultMetadata.find(ANDROID_TONEMAP_CURVE_RED);
119 if (tcbEntry.count > 0
120 && tcbEntry.count == tcgEntry.count
121 && tcbEntry.count == tcrEntry.count) {
122 for (size_t i = 0; i < tcbEntry.count; i++) {
123 tcbEntry.data.f[i] = tcrEntry.data.f[i];
124 tcgEntry.data.f[i] = tcrEntry.data.f[i];
125 }
126 }
127
128 return res;
129}
130
Shuzhen Wangcd8811c2022-08-29 17:23:52 +0000131void correctMeteringRegions(camera_metadata_t *meta) {
132 if (meta == nullptr) return;
133
134 uint32_t meteringRegionKeys[] = {
135 ANDROID_CONTROL_AE_REGIONS,
136 ANDROID_CONTROL_AWB_REGIONS,
137 ANDROID_CONTROL_AF_REGIONS };
138
139 for (uint32_t key : meteringRegionKeys) {
140 camera_metadata_entry_t entry;
141 int res = find_camera_metadata_entry(meta, key, &entry);
142 if (res != OK) continue;
143
144 for (size_t i = 0; i < entry.count; i += 5) {
145 if (entry.data.i32[0] > entry.data.i32[2]) {
146 ALOGW("%s: Invalid metering region (%d): left: %d, right: %d",
147 __FUNCTION__, key, entry.data.i32[0], entry.data.i32[2]);
148 entry.data.i32[2] = entry.data.i32[0];
149 }
150 if (entry.data.i32[1] > entry.data.i32[3]) {
151 ALOGW("%s: Invalid metering region (%d): top: %d, bottom: %d",
152 __FUNCTION__, key, entry.data.i32[1], entry.data.i32[3]);
153 entry.data.i32[3] = entry.data.i32[1];
154 }
155 }
156 }
157}
158
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800159void insertResultLocked(CaptureOutputStates& states, CaptureResult *result, uint32_t frameNumber) {
160 if (result == nullptr) return;
161
162 camera_metadata_t *meta = const_cast<camera_metadata_t *>(
163 result->mMetadata.getAndLock());
164 set_camera_metadata_vendor_id(meta, states.vendorTagId);
Shuzhen Wangcd8811c2022-08-29 17:23:52 +0000165 correctMeteringRegions(meta);
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800166 result->mMetadata.unlock(meta);
167
168 if (result->mMetadata.update(ANDROID_REQUEST_FRAME_COUNT,
169 (int32_t*)&frameNumber, 1) != OK) {
170 SET_ERR("Failed to set frame number %d in metadata", frameNumber);
171 return;
172 }
173
174 if (result->mMetadata.update(ANDROID_REQUEST_ID, &result->mResultExtras.requestId, 1) != OK) {
175 SET_ERR("Failed to set request ID in metadata for frame %d", frameNumber);
176 return;
177 }
178
179 // Update vendor tag id for physical metadata
180 for (auto& physicalMetadata : result->mPhysicalMetadatas) {
181 camera_metadata_t *pmeta = const_cast<camera_metadata_t *>(
182 physicalMetadata.mPhysicalCameraMetadata.getAndLock());
183 set_camera_metadata_vendor_id(pmeta, states.vendorTagId);
Shuzhen Wangcd8811c2022-08-29 17:23:52 +0000184 correctMeteringRegions(pmeta);
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800185 physicalMetadata.mPhysicalCameraMetadata.unlock(pmeta);
186 }
187
188 // Valid result, insert into queue
Jayant Chowdhary8a0be292020-01-08 13:10:38 -0800189 std::list<CaptureResult>::iterator queuedResult =
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800190 states.resultQueue.insert(states.resultQueue.end(), CaptureResult(*result));
Jayant Chowdhary8a0be292020-01-08 13:10:38 -0800191 ALOGV("%s: result requestId = %" PRId32 ", frameNumber = %" PRId64
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800192 ", burstId = %" PRId32, __FUNCTION__,
193 queuedResult->mResultExtras.requestId,
194 queuedResult->mResultExtras.frameNumber,
195 queuedResult->mResultExtras.burstId);
196
197 states.resultSignal.notify_one();
198}
199
200
201void sendPartialCaptureResult(CaptureOutputStates& states,
202 const camera_metadata_t * partialResult,
203 const CaptureResultExtras &resultExtras, uint32_t frameNumber) {
204 ATRACE_CALL();
205 std::lock_guard<std::mutex> l(states.outputLock);
206
207 CaptureResult captureResult;
208 captureResult.mResultExtras = resultExtras;
209 captureResult.mMetadata = partialResult;
210
211 // Fix up result metadata for monochrome camera.
212 status_t res = fixupMonochromeTags(states, states.deviceInfo, captureResult.mMetadata);
213 if (res != OK) {
214 SET_ERR("Failed to override result metadata: %s (%d)", strerror(-res), res);
215 return;
216 }
217
Shuzhen Wang8c75a642020-10-29 21:58:53 -0700218 // Update partial result by removing keys remapped by DistortionCorrection, ZoomRatio,
219 // and RotationAndCrop mappers.
220 std::set<uint32_t> keysToRemove;
221
222 auto iter = states.distortionMappers.find(states.cameraId.c_str());
223 if (iter != states.distortionMappers.end()) {
224 const auto& remappedKeys = iter->second.getRemappedKeys();
225 keysToRemove.insert(remappedKeys.begin(), remappedKeys.end());
226 }
227
228 const auto& remappedKeys = states.zoomRatioMappers[states.cameraId.c_str()].getRemappedKeys();
229 keysToRemove.insert(remappedKeys.begin(), remappedKeys.end());
230
231 auto mapper = states.rotateAndCropMappers.find(states.cameraId.c_str());
232 if (mapper != states.rotateAndCropMappers.end()) {
233 const auto& remappedKeys = iter->second.getRemappedKeys();
234 keysToRemove.insert(remappedKeys.begin(), remappedKeys.end());
235 }
236
237 for (uint32_t key : keysToRemove) {
238 captureResult.mMetadata.erase(key);
239 }
240
241 // Send partial result
242 if (captureResult.mMetadata.entryCount() > 0) {
243 insertResultLocked(states, &captureResult, frameNumber);
244 }
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800245}
246
247void sendCaptureResult(
248 CaptureOutputStates& states,
249 CameraMetadata &pendingMetadata,
250 CaptureResultExtras &resultExtras,
251 CameraMetadata &collectedPartialResult,
252 uint32_t frameNumber,
Eino-Ville Talvalaf2e37092020-01-07 15:32:32 -0800253 bool reprocess, bool zslStillCapture, bool rotateAndCropAuto,
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800254 const std::set<std::string>& cameraIdsWithZoom,
255 const std::vector<PhysicalCaptureResultInfo>& physicalMetadatas) {
256 ATRACE_CALL();
257 if (pendingMetadata.isEmpty())
258 return;
259
260 std::lock_guard<std::mutex> l(states.outputLock);
261
262 // TODO: need to track errors for tighter bounds on expected frame number
263 if (reprocess) {
264 if (frameNumber < states.nextReprocResultFrameNum) {
265 SET_ERR("Out-of-order reprocess capture result metadata submitted! "
266 "(got frame number %d, expecting %d)",
267 frameNumber, states.nextReprocResultFrameNum);
268 return;
269 }
270 states.nextReprocResultFrameNum = frameNumber + 1;
271 } else if (zslStillCapture) {
272 if (frameNumber < states.nextZslResultFrameNum) {
273 SET_ERR("Out-of-order ZSL still capture result metadata submitted! "
274 "(got frame number %d, expecting %d)",
275 frameNumber, states.nextZslResultFrameNum);
276 return;
277 }
278 states.nextZslResultFrameNum = frameNumber + 1;
279 } else {
280 if (frameNumber < states.nextResultFrameNum) {
281 SET_ERR("Out-of-order capture result metadata submitted! "
282 "(got frame number %d, expecting %d)",
283 frameNumber, states.nextResultFrameNum);
284 return;
285 }
286 states.nextResultFrameNum = frameNumber + 1;
287 }
288
289 CaptureResult captureResult;
290 captureResult.mResultExtras = resultExtras;
291 captureResult.mMetadata = pendingMetadata;
292 captureResult.mPhysicalMetadatas = physicalMetadatas;
293
294 // Append any previous partials to form a complete result
295 if (states.usePartialResult && !collectedPartialResult.isEmpty()) {
296 captureResult.mMetadata.append(collectedPartialResult);
297 }
298
299 captureResult.mMetadata.sort();
300
301 // Check that there's a timestamp in the result metadata
302 camera_metadata_entry timestamp = captureResult.mMetadata.find(ANDROID_SENSOR_TIMESTAMP);
303 if (timestamp.count == 0) {
304 SET_ERR("No timestamp provided by HAL for frame %d!",
305 frameNumber);
306 return;
307 }
Yin-Chia Yehc530c592020-03-09 14:50:36 -0700308 nsecs_t sensorTimestamp = timestamp.data.i64[0];
309
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800310 for (auto& physicalMetadata : captureResult.mPhysicalMetadatas) {
311 camera_metadata_entry timestamp =
312 physicalMetadata.mPhysicalCameraMetadata.find(ANDROID_SENSOR_TIMESTAMP);
313 if (timestamp.count == 0) {
314 SET_ERR("No timestamp provided by HAL for physical camera %s frame %d!",
315 String8(physicalMetadata.mPhysicalCameraId).c_str(), frameNumber);
316 return;
317 }
318 }
319
320 // Fix up some result metadata to account for HAL-level distortion correction
Yin-Chia Yeh7ffbd982020-04-13 10:04:23 -0700321 status_t res = OK;
322 auto iter = states.distortionMappers.find(states.cameraId.c_str());
323 if (iter != states.distortionMappers.end()) {
324 res = iter->second.correctCaptureResult(&captureResult.mMetadata);
325 if (res != OK) {
326 SET_ERR("Unable to correct capture result metadata for frame %d: %s (%d)",
327 frameNumber, strerror(-res), res);
328 return;
329 }
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800330 }
331
332 // Fix up result metadata to account for zoom ratio availabilities between
333 // HAL and app.
334 bool zoomRatioIs1 = cameraIdsWithZoom.find(states.cameraId.c_str()) == cameraIdsWithZoom.end();
335 res = states.zoomRatioMappers[states.cameraId.c_str()].updateCaptureResult(
336 &captureResult.mMetadata, zoomRatioIs1);
337 if (res != OK) {
338 SET_ERR("Failed to update capture result zoom ratio metadata for frame %d: %s (%d)",
339 frameNumber, strerror(-res), res);
340 return;
341 }
342
Eino-Ville Talvalaf2e37092020-01-07 15:32:32 -0800343 // Fix up result metadata to account for rotateAndCrop in AUTO mode
344 if (rotateAndCropAuto) {
345 auto mapper = states.rotateAndCropMappers.find(states.cameraId.c_str());
346 if (mapper != states.rotateAndCropMappers.end()) {
347 res = mapper->second.updateCaptureResult(
348 &captureResult.mMetadata);
349 if (res != OK) {
350 SET_ERR("Unable to correct capture result rotate-and-crop for frame %d: %s (%d)",
351 frameNumber, strerror(-res), res);
352 return;
353 }
354 }
355 }
356
Bharatt Kukrejad33fe9f2022-11-23 21:52:52 +0000357 // Fix up autoframing metadata
358 camera_metadata_entry autoframingEntry =
359 captureResult.mMetadata.find(ANDROID_CONTROL_AUTOFRAMING);
360 if (autoframingEntry.count == 0) {
361 const uint8_t defaultAutoframingEntry = ANDROID_CONTROL_AUTOFRAMING_OFF;
362 if (captureResult.mMetadata.update(ANDROID_CONTROL_AUTOFRAMING,
363 &defaultAutoframingEntry, 1) != OK) {
364 SET_ERR("Failed to set autoframing mode in metadata for frame %d", frameNumber);
365 return;
366 }
367 }
368
369 camera_metadata_entry autoframingStateEntry =
370 captureResult.mMetadata.find(ANDROID_CONTROL_AUTOFRAMING_STATE);
371 if (autoframingStateEntry.count == 0) {
372 const uint8_t defaultAutoframingStateEntry = ANDROID_CONTROL_AUTOFRAMING_STATE_INACTIVE;
373 if (captureResult.mMetadata.update(ANDROID_CONTROL_AUTOFRAMING_STATE,
374 &defaultAutoframingStateEntry, 1) != OK) {
375 SET_ERR("Failed to set autoframing state in metadata for frame %d", frameNumber);
376 return;
377 }
378 }
379
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800380 for (auto& physicalMetadata : captureResult.mPhysicalMetadatas) {
381 String8 cameraId8(physicalMetadata.mPhysicalCameraId);
Eino-Ville Talvalaf2e37092020-01-07 15:32:32 -0800382 auto mapper = states.distortionMappers.find(cameraId8.c_str());
383 if (mapper != states.distortionMappers.end()) {
384 res = mapper->second.correctCaptureResult(
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800385 &physicalMetadata.mPhysicalCameraMetadata);
386 if (res != OK) {
387 SET_ERR("Unable to correct physical capture result metadata for frame %d: %s (%d)",
388 frameNumber, strerror(-res), res);
389 return;
390 }
391 }
392
393 zoomRatioIs1 = cameraIdsWithZoom.find(cameraId8.c_str()) == cameraIdsWithZoom.end();
394 res = states.zoomRatioMappers[cameraId8.c_str()].updateCaptureResult(
395 &physicalMetadata.mPhysicalCameraMetadata, zoomRatioIs1);
396 if (res != OK) {
397 SET_ERR("Failed to update camera %s's physical zoom ratio metadata for "
398 "frame %d: %s(%d)", cameraId8.c_str(), frameNumber, strerror(-res), res);
399 return;
400 }
401 }
402
403 // Fix up result metadata for monochrome camera.
404 res = fixupMonochromeTags(states, states.deviceInfo, captureResult.mMetadata);
405 if (res != OK) {
406 SET_ERR("Failed to override result metadata: %s (%d)", strerror(-res), res);
407 return;
408 }
409 for (auto& physicalMetadata : captureResult.mPhysicalMetadatas) {
410 String8 cameraId8(physicalMetadata.mPhysicalCameraId);
411 res = fixupMonochromeTags(states,
412 states.physicalDeviceInfoMap.at(cameraId8.c_str()),
413 physicalMetadata.mPhysicalCameraMetadata);
414 if (res != OK) {
415 SET_ERR("Failed to override result metadata: %s (%d)", strerror(-res), res);
416 return;
417 }
418 }
419
420 std::unordered_map<std::string, CameraMetadata> monitoredPhysicalMetadata;
421 for (auto& m : physicalMetadatas) {
422 monitoredPhysicalMetadata.emplace(String8(m.mPhysicalCameraId).string(),
423 CameraMetadata(m.mPhysicalCameraMetadata));
424 }
425 states.tagMonitor.monitorMetadata(TagMonitor::RESULT,
Yin-Chia Yehc530c592020-03-09 14:50:36 -0700426 frameNumber, sensorTimestamp, captureResult.mMetadata,
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800427 monitoredPhysicalMetadata);
428
429 insertResultLocked(states, &captureResult, frameNumber);
430}
431
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800432void removeInFlightMapEntryLocked(CaptureOutputStates& states, int idx) {
433 ATRACE_CALL();
434 InFlightRequestMap& inflightMap = states.inflightMap;
435 nsecs_t duration = inflightMap.valueAt(idx).maxExpectedDuration;
436 inflightMap.removeItemsAt(idx, 1);
437
438 states.inflightIntf.onInflightEntryRemovedLocked(duration);
439}
440
441void removeInFlightRequestIfReadyLocked(CaptureOutputStates& states, int idx) {
442 InFlightRequestMap& inflightMap = states.inflightMap;
Greg Kaiser51b882c2020-06-10 05:41:44 +0000443 const InFlightRequest &request = inflightMap.valueAt(idx);
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800444 const uint32_t frameNumber = inflightMap.keyAt(idx);
Shuzhen Wang316781a2020-08-18 18:11:01 -0700445 SessionStatsBuilder& sessionStatsBuilder = states.sessionStatsBuilder;
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800446
447 nsecs_t sensorTimestamp = request.sensorTimestamp;
448 nsecs_t shutterTimestamp = request.shutterTimestamp;
449
450 // Check if it's okay to remove the request from InFlightMap:
451 // In the case of a successful request:
452 // all input and output buffers, all result metadata, shutter callback
453 // arrived.
Shuzhen Wangb7b42652020-05-07 11:59:02 -0700454 // In the case of an unsuccessful request:
455 // all input and output buffers, as well as request/result error notifications, arrived.
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800456 if (request.numBuffersLeft == 0 &&
457 (request.skipResultMetadata ||
458 (request.haveResultMetadata && shutterTimestamp != 0))) {
459 if (request.stillCapture) {
460 ATRACE_ASYNC_END("still capture", frameNumber);
461 }
462
463 ATRACE_ASYNC_END("frame capture", frameNumber);
464
Ivan Lozanoc0ad82f2020-07-30 09:32:57 -0400465 // Validation check - if sensor timestamp matches shutter timestamp in the
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800466 // case of request having callback.
467 if (request.hasCallback && request.requestStatus == OK &&
468 sensorTimestamp != shutterTimestamp) {
469 SET_ERR("sensor timestamp (%" PRId64
470 ") for frame %d doesn't match shutter timestamp (%" PRId64 ")",
471 sensorTimestamp, frameNumber, shutterTimestamp);
472 }
473
474 // for an unsuccessful request, it may have pending output buffers to
475 // return.
476 assert(request.requestStatus != OK ||
477 request.pendingOutputBuffers.size() == 0);
478
Greg Kaiser51b882c2020-06-10 05:41:44 +0000479 returnOutputBuffers(
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800480 states.useHalBufManager, states.listener,
481 request.pendingOutputBuffers.array(),
Shuzhen Wang90708ea2021-11-04 11:40:49 -0700482 request.pendingOutputBuffers.size(), /*timestamp*/0, /*readoutTimestamp*/0,
Shuzhen Wang316781a2020-08-18 18:11:01 -0700483 /*requested*/true, request.requestTimeNs, states.sessionStatsBuilder,
484 /*timestampIncreasing*/true,
Shuzhen Wangb7b42652020-05-07 11:59:02 -0700485 request.outputSurfaces, request.resultExtras,
Emilian Peev5104fe92021-10-21 14:27:09 -0700486 request.errorBufStrategy, request.transform);
Shuzhen Wangb7b42652020-05-07 11:59:02 -0700487
488 // Note down the just completed frame number
489 if (request.hasInputBuffer) {
490 states.lastCompletedReprocessFrameNumber = frameNumber;
Shuzhen Wang828ade32022-01-10 17:19:02 -0800491 } else if (request.zslCapture && request.stillCapture) {
Shuzhen Wangb7b42652020-05-07 11:59:02 -0700492 states.lastCompletedZslFrameNumber = frameNumber;
493 } else {
494 states.lastCompletedRegularFrameNumber = frameNumber;
495 }
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800496
Shuzhen Wang316781a2020-08-18 18:11:01 -0700497 sessionStatsBuilder.incResultCounter(request.skipResultMetadata);
498
Greg Kaiser51b882c2020-06-10 05:41:44 +0000499 removeInFlightMapEntryLocked(states, idx);
500 ALOGVV("%s: removed frame %d from InFlightMap", __FUNCTION__, frameNumber);
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800501 }
502
503 states.inflightIntf.checkInflightMapLengthLocked();
504}
505
Shuzhen Wang99080502021-03-07 21:08:20 -0800506// Erase the subset of physicalCameraIds that contains id
507bool erasePhysicalCameraIdSet(
508 std::set<std::set<String8>>& physicalCameraIds, const String8& id) {
509 bool found = false;
510 for (auto iter = physicalCameraIds.begin(); iter != physicalCameraIds.end(); iter++) {
511 if (iter->count(id) == 1) {
512 physicalCameraIds.erase(iter);
513 found = true;
514 break;
515 }
516 }
517 return found;
518}
519
Shuzhen Wang3c00b092022-11-08 22:53:07 +0000520const std::set<std::string>& getCameraIdsWithZoomLocked(
521 const InFlightRequestMap& inflightMap, const CameraMetadata& metadata,
522 const std::set<std::string>& cameraIdsWithZoom) {
523 camera_metadata_ro_entry overrideEntry =
524 metadata.find(ANDROID_CONTROL_SETTINGS_OVERRIDE);
525 camera_metadata_ro_entry frameNumberEntry =
526 metadata.find(ANDROID_CONTROL_SETTINGS_OVERRIDING_FRAME_NUMBER);
527 if (overrideEntry.count != 1
528 || overrideEntry.data.i32[0] != ANDROID_CONTROL_SETTINGS_OVERRIDE_ZOOM
529 || frameNumberEntry.count != 1) {
530 // No valid overriding frame number, skip
531 return cameraIdsWithZoom;
532 }
533
534 uint32_t overridingFrameNumber = frameNumberEntry.data.i32[0];
535 ssize_t idx = inflightMap.indexOfKey(overridingFrameNumber);
536 if (idx < 0) {
537 ALOGE("%s: Failed to find pending request #%d in inflight map",
538 __FUNCTION__, overridingFrameNumber);
539 return cameraIdsWithZoom;
540 }
541
542 const InFlightRequest &r = inflightMap.valueFor(overridingFrameNumber);
543 return r.cameraIdsWithZoom;
544}
545
Emilian Peevf4816702020-04-03 15:44:51 -0700546void processCaptureResult(CaptureOutputStates& states, const camera_capture_result *result) {
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800547 ATRACE_CALL();
548
549 status_t res;
550
551 uint32_t frameNumber = result->frame_number;
552 if (result->result == NULL && result->num_output_buffers == 0 &&
553 result->input_buffer == NULL) {
554 SET_ERR("No result data provided by HAL for frame %d",
555 frameNumber);
556 return;
557 }
558
559 if (!states.usePartialResult &&
560 result->result != NULL &&
561 result->partial_result != 1) {
562 SET_ERR("Result is malformed for frame %d: partial_result %u must be 1"
563 " if partial result is not supported",
564 frameNumber, result->partial_result);
565 return;
566 }
567
568 bool isPartialResult = false;
569 CameraMetadata collectedPartialResult;
570 bool hasInputBufferInRequest = false;
571
572 // Get shutter timestamp and resultExtras from list of in-flight requests,
573 // where it was added by the shutter notification for this frame. If the
574 // shutter timestamp isn't received yet, append the output buffers to the
575 // in-flight request and they will be returned when the shutter timestamp
576 // arrives. Update the in-flight status and remove the in-flight entry if
577 // all result data and shutter timestamp have been received.
578 nsecs_t shutterTimestamp = 0;
579 {
580 std::lock_guard<std::mutex> l(states.inflightLock);
581 ssize_t idx = states.inflightMap.indexOfKey(frameNumber);
582 if (idx == NAME_NOT_FOUND) {
583 SET_ERR("Unknown frame number for capture result: %d",
584 frameNumber);
585 return;
586 }
587 InFlightRequest &request = states.inflightMap.editValueAt(idx);
588 ALOGVV("%s: got InFlightRequest requestId = %" PRId32
589 ", frameNumber = %" PRId64 ", burstId = %" PRId32
Shuzhen Wangb7b42652020-05-07 11:59:02 -0700590 ", partialResultCount = %d/%d, hasCallback = %d, num_output_buffers %d"
591 ", usePartialResult = %d",
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800592 __FUNCTION__, request.resultExtras.requestId,
593 request.resultExtras.frameNumber, request.resultExtras.burstId,
Shuzhen Wangb7b42652020-05-07 11:59:02 -0700594 result->partial_result, states.numPartialResults,
595 request.hasCallback, result->num_output_buffers,
596 states.usePartialResult);
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800597 // Always update the partial count to the latest one if it's not 0
598 // (buffers only). When framework aggregates adjacent partial results
599 // into one, the latest partial count will be used.
600 if (result->partial_result != 0)
601 request.resultExtras.partialResultCount = result->partial_result;
602
Emilian Peev5104fe92021-10-21 14:27:09 -0700603 if ((result->result != nullptr) && !states.legacyClient) {
604 camera_metadata_ro_entry entry;
605 auto ret = find_camera_metadata_ro_entry(result->result,
606 ANDROID_LOGICAL_MULTI_CAMERA_ACTIVE_PHYSICAL_ID, &entry);
607 if ((ret == OK) && (entry.count > 0)) {
608 std::string physicalId(reinterpret_cast<const char *>(entry.data.u8));
609 auto deviceInfo = states.physicalDeviceInfoMap.find(physicalId);
610 if (deviceInfo != states.physicalDeviceInfoMap.end()) {
611 auto orientation = deviceInfo->second.find(ANDROID_SENSOR_ORIENTATION);
612 if (orientation.count > 0) {
613 ret = CameraUtils::getRotationTransform(deviceInfo->second,
Shuzhen Wang610d7b82022-02-08 14:37:22 -0800614 OutputConfiguration::MIRROR_MODE_AUTO, &request.transform);
Emilian Peev5104fe92021-10-21 14:27:09 -0700615 if (ret != OK) {
616 ALOGE("%s: Failed to calculate current stream transformation: %s (%d)",
617 __FUNCTION__, strerror(-ret), ret);
618 }
619 } else {
620 ALOGE("%s: Physical device orientation absent!", __FUNCTION__);
621 }
622 } else {
623 ALOGE("%s: Physical device not found in device info map found!", __FUNCTION__);
624 }
625 }
626 }
627
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800628 // Check if this result carries only partial metadata
629 if (states.usePartialResult && result->result != NULL) {
630 if (result->partial_result > states.numPartialResults || result->partial_result < 1) {
631 SET_ERR("Result is malformed for frame %d: partial_result %u must be in"
632 " the range of [1, %d] when metadata is included in the result",
633 frameNumber, result->partial_result, states.numPartialResults);
634 return;
635 }
636 isPartialResult = (result->partial_result < states.numPartialResults);
637 if (isPartialResult && result->num_physcam_metadata) {
638 SET_ERR("Result is malformed for frame %d: partial_result not allowed for"
639 " physical camera result", frameNumber);
640 return;
641 }
642 if (isPartialResult) {
643 request.collectedPartialResult.append(result->result);
644 }
645
646 if (isPartialResult && request.hasCallback) {
647 // Send partial capture result
648 sendPartialCaptureResult(states, result->result, request.resultExtras,
649 frameNumber);
650 }
651 }
652
653 shutterTimestamp = request.shutterTimestamp;
654 hasInputBufferInRequest = request.hasInputBuffer;
655
656 // Did we get the (final) result metadata for this capture?
657 if (result->result != NULL && !isPartialResult) {
658 if (request.physicalCameraIds.size() != result->num_physcam_metadata) {
659 SET_ERR("Expected physical Camera metadata count %d not equal to actual count %d",
660 request.physicalCameraIds.size(), result->num_physcam_metadata);
661 return;
662 }
663 if (request.haveResultMetadata) {
664 SET_ERR("Called multiple times with metadata for frame %d",
665 frameNumber);
666 return;
667 }
668 for (uint32_t i = 0; i < result->num_physcam_metadata; i++) {
669 String8 physicalId(result->physcam_ids[i]);
Shuzhen Wang99080502021-03-07 21:08:20 -0800670 bool validPhysicalCameraMetadata =
671 erasePhysicalCameraIdSet(request.physicalCameraIds, physicalId);
672 if (!validPhysicalCameraMetadata) {
673 SET_ERR("Unexpected total result for frame %d camera %s",
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800674 frameNumber, physicalId.c_str());
675 return;
676 }
677 }
678 if (states.usePartialResult &&
679 !request.collectedPartialResult.isEmpty()) {
680 collectedPartialResult.acquire(
681 request.collectedPartialResult);
682 }
683 request.haveResultMetadata = true;
Shuzhen Wangb7b42652020-05-07 11:59:02 -0700684 request.errorBufStrategy = ERROR_BUF_RETURN_NOTIFY;
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800685 }
686
687 uint32_t numBuffersReturned = result->num_output_buffers;
688 if (result->input_buffer != NULL) {
689 if (hasInputBufferInRequest) {
690 numBuffersReturned += 1;
691 } else {
692 ALOGW("%s: Input buffer should be NULL if there is no input"
693 " buffer sent in the request",
694 __FUNCTION__);
695 }
696 }
697 request.numBuffersLeft -= numBuffersReturned;
698 if (request.numBuffersLeft < 0) {
699 SET_ERR("Too many buffers returned for frame %d",
700 frameNumber);
701 return;
702 }
703
704 camera_metadata_ro_entry_t entry;
705 res = find_camera_metadata_ro_entry(result->result,
706 ANDROID_SENSOR_TIMESTAMP, &entry);
707 if (res == OK && entry.count == 1) {
708 request.sensorTimestamp = entry.data.i64[0];
709 }
710
Shuzhen Wangb7b42652020-05-07 11:59:02 -0700711 // If shutter event isn't received yet, do not return the pending output
712 // buffers.
713 request.pendingOutputBuffers.appendArray(result->output_buffers,
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800714 result->num_output_buffers);
Shuzhen Wangb7b42652020-05-07 11:59:02 -0700715 if (shutterTimestamp != 0) {
716 returnAndRemovePendingOutputBuffers(
717 states.useHalBufManager, states.listener,
Shuzhen Wang316781a2020-08-18 18:11:01 -0700718 request, states.sessionStatsBuilder);
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800719 }
720
721 if (result->result != NULL && !isPartialResult) {
722 for (uint32_t i = 0; i < result->num_physcam_metadata; i++) {
723 CameraMetadata physicalMetadata;
724 physicalMetadata.append(result->physcam_metadata[i]);
725 request.physicalMetadatas.push_back({String16(result->physcam_ids[i]),
726 physicalMetadata});
727 }
728 if (shutterTimestamp == 0) {
729 request.pendingMetadata = result->result;
730 request.collectedPartialResult = collectedPartialResult;
731 } else if (request.hasCallback) {
732 CameraMetadata metadata;
733 metadata = result->result;
Shuzhen Wang3c00b092022-11-08 22:53:07 +0000734 auto cameraIdsWithZoom = getCameraIdsWithZoomLocked(
735 states.inflightMap, metadata, request.cameraIdsWithZoom);
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800736 sendCaptureResult(states, metadata, request.resultExtras,
737 collectedPartialResult, frameNumber,
738 hasInputBufferInRequest, request.zslCapture && request.stillCapture,
Shuzhen Wang3c00b092022-11-08 22:53:07 +0000739 request.rotateAndCropAuto, cameraIdsWithZoom,
Eino-Ville Talvalaf2e37092020-01-07 15:32:32 -0800740 request.physicalMetadatas);
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800741 }
742 }
743 removeInFlightRequestIfReadyLocked(states, idx);
744 } // scope for states.inFlightLock
745
746 if (result->input_buffer != NULL) {
747 if (hasInputBufferInRequest) {
748 Camera3Stream *stream =
749 Camera3Stream::cast(result->input_buffer->stream);
750 res = stream->returnInputBuffer(*(result->input_buffer));
751 // Note: stream may be deallocated at this point, if this buffer was the
752 // last reference to it.
753 if (res != OK) {
754 ALOGE("%s: RequestThread: Can't return input buffer for frame %d to"
755 " its stream:%s (%d)", __FUNCTION__,
756 frameNumber, strerror(-res), res);
757 }
758 } else {
759 ALOGW("%s: Input buffer should be NULL if there is no input"
760 " buffer sent in the request, skipping input buffer return.",
761 __FUNCTION__);
762 }
763 }
764}
765
Greg Kaiser51b882c2020-06-10 05:41:44 +0000766void returnOutputBuffers(
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800767 bool useHalBufManager,
768 sp<NotificationListener> listener,
Emilian Peevf4816702020-04-03 15:44:51 -0700769 const camera_stream_buffer_t *outputBuffers, size_t numBuffers,
Shuzhen Wang90708ea2021-11-04 11:40:49 -0700770 nsecs_t timestamp, nsecs_t readoutTimestamp, bool requested,
771 nsecs_t requestTimeNs, SessionStatsBuilder& sessionStatsBuilder,
772 bool timestampIncreasing, const SurfaceMap& outputSurfaces,
Shuzhen Wangb7b42652020-05-07 11:59:02 -0700773 const CaptureResultExtras &inResultExtras,
Emilian Peev5104fe92021-10-21 14:27:09 -0700774 ERROR_BUF_STRATEGY errorBufStrategy, int32_t transform) {
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800775
776 for (size_t i = 0; i < numBuffers; i++)
777 {
Shuzhen Wangb7b42652020-05-07 11:59:02 -0700778 Camera3StreamInterface *stream = Camera3Stream::cast(outputBuffers[i].stream);
779 int streamId = stream->getId();
780
781 // Call notify(ERROR_BUFFER) if necessary.
Emilian Peevf4816702020-04-03 15:44:51 -0700782 if (outputBuffers[i].status == CAMERA_BUFFER_STATUS_ERROR &&
Shuzhen Wangb7b42652020-05-07 11:59:02 -0700783 errorBufStrategy == ERROR_BUF_RETURN_NOTIFY) {
784 if (listener != nullptr) {
785 CaptureResultExtras extras = inResultExtras;
786 extras.errorStreamId = streamId;
787 listener->notifyError(
788 hardware::camera2::ICameraDeviceCallbacks::ERROR_CAMERA_BUFFER,
789 extras);
790 }
791 }
792
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800793 if (outputBuffers[i].buffer == nullptr) {
794 if (!useHalBufManager) {
795 // With HAL buffer management API, HAL sometimes will have to return buffers that
796 // has not got a output buffer handle filled yet. This is though illegal if HAL
797 // buffer management API is not being used.
798 ALOGE("%s: cannot return a null buffer!", __FUNCTION__);
Shuzhen Wang316781a2020-08-18 18:11:01 -0700799 } else {
800 if (requested) {
801 sessionStatsBuilder.incCounter(streamId, /*dropped*/true, 0);
802 }
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800803 }
804 continue;
805 }
806
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800807 const auto& it = outputSurfaces.find(streamId);
808 status_t res = OK;
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800809
Shuzhen Wangb7b42652020-05-07 11:59:02 -0700810 // Do not return the buffer if the buffer status is error, and the error
811 // buffer strategy is CACHE.
Emilian Peevf4816702020-04-03 15:44:51 -0700812 if (outputBuffers[i].status != CAMERA_BUFFER_STATUS_ERROR ||
Shuzhen Wangb7b42652020-05-07 11:59:02 -0700813 errorBufStrategy != ERROR_BUF_CACHE) {
814 if (it != outputSurfaces.end()) {
815 res = stream->returnBuffer(
Shuzhen Wang90708ea2021-11-04 11:40:49 -0700816 outputBuffers[i], timestamp, readoutTimestamp, timestampIncreasing,
817 it->second, inResultExtras.frameNumber, transform);
Shuzhen Wangb7b42652020-05-07 11:59:02 -0700818 } else {
819 res = stream->returnBuffer(
Shuzhen Wang90708ea2021-11-04 11:40:49 -0700820 outputBuffers[i], timestamp, readoutTimestamp, timestampIncreasing,
Emilian Peev5104fe92021-10-21 14:27:09 -0700821 std::vector<size_t> (), inResultExtras.frameNumber, transform);
Shuzhen Wangb7b42652020-05-07 11:59:02 -0700822 }
823 }
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800824 // Note: stream may be deallocated at this point, if this buffer was
825 // the last reference to it.
Shuzhen Wang316781a2020-08-18 18:11:01 -0700826 bool dropped = false;
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800827 if (res == NO_INIT || res == DEAD_OBJECT) {
828 ALOGV("Can't return buffer to its stream: %s (%d)", strerror(-res), res);
Shuzhen Wang316781a2020-08-18 18:11:01 -0700829 sessionStatsBuilder.stopCounter(streamId);
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800830 } else if (res != OK) {
831 ALOGE("Can't return buffer to its stream: %s (%d)", strerror(-res), res);
Shuzhen Wang316781a2020-08-18 18:11:01 -0700832 dropped = true;
833 } else {
Emilian Peevf4816702020-04-03 15:44:51 -0700834 if (outputBuffers[i].status == CAMERA_BUFFER_STATUS_ERROR || timestamp == 0) {
Shuzhen Wang316781a2020-08-18 18:11:01 -0700835 dropped = true;
836 }
837 }
838 if (requested) {
839 nsecs_t bufferTimeNs = systemTime();
840 int32_t captureLatencyMs = ns2ms(bufferTimeNs - requestTimeNs);
841 sessionStatsBuilder.incCounter(streamId, dropped, captureLatencyMs);
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800842 }
843
844 // Long processing consumers can cause returnBuffer timeout for shared stream
845 // If that happens, cancel the buffer and send a buffer error to client
846 if (it != outputSurfaces.end() && res == TIMED_OUT &&
Emilian Peevf4816702020-04-03 15:44:51 -0700847 outputBuffers[i].status == CAMERA_BUFFER_STATUS_OK) {
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800848 // cancel the buffer
Emilian Peevf4816702020-04-03 15:44:51 -0700849 camera_stream_buffer_t sb = outputBuffers[i];
850 sb.status = CAMERA_BUFFER_STATUS_ERROR;
Shuzhen Wang90708ea2021-11-04 11:40:49 -0700851 stream->returnBuffer(sb, /*timestamp*/0, /*readoutTimestamp*/0,
Shuzhen Wang316781a2020-08-18 18:11:01 -0700852 timestampIncreasing, std::vector<size_t> (),
Emilian Peev5104fe92021-10-21 14:27:09 -0700853 inResultExtras.frameNumber, transform);
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800854
855 if (listener != nullptr) {
856 CaptureResultExtras extras = inResultExtras;
857 extras.errorStreamId = streamId;
858 listener->notifyError(
859 hardware::camera2::ICameraDeviceCallbacks::ERROR_CAMERA_BUFFER,
860 extras);
861 }
862 }
863 }
864}
865
Shuzhen Wangb7b42652020-05-07 11:59:02 -0700866void returnAndRemovePendingOutputBuffers(bool useHalBufManager,
Shuzhen Wang316781a2020-08-18 18:11:01 -0700867 sp<NotificationListener> listener, InFlightRequest& request,
868 SessionStatsBuilder& sessionStatsBuilder) {
Shuzhen Wang828ade32022-01-10 17:19:02 -0800869 bool timestampIncreasing =
870 !((request.zslCapture && request.stillCapture) || request.hasInputBuffer);
Shuzhen Wangffc4c012022-04-20 15:55:46 -0700871 nsecs_t readoutTimestamp = request.resultExtras.hasReadoutTimestamp ?
872 request.resultExtras.readoutTimestamp : 0;
Shuzhen Wangb7b42652020-05-07 11:59:02 -0700873 returnOutputBuffers(useHalBufManager, listener,
874 request.pendingOutputBuffers.array(),
875 request.pendingOutputBuffers.size(),
Shuzhen Wangffc4c012022-04-20 15:55:46 -0700876 request.shutterTimestamp, readoutTimestamp,
Shuzhen Wang90708ea2021-11-04 11:40:49 -0700877 /*requested*/true, request.requestTimeNs, sessionStatsBuilder, timestampIncreasing,
Shuzhen Wangb7b42652020-05-07 11:59:02 -0700878 request.outputSurfaces, request.resultExtras,
Emilian Peev5104fe92021-10-21 14:27:09 -0700879 request.errorBufStrategy, request.transform);
Shuzhen Wangb7b42652020-05-07 11:59:02 -0700880
881 // Remove error buffers that are not cached.
882 for (auto iter = request.pendingOutputBuffers.begin();
883 iter != request.pendingOutputBuffers.end(); ) {
884 if (request.errorBufStrategy != ERROR_BUF_CACHE ||
Emilian Peevf4816702020-04-03 15:44:51 -0700885 iter->status != CAMERA_BUFFER_STATUS_ERROR) {
Shuzhen Wangb7b42652020-05-07 11:59:02 -0700886 iter = request.pendingOutputBuffers.erase(iter);
887 } else {
888 iter++;
889 }
890 }
891}
892
Emilian Peevf4816702020-04-03 15:44:51 -0700893void notifyShutter(CaptureOutputStates& states, const camera_shutter_msg_t &msg) {
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800894 ATRACE_CALL();
895 ssize_t idx;
896
897 // Set timestamp for the request in the in-flight tracking
898 // and get the request ID to send upstream
899 {
900 std::lock_guard<std::mutex> l(states.inflightLock);
901 InFlightRequestMap& inflightMap = states.inflightMap;
902 idx = inflightMap.indexOfKey(msg.frame_number);
903 if (idx >= 0) {
904 InFlightRequest &r = inflightMap.editValueAt(idx);
905
906 // Verify ordering of shutter notifications
907 {
908 std::lock_guard<std::mutex> l(states.outputLock);
909 // TODO: need to track errors for tighter bounds on expected frame number.
910 if (r.hasInputBuffer) {
911 if (msg.frame_number < states.nextReprocShutterFrameNum) {
912 SET_ERR("Reprocess shutter notification out-of-order. Expected "
913 "notification for frame %d, got frame %d",
914 states.nextReprocShutterFrameNum, msg.frame_number);
915 return;
916 }
917 states.nextReprocShutterFrameNum = msg.frame_number + 1;
918 } else if (r.zslCapture && r.stillCapture) {
919 if (msg.frame_number < states.nextZslShutterFrameNum) {
920 SET_ERR("ZSL still capture shutter notification out-of-order. Expected "
921 "notification for frame %d, got frame %d",
922 states.nextZslShutterFrameNum, msg.frame_number);
923 return;
924 }
925 states.nextZslShutterFrameNum = msg.frame_number + 1;
926 } else {
927 if (msg.frame_number < states.nextShutterFrameNum) {
928 SET_ERR("Shutter notification out-of-order. Expected "
929 "notification for frame %d, got frame %d",
930 states.nextShutterFrameNum, msg.frame_number);
931 return;
932 }
933 states.nextShutterFrameNum = msg.frame_number + 1;
934 }
935 }
936
937 r.shutterTimestamp = msg.timestamp;
Shuzhen Wangffc4c012022-04-20 15:55:46 -0700938 if (msg.readout_timestamp_valid) {
939 r.resultExtras.hasReadoutTimestamp = true;
940 r.resultExtras.readoutTimestamp = msg.readout_timestamp;
941 }
Shuzhen Wang696e4da2022-09-08 14:31:13 -0700942 if (r.minExpectedDuration != states.minFrameDuration ||
943 r.isFixedFps != states.isFixedFps) {
Shuzhen Wang00abbeb2022-02-25 17:14:42 -0800944 for (size_t i = 0; i < states.outputStreams.size(); i++) {
945 auto outputStream = states.outputStreams[i];
Shuzhen Wang696e4da2022-09-08 14:31:13 -0700946 outputStream->onMinDurationChanged(r.minExpectedDuration, r.isFixedFps);
Shuzhen Wang00abbeb2022-02-25 17:14:42 -0800947 }
948 states.minFrameDuration = r.minExpectedDuration;
Shuzhen Wang696e4da2022-09-08 14:31:13 -0700949 states.isFixedFps = r.isFixedFps;
Shuzhen Wang00abbeb2022-02-25 17:14:42 -0800950 }
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800951 if (r.hasCallback) {
952 ALOGVV("Camera %s: %s: Shutter fired for frame %d (id %d) at %" PRId64,
953 states.cameraId.string(), __FUNCTION__,
954 msg.frame_number, r.resultExtras.requestId, msg.timestamp);
955 // Call listener, if any
956 if (states.listener != nullptr) {
Shuzhen Wangb7b42652020-05-07 11:59:02 -0700957 r.resultExtras.lastCompletedRegularFrameNumber =
958 states.lastCompletedRegularFrameNumber;
959 r.resultExtras.lastCompletedReprocessFrameNumber =
960 states.lastCompletedReprocessFrameNumber;
961 r.resultExtras.lastCompletedZslFrameNumber =
962 states.lastCompletedZslFrameNumber;
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800963 states.listener->notifyShutter(r.resultExtras, msg.timestamp);
964 }
965 // send pending result and buffers
Shuzhen Wang3c00b092022-11-08 22:53:07 +0000966 const auto& cameraIdsWithZoom = getCameraIdsWithZoomLocked(
967 inflightMap, r.pendingMetadata, r.cameraIdsWithZoom);
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800968 sendCaptureResult(states,
969 r.pendingMetadata, r.resultExtras,
970 r.collectedPartialResult, msg.frame_number,
971 r.hasInputBuffer, r.zslCapture && r.stillCapture,
Shuzhen Wang3c00b092022-11-08 22:53:07 +0000972 r.rotateAndCropAuto, cameraIdsWithZoom, r.physicalMetadatas);
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800973 }
Shuzhen Wangb7b42652020-05-07 11:59:02 -0700974 returnAndRemovePendingOutputBuffers(
Shuzhen Wang316781a2020-08-18 18:11:01 -0700975 states.useHalBufManager, states.listener, r, states.sessionStatsBuilder);
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800976
977 removeInFlightRequestIfReadyLocked(states, idx);
978 }
979 }
980 if (idx < 0) {
981 SET_ERR("Shutter notification for non-existent frame number %d",
982 msg.frame_number);
983 }
984}
985
Emilian Peevf4816702020-04-03 15:44:51 -0700986void notifyError(CaptureOutputStates& states, const camera_error_msg_t &msg) {
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800987 ATRACE_CALL();
988 // Map camera HAL error codes to ICameraDeviceCallback error codes
989 // Index into this with the HAL error code
Emilian Peevf4816702020-04-03 15:44:51 -0700990 static const int32_t halErrorMap[CAMERA_MSG_NUM_ERRORS] = {
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800991 // 0 = Unused error code
992 hardware::camera2::ICameraDeviceCallbacks::ERROR_CAMERA_INVALID_ERROR,
Emilian Peevf4816702020-04-03 15:44:51 -0700993 // 1 = CAMERA_MSG_ERROR_DEVICE
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800994 hardware::camera2::ICameraDeviceCallbacks::ERROR_CAMERA_DEVICE,
Emilian Peevf4816702020-04-03 15:44:51 -0700995 // 2 = CAMERA_MSG_ERROR_REQUEST
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800996 hardware::camera2::ICameraDeviceCallbacks::ERROR_CAMERA_REQUEST,
Emilian Peevf4816702020-04-03 15:44:51 -0700997 // 3 = CAMERA_MSG_ERROR_RESULT
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -0800998 hardware::camera2::ICameraDeviceCallbacks::ERROR_CAMERA_RESULT,
Emilian Peevf4816702020-04-03 15:44:51 -0700999 // 4 = CAMERA_MSG_ERROR_BUFFER
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -08001000 hardware::camera2::ICameraDeviceCallbacks::ERROR_CAMERA_BUFFER
1001 };
1002
1003 int32_t errorCode =
1004 ((msg.error_code >= 0) &&
Emilian Peevf4816702020-04-03 15:44:51 -07001005 (msg.error_code < CAMERA_MSG_NUM_ERRORS)) ?
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -08001006 halErrorMap[msg.error_code] :
1007 hardware::camera2::ICameraDeviceCallbacks::ERROR_CAMERA_INVALID_ERROR;
1008
1009 int streamId = 0;
1010 String16 physicalCameraId;
1011 if (msg.error_stream != nullptr) {
1012 Camera3Stream *stream =
1013 Camera3Stream::cast(msg.error_stream);
1014 streamId = stream->getId();
1015 physicalCameraId = String16(stream->physicalCameraId());
1016 }
1017 ALOGV("Camera %s: %s: HAL error, frame %d, stream %d: %d",
1018 states.cameraId.string(), __FUNCTION__, msg.frame_number,
1019 streamId, msg.error_code);
1020
1021 CaptureResultExtras resultExtras;
1022 switch (errorCode) {
1023 case hardware::camera2::ICameraDeviceCallbacks::ERROR_CAMERA_DEVICE:
1024 // SET_ERR calls into listener to notify application
1025 SET_ERR("Camera HAL reported serious device error");
1026 break;
1027 case hardware::camera2::ICameraDeviceCallbacks::ERROR_CAMERA_REQUEST:
1028 case hardware::camera2::ICameraDeviceCallbacks::ERROR_CAMERA_RESULT:
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -08001029 {
1030 std::lock_guard<std::mutex> l(states.inflightLock);
1031 ssize_t idx = states.inflightMap.indexOfKey(msg.frame_number);
1032 if (idx >= 0) {
1033 InFlightRequest &r = states.inflightMap.editValueAt(idx);
1034 r.requestStatus = msg.error_code;
1035 resultExtras = r.resultExtras;
Shuzhen Wangb7b42652020-05-07 11:59:02 -07001036 bool physicalDeviceResultError = false;
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -08001037 if (hardware::camera2::ICameraDeviceCallbacks::ERROR_CAMERA_RESULT ==
1038 errorCode) {
1039 if (physicalCameraId.size() > 0) {
1040 String8 cameraId(physicalCameraId);
Shuzhen Wang99080502021-03-07 21:08:20 -08001041 bool validPhysicalCameraId =
1042 erasePhysicalCameraIdSet(r.physicalCameraIds, cameraId);
1043 if (!validPhysicalCameraId) {
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -08001044 ALOGE("%s: Reported result failure for physical camera device: %s "
1045 " which is not part of the respective request!",
1046 __FUNCTION__, cameraId.string());
1047 break;
1048 }
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -08001049 resultExtras.errorPhysicalCameraId = physicalCameraId;
Shuzhen Wangb7b42652020-05-07 11:59:02 -07001050 physicalDeviceResultError = true;
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -08001051 }
1052 }
1053
Shuzhen Wangb7b42652020-05-07 11:59:02 -07001054 if (!physicalDeviceResultError) {
Greg Kaiser51b882c2020-06-10 05:41:44 +00001055 r.skipResultMetadata = true;
Shuzhen Wangb7b42652020-05-07 11:59:02 -07001056 if (hardware::camera2::ICameraDeviceCallbacks::ERROR_CAMERA_RESULT
1057 == errorCode) {
1058 r.errorBufStrategy = ERROR_BUF_RETURN_NOTIFY;
1059 } else {
1060 // errorCode is ERROR_CAMERA_REQUEST
1061 r.errorBufStrategy = ERROR_BUF_RETURN;
1062 }
1063
1064 // Check whether the buffers returned. If they returned,
1065 // remove inflight request.
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -08001066 removeInFlightRequestIfReadyLocked(states, idx);
1067 }
1068 } else {
1069 resultExtras.frameNumber = msg.frame_number;
1070 ALOGE("Camera %s: %s: cannot find in-flight request on "
1071 "frame %" PRId64 " error", states.cameraId.string(), __FUNCTION__,
1072 resultExtras.frameNumber);
1073 }
1074 }
1075 resultExtras.errorStreamId = streamId;
1076 if (states.listener != nullptr) {
1077 states.listener->notifyError(errorCode, resultExtras);
1078 } else {
1079 ALOGE("Camera %s: %s: no listener available",
1080 states.cameraId.string(), __FUNCTION__);
1081 }
1082 break;
Shuzhen Wangb7b42652020-05-07 11:59:02 -07001083 case hardware::camera2::ICameraDeviceCallbacks::ERROR_CAMERA_BUFFER:
1084 // Do not depend on HAL ERROR_CAMERA_BUFFER to send buffer error
1085 // callback to the app. Rather, use STATUS_ERROR of image buffers.
1086 break;
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -08001087 default:
1088 // SET_ERR calls notifyError
1089 SET_ERR("Unknown error message from HAL: %d", msg.error_code);
1090 break;
1091 }
1092}
1093
Emilian Peevf4816702020-04-03 15:44:51 -07001094void notify(CaptureOutputStates& states, const camera_notify_msg *msg) {
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -08001095 switch (msg->type) {
Emilian Peevf4816702020-04-03 15:44:51 -07001096 case CAMERA_MSG_ERROR: {
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -08001097 notifyError(states, msg->message.error);
1098 break;
1099 }
Emilian Peevf4816702020-04-03 15:44:51 -07001100 case CAMERA_MSG_SHUTTER: {
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -08001101 notifyShutter(states, msg->message.shutter);
1102 break;
1103 }
1104 default:
1105 SET_ERR("Unknown notify message from HAL: %d",
1106 msg->type);
1107 }
1108}
1109
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -08001110void flushInflightRequests(FlushInflightReqStates& states) {
1111 ATRACE_CALL();
Shuzhen Wang316781a2020-08-18 18:11:01 -07001112 { // First return buffers cached in inFlightMap
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -08001113 std::lock_guard<std::mutex> l(states.inflightLock);
1114 for (size_t idx = 0; idx < states.inflightMap.size(); idx++) {
Greg Kaiser51b882c2020-06-10 05:41:44 +00001115 const InFlightRequest &request = states.inflightMap.valueAt(idx);
1116 returnOutputBuffers(
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -08001117 states.useHalBufManager, states.listener,
1118 request.pendingOutputBuffers.array(),
Shuzhen Wang90708ea2021-11-04 11:40:49 -07001119 request.pendingOutputBuffers.size(), /*timestamp*/0, /*readoutTimestamp*/0,
1120 /*requested*/true, request.requestTimeNs, states.sessionStatsBuilder,
1121 /*timestampIncreasing*/true, request.outputSurfaces, request.resultExtras,
1122 request.errorBufStrategy);
Shuzhen Wangb7b42652020-05-07 11:59:02 -07001123 ALOGW("%s: Frame %d | Timestamp: %" PRId64 ", metadata"
1124 " arrived: %s, buffers left: %d.\n", __FUNCTION__,
1125 states.inflightMap.keyAt(idx), request.shutterTimestamp,
1126 request.haveResultMetadata ? "true" : "false",
1127 request.numBuffersLeft);
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -08001128 }
Shuzhen Wangb7b42652020-05-07 11:59:02 -07001129
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -08001130 states.inflightMap.clear();
1131 states.inflightIntf.onInflightMapFlushedLocked();
1132 }
1133
1134 // Then return all inflight buffers not returned by HAL
1135 std::vector<std::pair<int32_t, int32_t>> inflightKeys;
1136 states.flushBufferIntf.getInflightBufferKeys(&inflightKeys);
1137
1138 // Inflight buffers for HAL buffer manager
1139 std::vector<uint64_t> inflightRequestBufferKeys;
1140 states.flushBufferIntf.getInflightRequestBufferKeys(&inflightRequestBufferKeys);
1141
1142 // (streamId, frameNumber, buffer_handle_t*) tuple for all inflight buffers.
1143 // frameNumber will be -1 for buffers from HAL buffer manager
1144 std::vector<std::tuple<int32_t, int32_t, buffer_handle_t*>> inflightBuffers;
1145 inflightBuffers.reserve(inflightKeys.size() + inflightRequestBufferKeys.size());
1146
1147 for (auto& pair : inflightKeys) {
1148 int32_t frameNumber = pair.first;
1149 int32_t streamId = pair.second;
1150 buffer_handle_t* buffer;
1151 status_t res = states.bufferRecordsIntf.popInflightBuffer(frameNumber, streamId, &buffer);
1152 if (res != OK) {
1153 ALOGE("%s: Frame %d: No in-flight buffer for stream %d",
1154 __FUNCTION__, frameNumber, streamId);
1155 continue;
1156 }
1157 inflightBuffers.push_back(std::make_tuple(streamId, frameNumber, buffer));
1158 }
1159
1160 for (auto& bufferId : inflightRequestBufferKeys) {
1161 int32_t streamId = -1;
1162 buffer_handle_t* buffer = nullptr;
1163 status_t res = states.bufferRecordsIntf.popInflightRequestBuffer(
1164 bufferId, &buffer, &streamId);
1165 if (res != OK) {
1166 ALOGE("%s: cannot find in-flight buffer %" PRIu64, __FUNCTION__, bufferId);
1167 continue;
1168 }
1169 inflightBuffers.push_back(std::make_tuple(streamId, /*frameNumber*/-1, buffer));
1170 }
1171
1172 std::vector<sp<Camera3StreamInterface>> streams = states.flushBufferIntf.getAllStreams();
1173
1174 for (auto& tuple : inflightBuffers) {
1175 status_t res = OK;
1176 int32_t streamId = std::get<0>(tuple);
1177 int32_t frameNumber = std::get<1>(tuple);
1178 buffer_handle_t* buffer = std::get<2>(tuple);
1179
Emilian Peevf4816702020-04-03 15:44:51 -07001180 camera_stream_buffer_t streamBuffer;
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -08001181 streamBuffer.buffer = buffer;
Emilian Peevf4816702020-04-03 15:44:51 -07001182 streamBuffer.status = CAMERA_BUFFER_STATUS_ERROR;
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -08001183 streamBuffer.acquire_fence = -1;
1184 streamBuffer.release_fence = -1;
1185
1186 for (auto& stream : streams) {
1187 if (streamId == stream->getId()) {
1188 // Return buffer to deleted stream
Emilian Peevf4816702020-04-03 15:44:51 -07001189 camera_stream* halStream = stream->asHalStream();
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -08001190 streamBuffer.stream = halStream;
1191 switch (halStream->stream_type) {
Emilian Peevf4816702020-04-03 15:44:51 -07001192 case CAMERA_STREAM_OUTPUT:
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -08001193 res = stream->returnBuffer(streamBuffer, /*timestamp*/ 0,
Shuzhen Wang90708ea2021-11-04 11:40:49 -07001194 /*readoutTimestamp*/0, /*timestampIncreasing*/true,
Shuzhen Wang316781a2020-08-18 18:11:01 -07001195 std::vector<size_t> (), frameNumber);
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -08001196 if (res != OK) {
1197 ALOGE("%s: Can't return output buffer for frame %d to"
1198 " stream %d: %s (%d)", __FUNCTION__,
1199 frameNumber, streamId, strerror(-res), res);
1200 }
1201 break;
Emilian Peevf4816702020-04-03 15:44:51 -07001202 case CAMERA_STREAM_INPUT:
Yin-Chia Yeh5fd603e2019-11-20 11:22:27 -08001203 res = stream->returnInputBuffer(streamBuffer);
1204 if (res != OK) {
1205 ALOGE("%s: Can't return input buffer for frame %d to"
1206 " stream %d: %s (%d)", __FUNCTION__,
1207 frameNumber, streamId, strerror(-res), res);
1208 }
1209 break;
1210 default: // Bi-direcitonal stream is deprecated
1211 ALOGE("%s: stream %d has unknown stream type %d",
1212 __FUNCTION__, streamId, halStream->stream_type);
1213 break;
1214 }
1215 break;
1216 }
1217 }
1218 }
1219}
1220
1221} // camera3
1222} // namespace android