1 /*
2 ** Copyright (c) 2011-2012 The Linux Foundation. All rights reserved.
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 /*#error uncomment this for compiler test!*/
18
19 #define ALOG_NDEBUG 0
20 #define ALOG_NDDEBUG 0
21 #define ALOG_NIDEBUG 0
22 #define LOG_TAG "QCameraHWI_Still"
23 #include <utils/Log.h>
24 #include <utils/threads.h>
25 #include <fcntl.h>
26 #include <sys/mman.h>
27 #include <media/mediarecorder.h>
28 #include <math.h>
29 #include "QCameraHAL.h"
30 #include "QCameraHWI.h"
31
32 #define THUMBNAIL_DEFAULT_WIDTH 512
33 #define THUMBNAIL_DEFAULT_HEIGHT 384
34 /* following code implement the still image capture & encoding logic of this class*/
35 namespace android {
36
37 typedef enum {
38 SNAPSHOT_STATE_ERROR,
39 SNAPSHOT_STATE_UNINIT,
40 SNAPSHOT_STATE_CH_ACQUIRED,
41 SNAPSHOT_STATE_BUF_NOTIF_REGD,
42 SNAPSHOT_STATE_BUF_INITIALIZED,
43 SNAPSHOT_STATE_INITIALIZED,
44 SNAPSHOT_STATE_IMAGE_CAPTURE_STRTD,
45 SNAPSHOT_STATE_YUV_RECVD,
46 SNAPSHOT_STATE_JPEG_ENCODING,
47 SNAPSHOT_STATE_JPEG_ENCODE_DONE,
48 SNAPSHOT_STATE_JPEG_COMPLETE_ENCODE_DONE,
49
50 /*Add any new state above*/
51 SNAPSHOT_STATE_MAX
52 } snapshot_state_type_t;
53
54
55 //-----------------------------------------------------------------------
56 // Constants
57 //----------------------------------------------------------------------
58 static const int PICTURE_FORMAT_JPEG = 1;
59 static const int PICTURE_FORMAT_RAW = 2;
60 static const int POSTVIEW_SMALL_HEIGHT = 144;
61
62 // ---------------------------------------------------------------------------
63 /* static functions*/
64 // ---------------------------------------------------------------------------
65
66
67
68 /* TBD: Temp: to be removed*/
69 static pthread_mutex_t g_s_mutex;
70 static int g_status = 0;
71 static pthread_cond_t g_s_cond_v;
72
mm_app_snapshot_done()73 static void mm_app_snapshot_done()
74 {
75 pthread_mutex_lock(&g_s_mutex);
76 g_status = true;
77 pthread_cond_signal(&g_s_cond_v);
78 pthread_mutex_unlock(&g_s_mutex);
79 }
80
mm_app_snapshot_wait()81 static void mm_app_snapshot_wait()
82 {
83 pthread_mutex_lock(&g_s_mutex);
84 if(false == g_status) pthread_cond_wait(&g_s_cond_v, &g_s_mutex);
85 pthread_mutex_unlock(&g_s_mutex);
86 g_status = false;
87 }
88
mm_app_dump_snapshot_frame(char * filename,const void * buffer,uint32_t len)89 static int mm_app_dump_snapshot_frame(char *filename,
90 const void *buffer,
91 uint32_t len)
92 {
93 char bufp[128];
94 int file_fdp;
95 int rc = 0;
96
97 file_fdp = open(filename, O_RDWR | O_CREAT, 0777);
98
99 if (file_fdp < 0) {
100 rc = -1;
101 goto end;
102 }
103 write(file_fdp,
104 (const void *)buffer, len);
105 close(file_fdp);
106 end:
107 return rc;
108 }
109
110 /* Callback received when a frame is available after snapshot*/
snapshot_notify_cb(mm_camera_ch_data_buf_t * recvd_frame,void * user_data)111 static void snapshot_notify_cb(mm_camera_ch_data_buf_t *recvd_frame,
112 void *user_data)
113 {
114 QCameraStream_Snapshot *pme = (QCameraStream_Snapshot *)user_data;
115
116 ALOGV("%s: E", __func__);
117
118 if (pme != NULL) {
119 pme->receiveRawPicture(recvd_frame);
120 }
121 else{
122 ALOGW("%s: Snapshot obj NULL in callback", __func__);
123 }
124
125 ALOGV("%s: X", __func__);
126
127 }
128
129 /* Once we give frame for encoding, we get encoded jpeg image
130 fragments by fragment. We'll need to store them in a buffer
131 to form complete JPEG image */
snapshot_jpeg_fragment_cb(uint8_t * ptr,uint32_t size,void * user_data)132 static void snapshot_jpeg_fragment_cb(uint8_t *ptr,
133 uint32_t size,
134 void *user_data)
135 {
136 QCameraStream_Snapshot *pme = (QCameraStream_Snapshot *)user_data;
137
138 ALOGV("%s: E",__func__);
139 if (pme != NULL) {
140 pme->receiveJpegFragment(ptr,size);
141 }
142 else
143 ALOGW("%s: Receive jpeg fragment cb obj Null", __func__);
144
145 ALOGV("%s: X",__func__);
146 }
147
148 /* This callback is received once the complete JPEG encoding is done */
snapshot_jpeg_cb(jpeg_event_t event,void * user_data)149 static void snapshot_jpeg_cb(jpeg_event_t event, void *user_data)
150 {
151 QCameraStream_Snapshot *pme = (QCameraStream_Snapshot *)user_data;
152 ALOGV("%s: E ",__func__);
153
154 switch(event) {
155 case JPEG_EVENT_DONE:
156 break;
157 case JPEG_EVENT_THUMBNAIL_DROPPED:
158 ALOGE("%s: Error in thumbnail encoding (event: %d) : X !!!",
159 __func__, event);
160 return;
161 case JPEG_EVENT_ERROR:
162 case JPEG_EVENT_ABORTED:
163 if (NULL != pme) {
164 pme->jpegErrorHandler(event);
165 if (!(pme->isZSLMode())) {
166 pme->stop();
167 }
168 }
169 ALOGE("Error event handled from JPEG \n");
170 return;
171 default:
172 ALOGE("Unsupported JPEG event %d \n", event);
173 break;
174 }
175
176 if (event != JPEG_EVENT_DONE) {
177 if (event == JPEG_EVENT_THUMBNAIL_DROPPED) {
178 ALOGE("%s: Error in thumbnail encoding (event: %d)!!!",
179 __func__, event);
180 ALOGV("%s: X",__func__);
181 return;
182 }
183 else {
184 ALOGE("%s: Error (event: %d) while jpeg encoding!!!",
185 __func__, event);
186 }
187 }
188
189 if (pme != NULL) {
190 pme->setSnapJpegCbState(true);
191 pme->receiveCompleteJpegPicture(event);
192 ALOGI("Completed issuing JPEG callback");
193 /* deinit only if we are done taking requested number of snapshots */
194 if (pme->getSnapshotState() == SNAPSHOT_STATE_JPEG_COMPLETE_ENCODE_DONE) {
195 ALOGV(" About to issue deinit callback");
196 /* If it's ZSL Mode, we don't deinit now. We'll stop the polling thread and
197 deinit the channel/buffers only when we change the mode from zsl to
198 non-zsl. */
199 if (!(pme->isZSLMode())) {
200 pme->stop();
201 }
202 }
203 pme->setSnapJpegCbState(false);
204 }
205 else
206 ALOGW("%s: Receive jpeg cb Obj Null", __func__);
207
208
209 ALOGV("%s: X",__func__);
210 }
211
212 // ---------------------------------------------------------------------------
213 /* private functions*/
214 // ---------------------------------------------------------------------------
215
216 void QCameraStream_Snapshot::
receiveJpegFragment(uint8_t * ptr,uint32_t size)217 receiveJpegFragment(uint8_t *ptr, uint32_t size)
218 {
219 ALOGV("%s: E", __func__);
220 #if 0
221 if (mJpegHeap != NULL) {
222 ALOGE("%s: Copy jpeg...", __func__);
223 memcpy((uint8_t *)mJpegHeap->mHeap->base()+ mJpegOffset, ptr, size);
224 mJpegOffset += size;
225 }
226 else {
227 ALOGE("%s: mJpegHeap is NULL!", __func__);
228 }
229 #else
230 if(mHalCamCtrl->mJpegMemory.camera_memory[0] != NULL && ptr != NULL && size > 0) {
231 memcpy((uint8_t *)((uint32_t)mHalCamCtrl->mJpegMemory.camera_memory[0]->data + mJpegOffset), ptr, size);
232 mJpegOffset += size;
233
234
235 /*
236 memcpy((uint8_t *)((uint32_t)mHalCamCtrl->mJpegMemory.camera_memory[0]->data + mJpegOffset), ptr, size);
237 mJpegOffset += size;
238 */
239 } else {
240 ALOGE("%s: mJpegHeap is NULL!", __func__);
241 }
242
243
244 #endif
245
246 ALOGV("%s: X", __func__);
247 }
248
jpegErrorHandler(jpeg_event_t event)249 void QCameraStream_Snapshot::jpegErrorHandler(jpeg_event_t event)
250 {
251 ALOGV("%s: E", __func__);
252 camera_memory_t *data = mHalCamCtrl->mGetMemory(-1, 1, 1, NULL);
253 mStopCallbackLock.lock( );
254 if(mCurrentFrameEncoded) {
255 free(mCurrentFrameEncoded);
256 mCurrentFrameEncoded = NULL;
257 }
258 setSnapshotState(SNAPSHOT_STATE_ERROR);
259 if (!mSnapshotQueue.isEmpty()) {
260 ALOGV("%s: JPEG Queue not empty. flush the queue in "
261 "error case.", __func__);
262 mSnapshotQueue.flush();
263 }
264 mStopCallbackLock.unlock( );
265 if (NULL != mHalCamCtrl->mDataCb)
266 mHalCamCtrl->mDataCb (CAMERA_MSG_COMPRESSED_IMAGE,
267 data, 0, NULL,mHalCamCtrl->mCallbackCookie);
268 if(NULL != data) data->release(data);
269 ALOGV("%s: X", __func__);
270 }
271
272 void QCameraStream_Snapshot::
receiveCompleteJpegPicture(jpeg_event_t event)273 receiveCompleteJpegPicture(jpeg_event_t event)
274 {
275 int msg_type = CAMERA_MSG_COMPRESSED_IMAGE;
276 ALOGV("%s: E", __func__);
277 camera_memory_t *encodedMem = NULL;
278 camera_data_callback jpg_data_cb = NULL;
279 bool fail_cb_flag = false;
280
281 if (mHalCamCtrl->mHdrMode == HDR_MODE)
282 hdrJpegCount++;
283
284 mStopCallbackLock.lock( );
285 ALOGV("%s after mStopCallbackLock.lock()", __func__);
286 // if(!mActive && !isLiveSnapshot() && !mHalCamCtrl->mSnapCbDisabled) {
287 if(mHalCamCtrl->mSnapCbDisabled) {
288 ALOGE("%s : Cancel Picture",__func__);
289 fail_cb_flag = true;
290 mHalCamCtrl->deinitExifData();
291 mBurstModeFlag = false;
292 //reset jpeg_offset
293 mJpegOffset = 0;
294 /* free the resource we allocated to maintain the structure */
295 //mm_camera_do_munmap(main_fd, (void *)main_buffer_addr, mSnapshotStreamBuf.frame_len);
296 if(mCurrentFrameEncoded) {
297 free(mCurrentFrameEncoded);
298 mCurrentFrameEncoded = NULL;
299 }
300 // goto end;
301 mStopCallbackLock.unlock();
302 return;
303 }
304 // mStopCallbackLock.lock( );
305 if(mCurrentFrameEncoded!=NULL /*&& !isLiveSnapshot()*/){
306 ALOGV("<DEBUG>: Calling buf done for snapshot buffer");
307 cam_evt_buf_done(mCameraId, mCurrentFrameEncoded);
308 }
309 mHalCamCtrl->dumpFrameToFile(mHalCamCtrl->mJpegMemory.camera_memory[0]->data, mJpegOffset, (char *)"debug", (char *)"jpg", 0);
310
311 end:
312 msg_type = CAMERA_MSG_COMPRESSED_IMAGE;
313 if (mHalCamCtrl->mDataCb && (mHalCamCtrl->mMsgEnabled & msg_type)) {
314 jpg_data_cb = mHalCamCtrl->mDataCb;
315 }else{
316 ALOGE("%s: JPEG callback was cancelled--not delivering image.", __func__);
317 }
318 setSnapshotState(SNAPSHOT_STATE_JPEG_ENCODE_DONE);
319 mNumOfRecievedJPEG++;
320 mHalCamCtrl->deinitExifData();
321
322 /* free the resource we allocated to maintain the structure */
323 //mm_camera_do_munmap(main_fd, (void *)main_buffer_addr, mSnapshotStreamBuf.frame_len);
324 if(mCurrentFrameEncoded) {
325 free(mCurrentFrameEncoded);
326 mCurrentFrameEncoded = NULL;
327 }
328 /* Before leaving check the jpeg queue. If it's not empty give the available
329 frame for encoding*/
330 if (!mSnapshotQueue.isEmpty()) {
331 ALOGV("%s: JPEG Queue not empty. Dequeue and encode.", __func__);
332 mm_camera_ch_data_buf_t* buf =
333 (mm_camera_ch_data_buf_t *)mSnapshotQueue.dequeue();
334 //encodeDisplayAndSave(buf, 1);
335 if ( NO_ERROR != encodeDisplayAndSave(buf, 1)){
336 fail_cb_flag = true;
337 }
338 } else if (mNumOfSnapshot == mNumOfRecievedJPEG ) { /* finished */
339 ALOGV("nusnap %d, mNumjpeg %d", mNumOfSnapshot, mNumOfRecievedJPEG);
340 ALOGV("%s: Before omxJpegFinish", __func__);
341 omxJpegFinish();
342 ALOGV("%s: After omxJpegFinish", __func__);
343 /* getRemainingSnapshots call will give us number of snapshots still
344 remaining after flushing current zsl buffer once*/
345 ALOGV("%s: Complete JPEG Encoding Done!", __func__);
346 setSnapshotState(SNAPSHOT_STATE_JPEG_COMPLETE_ENCODE_DONE);
347 mBurstModeFlag = false;
348 mSnapshotQueue.flush();
349 mNumOfRecievedJPEG = 0;
350 /* in case of zsl, we need to reset some of the zsl attributes */
351 if (isZSLMode()){
352 ALOGV("%s: Resetting the ZSL attributes", __func__);
353 setZSLChannelAttribute();
354 }
355 if (!isZSLMode() && !isLiveSnapshot()){
356 //Stop polling before calling datacb for if not ZSL mode
357 stopPolling();
358 }
359
360 } else {
361 ALOGV("%s: mNumOfRecievedJPEG(%d), mNumOfSnapshot(%d)", __func__, mNumOfRecievedJPEG, mNumOfSnapshot);
362 }
363 if(fail_cb_flag && mHalCamCtrl->mDataCb &&
364 (mHalCamCtrl->mMsgEnabled & CAMERA_MSG_COMPRESSED_IMAGE)) {
365 /* get picture failed. Give jpeg callback with NULL data
366 * to the application to restore to preview mode
367 */
368 jpg_data_cb = mHalCamCtrl->mDataCb;
369 }
370 if(!isLiveSnapshot()) {
371 if(mHalCamCtrl->mHdrMode == HDR_MODE && (hdrJpegCount%2) != 0){
372 mStopCallbackLock.unlock( );
373 mJpegOffset = 0;
374 return;
375 }
376 }
377 if(!fail_cb_flag) {
378 camera_memory_t *encodedMem = mHalCamCtrl->mGetMemory(
379 mHalCamCtrl->mJpegMemory.fd[0], mJpegOffset, 1, mHalCamCtrl);
380 if (!encodedMem || !encodedMem->data) {
381 ALOGE("%s: mGetMemory failed.\n", __func__);
382 }
383 memcpy(encodedMem->data, mHalCamCtrl->mJpegMemory.camera_memory[0]->data, mJpegOffset );
384
385 if ((mActive || isLiveSnapshot()) && jpg_data_cb != NULL && !mHalCamCtrl->mSnapCbDisabled) {
386 ALOGV("%s: Calling upperlayer callback to store JPEG image", __func__);
387 jpg_data_cb (msg_type,encodedMem, 0, NULL,mHalCamCtrl->mCallbackCookie);
388 }
389 encodedMem->release( encodedMem );
390 jpg_data_cb = NULL;
391 }else{
392 ALOGV("Image Encoding Failed... Notify Upper layer");
393 if((mActive || isLiveSnapshot()) && jpg_data_cb != NULL && !mHalCamCtrl->mSnapCbDisabled) {
394 jpg_data_cb (CAMERA_MSG_COMPRESSED_IMAGE,NULL, 0, NULL,
395 mHalCamCtrl->mCallbackCookie);
396 }
397 }
398 //reset jpeg_offset
399 mJpegOffset = 0;
400
401 if(isLiveSnapshot() && mHalCamCtrl->mStateLiveshot) {
402 deInitBuffer();
403 }
404 mHalCamCtrl->mStateLiveshot = false;
405
406 mStopCallbackLock.unlock( );
407 ALOGI("%s After mStopCallbackLock.unlock()", __func__);
408 ALOGD("%s: X", __func__);
409 }
410
411 status_t QCameraStream_Snapshot::
configSnapshotDimension(cam_ctrl_dimension_t * dim)412 configSnapshotDimension(cam_ctrl_dimension_t* dim)
413 {
414 bool matching = true;
415 cam_format_t img_format;
416 status_t ret = NO_ERROR;
417 ALOGV("%s: E", __func__);
418
419 ALOGV("%s:Passed picture size: %d X %d", __func__,
420 dim->picture_width, dim->picture_height);
421 ALOGV("%s:Passed postview size: %d X %d", __func__,
422 dim->ui_thumbnail_width, dim->ui_thumbnail_height);
423
424 /* First check if the picture resolution is the same, if not, change it*/
425 mHalCamCtrl->getPictureSize(&mPictureWidth, &mPictureHeight);
426 ALOGV("%s: Picture size received: %d x %d", __func__,
427 mPictureWidth, mPictureHeight);
428
429 mPostviewWidth = mHalCamCtrl->mParameters.getInt(QCameraParameters::KEY_JPEG_THUMBNAIL_WIDTH);
430 mPostviewHeight = mHalCamCtrl->mParameters.getInt(QCameraParameters::KEY_JPEG_THUMBNAIL_HEIGHT);
431 /*If application requested thumbnail size to be (0,0)
432 then configure second outout to a default size.
433 Jpeg encoder will drop thumbnail as reflected in encodeParams.
434 */
435 mDropThumbnail = false;
436 if (mPostviewWidth == 0 && mPostviewHeight == 0) {
437 mPostviewWidth = THUMBNAIL_DEFAULT_WIDTH;
438 mPostviewHeight = THUMBNAIL_DEFAULT_HEIGHT;
439 mDropThumbnail = true;
440 }
441
442 ALOGV("%s: Postview size received: %d x %d", __func__,
443 mPostviewWidth, mPostviewHeight);
444
445 matching = (mPictureWidth == dim->picture_width) &&
446 (mPictureHeight == dim->picture_height);
447 matching &= (dim->ui_thumbnail_width == mPostviewWidth) &&
448 (dim->ui_thumbnail_height == mPostviewHeight);
449
450 /* picture size currently set do not match with the one wanted
451 by user.*/
452 if (!matching) {
453 if (!isZSLMode() && (mPictureWidth < mPostviewWidth || mPictureHeight < mPostviewHeight)) {
454 //Changes to Handle VFE limitation.
455 mActualPictureWidth = mPictureWidth;
456 mActualPictureHeight = mPictureHeight;
457 mPictureWidth = mPostviewWidth;
458 mPictureHeight = mPostviewHeight;
459 mJpegDownscaling = true;
460 }else{
461 mJpegDownscaling = false;
462 }
463 dim->picture_width = mPictureWidth;
464 dim->picture_height = mPictureHeight;
465 dim->ui_thumbnail_height = mThumbnailHeight = mPostviewHeight;
466 dim->ui_thumbnail_width = mThumbnailWidth = mPostviewWidth;
467 }
468 #if 0
469 img_format = mHalCamCtrl->getPreviewFormat();
470 if (img_format) {
471 matching &= (img_format == dim->main_img_format);
472 if (!matching) {
473 dim->main_img_format = img_format;
474 dim->thumb_format = img_format;
475 }
476 }
477 #endif
478 if (!matching) {
479 ALOGV("%s: Image Sizes before set parm call: main: %dx%d thumbnail: %dx%d",
480 __func__,
481 dim->picture_width, dim->picture_height,
482 dim->ui_thumbnail_width, dim->ui_thumbnail_height);
483
484 ret = cam_config_set_parm(mCameraId, MM_CAMERA_PARM_DIMENSION,dim);
485 if (NO_ERROR != ret) {
486 ALOGE("%s: error - can't config snapshot parms!", __func__);
487 ret = FAILED_TRANSACTION;
488 goto end;
489 }
490 }
491 /* set_parm will return corrected dimension based on aspect ratio and
492 ceiling size */
493 mPictureWidth = dim->picture_width;
494 mPictureHeight = dim->picture_height;
495 mPostviewHeight = mThumbnailHeight = dim->ui_thumbnail_height;
496 mPostviewWidth = mThumbnailWidth = dim->ui_thumbnail_width;
497 mPictureFormat= dim->main_img_format;
498 mThumbnailFormat = dim->thumb_format;
499
500 ALOGV("%s: Image Format: %d", __func__, dim->main_img_format);
501 ALOGV("%s: Image Sizes: main: %dx%d thumbnail: %dx%d", __func__,
502 dim->picture_width, dim->picture_height,
503 dim->ui_thumbnail_width, dim->ui_thumbnail_height);
504 end:
505 ALOGV("%s: X", __func__);
506 return ret;
507 }
508
509 status_t QCameraStream_Snapshot::
initRawSnapshotChannel(cam_ctrl_dimension_t * dim,int num_of_snapshots)510 initRawSnapshotChannel(cam_ctrl_dimension_t *dim,
511 int num_of_snapshots)
512 {
513 status_t ret = NO_ERROR;
514 mm_camera_ch_image_fmt_parm_t fmt;
515 mm_camera_channel_attr_t ch_attr;
516 cam_format_t raw_fmt;
517
518 mm_camera_raw_streaming_type_t raw_stream_type =
519 MM_CAMERA_RAW_STREAMING_CAPTURE_SINGLE;
520
521 ALOGV("%s: E", __func__);
522
523 /* Initialize stream - set format, acquire channel */
524 /*TBD: Currently we only support single raw capture*/
525 ALOGV("num_of_snapshots = %d",num_of_snapshots);
526 if (num_of_snapshots == 1) {
527 raw_stream_type = MM_CAMERA_RAW_STREAMING_CAPTURE_SINGLE;
528 }
529
530 /* Set channel attribute */
531 ALOGV("%s: Set Raw Snapshot Channel attribute", __func__);
532 memset(&ch_attr, 0, sizeof(ch_attr));
533 ch_attr.type = MM_CAMERA_CH_ATTR_RAW_STREAMING_TYPE;
534 ch_attr.raw_streaming_mode = raw_stream_type;
535
536 if( NO_ERROR !=
537 cam_ops_ch_set_attr(mCameraId, MM_CAMERA_CH_RAW, &ch_attr)) {
538 ALOGV("%s: Failure setting Raw channel attribute.", __func__);
539 ret = FAILED_TRANSACTION;
540 goto end;
541 }
542
543 ret = cam_config_get_parm(mCameraId,
544 MM_CAMERA_PARM_RAW_SNAPSHOT_FMT, &raw_fmt);
545 if (NO_ERROR != ret) {
546 ALOGE("%s: error - can't get raw snapshot fmt!", __func__);
547 ret = FAILED_TRANSACTION;
548 goto end;
549 }
550
551 memset(&fmt, 0, sizeof(mm_camera_ch_image_fmt_parm_t));
552 fmt.ch_type = MM_CAMERA_CH_RAW;
553 fmt.def.fmt = raw_fmt;
554 fmt.def.dim.width = dim->raw_picture_width;
555 fmt.def.dim.height = dim->raw_picture_height;
556
557
558 ALOGV("%s: Raw snapshot channel fmt: %d", __func__,
559 fmt.def.fmt);
560 ALOGV("%s: Raw snapshot resolution: %dX%d", __func__,
561 dim->raw_picture_width, dim->raw_picture_height);
562
563 ALOGV("%s: Set Raw Snapshot channel image format", __func__);
564 ret = cam_config_set_parm(mCameraId, MM_CAMERA_PARM_CH_IMAGE_FMT, &fmt);
565 if (NO_ERROR != ret) {
566 ALOGE("%s: Set Raw Snapshot Channel format err=%d\n", __func__, ret);
567 ret = FAILED_TRANSACTION;
568 goto end;
569 }
570
571 end:
572 if (ret != NO_ERROR) {
573 handleError();
574 }
575 ALOGV("%s: X", __func__);
576 return ret;
577
578 }
579
580 status_t QCameraStream_Snapshot::
setZSLChannelAttribute(void)581 setZSLChannelAttribute(void)
582 {
583 status_t ret = NO_ERROR;
584 mm_camera_channel_attr_t ch_attr;
585 ALOGV("%s: E", __func__);
586
587 memset(&ch_attr, 0, sizeof(mm_camera_channel_attr_t));
588 ch_attr.type = MM_CAMERA_CH_ATTR_BUFFERING_FRAME;
589 ch_attr.buffering_frame.look_back = mHalCamCtrl->getZSLBackLookCount();
590 ch_attr.buffering_frame.water_mark = mHalCamCtrl->getZSLQueueDepth();
591 ch_attr.buffering_frame.interval = mHalCamCtrl->getZSLBurstInterval( );
592 ALOGV("%s: ZSL queue_depth = %d, back_look_count = %d", __func__,
593 ch_attr.buffering_frame.water_mark,
594 ch_attr.buffering_frame.look_back);
595 if( NO_ERROR !=
596 cam_ops_ch_set_attr(mCameraId, MM_CAMERA_CH_SNAPSHOT, &ch_attr)) {
597 ALOGV("%s: Failure setting ZSL channel attribute.", __func__);
598 ret = FAILED_TRANSACTION;
599 goto end;
600 }
601 end:
602 ALOGV("%s: X", __func__);
603 return ret;
604 }
605
606 status_t QCameraStream_Snapshot::
initSnapshotFormat(cam_ctrl_dimension_t * dim)607 initSnapshotFormat(cam_ctrl_dimension_t *dim)
608 {
609 status_t ret = NO_ERROR;
610 mm_camera_ch_image_fmt_parm_t fmt;
611
612 ALOGV("%s: E", __func__);
613
614 /* For ZSL mode we'll need to set channel attribute */
615 if (isZSLMode()) {
616 ret = setZSLChannelAttribute();
617 if (ret != NO_ERROR) {
618 goto end;
619 }
620 }
621
622 memset(&fmt, 0, sizeof(mm_camera_ch_image_fmt_parm_t));
623 fmt.ch_type = MM_CAMERA_CH_SNAPSHOT;
624 fmt.snapshot.main.fmt = dim->main_img_format;
625 fmt.snapshot.main.dim.width = dim->picture_width;
626 fmt.snapshot.main.dim.height = dim->picture_height;
627
628 fmt.snapshot.thumbnail.fmt = dim->thumb_format;
629 fmt.snapshot.thumbnail.dim.width = dim->ui_thumbnail_width;
630 fmt.snapshot.thumbnail.dim.height = dim->ui_thumbnail_height;
631
632 ALOGV("%s: Snapshot channel fmt = main: %d thumbnail: %d", __func__,
633 dim->main_img_format, dim->thumb_format);
634 ALOGV("%s: Snapshot channel resolution = main: %dX%d thumbnail: %dX%d",
635 __func__, dim->picture_width, dim->picture_height,
636 dim->ui_thumbnail_width, dim->ui_thumbnail_height);
637
638 ALOGV("%s: Set Snapshot channel image format", __func__);
639 ret = cam_config_set_parm(mCameraId, MM_CAMERA_PARM_CH_IMAGE_FMT, &fmt);
640 if (NO_ERROR != ret) {
641 ALOGE("%s: Set Snapshot Channel format err=%d\n", __func__, ret);
642 ret = FAILED_TRANSACTION;
643 goto end;
644 }
645
646 end:
647 if (ret != NO_ERROR) {
648 handleError();
649 }
650 ALOGV("%s: X", __func__);
651 return ret;
652
653 }
654
655 void QCameraStream_Snapshot::
deinitSnapshotChannel(mm_camera_channel_type_t ch_type)656 deinitSnapshotChannel(mm_camera_channel_type_t ch_type)
657 {
658 ALOGV("%s: E", __func__);
659
660 /* unreg buf notify*/
661 if (getSnapshotState() >= SNAPSHOT_STATE_BUF_NOTIF_REGD){
662 if (NO_ERROR != cam_evt_register_buf_notify(mCameraId,
663 ch_type, NULL,(mm_camera_register_buf_cb_type_t)NULL,NULL, this)) {
664 ALOGE("%s: Failure to unregister buf notification", __func__);
665 }
666 }
667
668 if (getSnapshotState() >= SNAPSHOT_STATE_CH_ACQUIRED) {
669 ALOGV("%s: Release snapshot channel", __func__);
670 cam_ops_ch_release(mCameraId, ch_type);
671 }
672
673 ALOGV("%s: X",__func__);
674 }
675
676 status_t QCameraStream_Snapshot::
initRawSnapshotBuffers(cam_ctrl_dimension_t * dim,int num_of_buf)677 initRawSnapshotBuffers(cam_ctrl_dimension_t *dim, int num_of_buf)
678 {
679 status_t ret = NO_ERROR;
680 struct msm_frame *frame;
681 uint32_t frame_len;
682 uint8_t num_planes;
683 uint32_t planes[VIDEO_MAX_PLANES];
684 mm_camera_reg_buf_t reg_buf;
685 cam_format_t raw_fmt;
686
687 ALOGV("%s: E", __func__);
688 memset(®_buf, 0, sizeof(mm_camera_reg_buf_t));
689 memset(&mSnapshotStreamBuf, 0, sizeof(mSnapshotStreamBuf));
690
691 if ((num_of_buf == 0) || (num_of_buf > MM_CAMERA_MAX_NUM_FRAMES)) {
692 ALOGE("%s: Invalid number of buffers (=%d) requested!", __func__, num_of_buf);
693 ret = BAD_VALUE;
694 goto end;
695 }
696
697 reg_buf.def.buf.mp = new mm_camera_mp_buf_t[num_of_buf];
698 if (!reg_buf.def.buf.mp) {
699 ALOGE("%s Error allocating memory for mplanar struct ", __func__);
700 ret = NO_MEMORY;
701 goto end;
702 }
703 memset(reg_buf.def.buf.mp, 0, num_of_buf * sizeof(mm_camera_mp_buf_t));
704
705 ret = cam_config_get_parm(mCameraId,
706 MM_CAMERA_PARM_RAW_SNAPSHOT_FMT, &raw_fmt);
707 if (NO_ERROR != ret) {
708 ALOGE("%s: error - can't get raw snapshot fmt!", __func__);
709 ret = FAILED_TRANSACTION;
710 goto end;
711 }
712
713 /* Get a frame len for buffer to be allocated*/
714 frame_len = mm_camera_get_msm_frame_len(raw_fmt,
715 myMode,
716 dim->raw_picture_width,
717 dim->raw_picture_height,
718 OUTPUT_TYPE_S,
719 &num_planes, planes);
720
721 if (mHalCamCtrl->initHeapMem(&mHalCamCtrl->mRawMemory, num_of_buf,
722 frame_len, 0, planes[0], MSM_PMEM_RAW_MAINIMG,
723 &mSnapshotStreamBuf, ®_buf.def,
724 num_planes, planes) < 0) {
725 ret = NO_MEMORY;
726 goto end;
727 }
728
729 /* register the streaming buffers for the channel*/
730 reg_buf.ch_type = MM_CAMERA_CH_RAW;
731 reg_buf.def.num = mSnapshotStreamBuf.num;
732
733 ret = cam_config_prepare_buf(mCameraId, ®_buf);
734 if(ret != NO_ERROR) {
735 ALOGV("%s:reg snapshot buf err=%d\n", __func__, ret);
736 ret = FAILED_TRANSACTION;
737 mHalCamCtrl->releaseHeapMem(&mHalCamCtrl->mRawMemory);
738 goto end;
739 }
740
741 /* If we have reached here successfully, we have allocated buffer.
742 Set state machine.*/
743 setSnapshotState(SNAPSHOT_STATE_BUF_INITIALIZED);
744
745 end:
746 /* If it's error, we'll need to do some needful */
747 if (ret != NO_ERROR) {
748 handleError();
749 }
750 if (reg_buf.def.buf.mp)
751 delete []reg_buf.def.buf.mp;
752 ALOGV("%s: X", __func__);
753 return ret;
754 }
755
deinitRawSnapshotBuffers(void)756 status_t QCameraStream_Snapshot::deinitRawSnapshotBuffers(void)
757 {
758 int ret = NO_ERROR;
759 ALOGV("%s: E", __func__);
760
761 int err = getSnapshotState();
762
763 /* deinit buffers only if we have already allocated */
764 if (err >= SNAPSHOT_STATE_BUF_INITIALIZED || err == SNAPSHOT_STATE_ERROR){
765 ALOGV("%s: Unpreparing Snapshot Buffer", __func__);
766 ret = cam_config_unprepare_buf(mCameraId, MM_CAMERA_CH_RAW);
767 if(ret != NO_ERROR) {
768 ALOGE("%s:Unreg Raw snapshot buf err=%d\n", __func__, ret);
769 ret = FAILED_TRANSACTION;
770 goto end;
771 }
772 mHalCamCtrl->releaseHeapMem(&mHalCamCtrl->mRawMemory);
773 }
774
775 end:
776 ALOGV("%s: X", __func__);
777 return ret;
778 }
779
780 status_t QCameraStream_Snapshot::
initSnapshotBuffers(cam_ctrl_dimension_t * dim,int num_of_buf)781 initSnapshotBuffers(cam_ctrl_dimension_t *dim, int num_of_buf)
782 {
783 status_t ret = NO_ERROR;
784 struct msm_frame *frame;
785 uint32_t frame_len, y_off, cbcr_off;
786 uint8_t num_planes;
787 uint32_t planes[VIDEO_MAX_PLANES];
788 mm_camera_reg_buf_t reg_buf;
789 int rotation = 0;
790
791 ALOGV("%s: E", __func__);
792 memset(®_buf, 0, sizeof(mm_camera_reg_buf_t));
793 memset(&mSnapshotStreamBuf, 0, sizeof(mSnapshotStreamBuf));
794
795 if ((num_of_buf == 0) || (num_of_buf > MM_CAMERA_MAX_NUM_FRAMES)) {
796 ALOGE("%s: Invalid number of buffers (=%d) requested!",
797 __func__, num_of_buf);
798 ret = BAD_VALUE;
799 goto end;
800 }
801
802 ALOGV("%s: Mode: %d Num_of_buf: %d ImageSizes: main: %dx%d thumb: %dx%d",
803 __func__, myMode, num_of_buf,
804 dim->picture_width, dim->picture_height,
805 dim->ui_thumbnail_width, dim->ui_thumbnail_height);
806
807 reg_buf.snapshot.main.buf.mp = new mm_camera_mp_buf_t[num_of_buf];
808 if (!reg_buf.snapshot.main.buf.mp) {
809 ALOGE("%s Error allocating memory for mplanar struct ", __func__);
810 ret = NO_MEMORY;
811 goto end;
812 }
813 memset(reg_buf.snapshot.main.buf.mp, 0,
814 num_of_buf * sizeof(mm_camera_mp_buf_t));
815 if (!isFullSizeLiveshot()) {
816 reg_buf.snapshot.thumbnail.buf.mp = new mm_camera_mp_buf_t[num_of_buf];
817 if (!reg_buf.snapshot.thumbnail.buf.mp) {
818 ALOGE("%s Error allocating memory for mplanar struct ", __func__);
819 ret = NO_MEMORY;
820 goto end;
821 }
822 memset(reg_buf.snapshot.thumbnail.buf.mp, 0,
823 num_of_buf * sizeof(mm_camera_mp_buf_t));
824 }
825 /* Number of buffers to be set*/
826 /* Set the JPEG Rotation here since get_buffer_offset needs
827 * the value of rotation.*/
828 mHalCamCtrl->setJpegRotation(isZSLMode());
829 if(!isZSLMode())
830 rotation = mHalCamCtrl->getJpegRotation();
831 else
832 rotation = 0;
833 if(rotation != dim->rotation) {
834 dim->rotation = rotation;
835 ret = cam_config_set_parm(mHalCamCtrl->mCameraId, MM_CAMERA_PARM_DIMENSION, dim);
836 }
837
838 if(isLiveSnapshot()) {
839 ret = cam_config_set_parm(mHalCamCtrl->mCameraId, MM_CAMERA_PARM_DIMENSION, dim);
840 }
841 num_planes = 2;
842 planes[0] = dim->picture_frame_offset.mp[0].len;
843 planes[1] = dim->picture_frame_offset.mp[1].len;
844 frame_len = dim->picture_frame_offset.frame_len;
845 y_off = dim->picture_frame_offset.mp[0].offset;
846 cbcr_off = dim->picture_frame_offset.mp[1].offset;
847 ALOGV("%s: main image: rotation = %d, yoff = %d, cbcroff = %d, size = %d, width = %d, height = %d",
848 __func__, dim->rotation, y_off, cbcr_off, frame_len, dim->picture_width, dim->picture_height);
849 if (mHalCamCtrl->initHeapMem (&mHalCamCtrl->mJpegMemory, 1, frame_len, 0, cbcr_off,
850 MSM_PMEM_MAX, NULL, NULL, num_planes, planes) < 0) {
851 ALOGE("%s: Error allocating JPEG memory", __func__);
852 ret = NO_MEMORY;
853 goto end;
854 }
855 if(!isLiveSnapshot()) {
856 if (mHalCamCtrl->initHeapMem(&mHalCamCtrl->mSnapshotMemory, num_of_buf,
857 frame_len, y_off, cbcr_off, MSM_PMEM_MAINIMG, &mSnapshotStreamBuf,
858 ®_buf.snapshot.main, num_planes, planes) < 0) {
859 ret = NO_MEMORY;
860 mHalCamCtrl->releaseHeapMem(&mHalCamCtrl->mJpegMemory);
861 goto end;
862 };
863 num_planes = 2;
864 planes[0] = dim->thumb_frame_offset.mp[0].len;
865 planes[1] = dim->thumb_frame_offset.mp[1].len;
866 frame_len = planes[0] + planes[1];
867 if (!isFullSizeLiveshot()) {
868 y_off = dim->thumb_frame_offset.mp[0].offset;
869 cbcr_off = dim->thumb_frame_offset.mp[1].offset;
870 ALOGV("%s: thumbnail: rotation = %d, yoff = %d, cbcroff = %d, size = %d, width = %d, height = %d",
871 __func__, dim->rotation, y_off, cbcr_off, frame_len,
872 dim->thumbnail_width, dim->thumbnail_height);
873
874 if (mHalCamCtrl->initHeapMem(&mHalCamCtrl->mThumbnailMemory, num_of_buf,
875 frame_len, y_off, cbcr_off, MSM_PMEM_THUMBNAIL, &mPostviewStreamBuf,
876 ®_buf.snapshot.thumbnail, num_planes, planes) < 0) {
877 ret = NO_MEMORY;
878 mHalCamCtrl->releaseHeapMem(&mHalCamCtrl->mSnapshotMemory);
879 mHalCamCtrl->releaseHeapMem(&mHalCamCtrl->mJpegMemory);
880 goto end;
881 }
882 }
883 /* register the streaming buffers for the channel*/
884 reg_buf.ch_type = MM_CAMERA_CH_SNAPSHOT;
885 reg_buf.snapshot.main.num = mSnapshotStreamBuf.num;
886
887 if (!isFullSizeLiveshot())
888 reg_buf.snapshot.thumbnail.num = mPostviewStreamBuf.num;
889 else
890 reg_buf.snapshot.thumbnail.num = 0;
891
892 ret = cam_config_prepare_buf(mCameraId, ®_buf);
893 if(ret != NO_ERROR) {
894 ALOGE("%s:reg snapshot buf err=%d\n", __func__, ret);
895 ret = FAILED_TRANSACTION;
896 if (!isFullSizeLiveshot()){
897 mHalCamCtrl->releaseHeapMem(&mHalCamCtrl->mThumbnailMemory);
898 }
899 mHalCamCtrl->releaseHeapMem(&mHalCamCtrl->mSnapshotMemory);
900 mHalCamCtrl->releaseHeapMem(&mHalCamCtrl->mJpegMemory);
901 goto end;
902 }
903 }
904
905 /* If we have reached here successfully, we have allocated buffer.
906 Set state machine.*/
907 setSnapshotState(SNAPSHOT_STATE_BUF_INITIALIZED);
908 end:
909 if (ret != NO_ERROR) {
910 handleError();
911 }
912 if (reg_buf.snapshot.main.buf.mp)
913 delete []reg_buf.snapshot.main.buf.mp;
914 if (reg_buf.snapshot.thumbnail.buf.mp)
915 delete []reg_buf.snapshot.thumbnail.buf.mp;
916 ALOGV("%s: X", __func__);
917 return ret;
918 }
919
920 status_t QCameraStream_Snapshot::
deinitSnapshotBuffers(void)921 deinitSnapshotBuffers(void)
922 {
923 int ret = NO_ERROR;
924 ALOGV("%s: E", __func__);
925
926 int err = getSnapshotState();
927 /* Deinit only if we have already initialized*/
928 if (err >= SNAPSHOT_STATE_BUF_INITIALIZED || err == SNAPSHOT_STATE_ERROR){
929
930 if(!isLiveSnapshot()) {
931 ALOGV("%s: Unpreparing Snapshot Buffer", __func__);
932 ret = cam_config_unprepare_buf(mCameraId, MM_CAMERA_CH_SNAPSHOT);
933 if(ret != NO_ERROR) {
934 ALOGE("%s:unreg snapshot buf err=%d\n", __func__, ret);
935 ret = FAILED_TRANSACTION;
936 goto end;
937 }
938 }
939
940 /* Clear main and thumbnail heap*/
941 if(!isLiveSnapshot()) {
942 mHalCamCtrl->releaseHeapMem(&mHalCamCtrl->mSnapshotMemory);
943 if (!isFullSizeLiveshot())
944 mHalCamCtrl->releaseHeapMem(&mHalCamCtrl->mThumbnailMemory);
945 }
946 mHalCamCtrl->releaseHeapMem(&mHalCamCtrl->mJpegMemory);
947 }
948 end:
949 ALOGV("%s: X", __func__);
950 return ret;
951 }
952
deInitBuffer(void)953 void QCameraStream_Snapshot::deInitBuffer(void)
954 {
955 mm_camera_channel_type_t ch_type;
956
957 ALOGV("%s: E", __func__);
958
959 if( getSnapshotState() == SNAPSHOT_STATE_UNINIT) {
960 ALOGV("%s: Already deinit'd!", __func__);
961 return;
962 }
963
964 if (mSnapshotFormat == PICTURE_FORMAT_RAW) {
965 /* deinit buffer */
966 deinitRawSnapshotBuffers();
967 }
968 else
969 {
970 if ((!isZSLMode() && !isLiveSnapshot()) &&
971 ((mHalCamCtrl->getHDRMode() == HDR_MODE) || (mHalCamCtrl->isWDenoiseEnabled()))) {
972 /*register main and thumbnail buffers at back-end for frameproc*/
973 for (int i = 0; i < mHalCamCtrl->mSnapshotMemory.buffer_count; i++) {
974 if (NO_ERROR != mHalCamCtrl->sendUnMappingBuf(MSM_V4L2_EXT_CAPTURE_MODE_MAIN, i, mCameraId,
975 CAM_SOCK_MSG_TYPE_FD_UNMAPPING)) {
976 ALOGE("%s: unmapping Main image Buffer for HDR and Denoise", __func__);
977 }
978 if (NO_ERROR != mHalCamCtrl->sendUnMappingBuf(MSM_V4L2_EXT_CAPTURE_MODE_THUMBNAIL, i, mCameraId,
979 CAM_SOCK_MSG_TYPE_FD_UNMAPPING)) {
980 ALOGE("%s: unmapping Thumbnail buffer for HDR and Denoise", __func__);
981 }
982 }
983 }
984 if (isZSLMode()) {
985 /*register main and thumbnail buffers at back-end for frameproc*/
986 for (int i = 0; i < mHalCamCtrl->mSnapshotMemory.buffer_count; i++) {
987 if (NO_ERROR != mHalCamCtrl->sendUnMappingBuf(MSM_V4L2_EXT_CAPTURE_MODE_MAIN, i, mCameraId,
988 CAM_SOCK_MSG_TYPE_FD_UNMAPPING)) {
989 ALOGE("%s: unmapping Main image Buffer for ZSL", __func__);
990 }
991 }
992 }
993
994 deinitSnapshotBuffers();
995 }
996
997
998 /* deinit jpeg buffer if allocated */
999 if(mJpegHeap != NULL) mJpegHeap.clear();
1000 mJpegHeap = NULL;
1001
1002 /* memset some global structure */
1003 memset(&mSnapshotStreamBuf, 0, sizeof(mSnapshotStreamBuf));
1004 memset(&mPostviewStreamBuf, 0, sizeof(mPostviewStreamBuf));
1005 mSnapshotQueue.flush();
1006 mWDNQueue.flush();
1007
1008 setSnapshotState(SNAPSHOT_STATE_UNINIT);
1009
1010 ALOGV("%s: X", __func__);
1011 }
1012
1013 /*Temp: to be removed once event handling is enabled in mm-camera.
1014 We need an event - one event for
1015 stream-off to disable OPS_SNAPSHOT*/
runSnapshotThread(void * data)1016 void QCameraStream_Snapshot::runSnapshotThread(void *data)
1017 {
1018 ALOGV("%s: E", __func__);
1019
1020 if (mSnapshotFormat == PICTURE_FORMAT_RAW) {
1021 /* TBD: Temp: Needs to be removed once event handling is enabled.
1022 We cannot call mm-camera interface to stop snapshot from callback
1023 function as it causes deadlock. Hence handling it here temporarily
1024 in this thread. Later mm-camera intf will give us event in separate
1025 thread context */
1026 mm_app_snapshot_wait();
1027 /* Send command to stop snapshot polling thread*/
1028 stop();
1029 }
1030 ALOGV("%s: X", __func__);
1031 }
1032
1033 /*Temp: to be removed once event handling is enabled in mm-camera*/
snapshot_thread(void * obj)1034 static void *snapshot_thread(void *obj)
1035 {
1036 QCameraStream_Snapshot *pme = (QCameraStream_Snapshot *)obj;
1037 ALOGV("%s: E", __func__);
1038 if (pme != 0) {
1039 pme->runSnapshotThread(obj);
1040 }
1041 else ALOGW("not starting snapshot thread: the object went away!");
1042 ALOGV("%s: X", __func__);
1043 return NULL;
1044 }
1045
1046 /*Temp: to be removed later*/
1047 static pthread_t mSnapshotThread;
1048
initJPEGSnapshot(int num_of_snapshots)1049 status_t QCameraStream_Snapshot::initJPEGSnapshot(int num_of_snapshots)
1050 {
1051 status_t ret = NO_ERROR;
1052 cam_ctrl_dimension_t dim;
1053 mm_camera_op_mode_type_t op_mode;
1054
1055 ALOGV("%s: E", __func__);
1056
1057 if (isFullSizeLiveshot())
1058 goto end;
1059
1060 ALOGV("%s: Get current dimension", __func__);
1061 /* Query mm_camera to get current dimension */
1062 memset(&dim, 0, sizeof(cam_ctrl_dimension_t));
1063 ret = cam_config_get_parm(mCameraId,
1064 MM_CAMERA_PARM_DIMENSION, &dim);
1065 if (NO_ERROR != ret) {
1066 ALOGE("%s: error - can't get preview dimension!", __func__);
1067 ret = FAILED_TRANSACTION;
1068 goto end;
1069 }
1070
1071 /* Set camera op mode to MM_CAMERA_OP_MODE_CAPTURE */
1072 ALOGV("Setting OP_MODE_CAPTURE");
1073 op_mode = MM_CAMERA_OP_MODE_CAPTURE;
1074 if( NO_ERROR != cam_config_set_parm(mCameraId,
1075 MM_CAMERA_PARM_OP_MODE, &op_mode)) {
1076 ALOGE("%s: MM_CAMERA_OP_MODE_CAPTURE failed", __func__);
1077 ret = FAILED_TRANSACTION;
1078 goto end;
1079 }
1080
1081 /* config the parmeters and see if we need to re-init the stream*/
1082 ALOGV("%s: Configure Snapshot Dimension", __func__);
1083 ret = configSnapshotDimension(&dim);
1084 if (ret != NO_ERROR) {
1085 ALOGE("%s: Setting snapshot dimension failed", __func__);
1086 goto end;
1087 }
1088
1089 /* Initialize stream - set format, acquire channel */
1090 ret = initSnapshotFormat(&dim);
1091 if (NO_ERROR != ret) {
1092 ALOGE("%s: error - can't init nonZSL stream!", __func__);
1093 goto end;
1094 }
1095
1096 ret = initSnapshotBuffers(&dim, num_of_snapshots);
1097 if ( NO_ERROR != ret ){
1098 ALOGE("%s: Failure allocating memory for Snapshot buffers", __func__);
1099 goto end;
1100 }
1101
1102 {
1103 /*register main and thumbnail buffers at back-end for frameproc*/
1104 for (int i = 0; i < num_of_snapshots; i++) {
1105 if (NO_ERROR != mHalCamCtrl->sendMappingBuf(MSM_V4L2_EXT_CAPTURE_MODE_MAIN, i,
1106 mSnapshotStreamBuf.frame[i].fd, mHalCamCtrl->mSnapshotMemory.size, mCameraId,
1107 CAM_SOCK_MSG_TYPE_FD_MAPPING)) {
1108 ALOGE("%s: sending mapping data Msg Failed", __func__);
1109 }
1110 if (NO_ERROR != mHalCamCtrl->sendMappingBuf(MSM_V4L2_EXT_CAPTURE_MODE_THUMBNAIL, i,
1111 mPostviewStreamBuf.frame[i].fd, mHalCamCtrl->mThumbnailMemory.size, mCameraId,
1112 CAM_SOCK_MSG_TYPE_FD_MAPPING)) {
1113 ALOGE("%s: sending mapping data Msg Failed", __func__);
1114 }
1115 }
1116 }
1117
1118 end:
1119 /* Based on what state we are in, we'll need to handle error -
1120 like deallocating memory if we have already allocated */
1121 if (ret != NO_ERROR) {
1122 handleError();
1123 }
1124 ALOGV("%s: X", __func__);
1125 return ret;
1126
1127 }
1128
initRawSnapshot(int num_of_snapshots)1129 status_t QCameraStream_Snapshot::initRawSnapshot(int num_of_snapshots)
1130 {
1131 status_t ret = NO_ERROR;
1132 cam_ctrl_dimension_t dim;
1133 bool initSnapshot = false;
1134 mm_camera_op_mode_type_t op_mode;
1135
1136 ALOGV("%s: E", __func__);
1137
1138 /* Set camera op mode to MM_CAMERA_OP_MODE_CAPTURE */
1139 ALOGV("%s: Setting OP_MODE_CAPTURE", __func__);
1140 op_mode = MM_CAMERA_OP_MODE_CAPTURE;
1141 if( NO_ERROR != cam_config_set_parm(mCameraId,
1142 MM_CAMERA_PARM_OP_MODE, &op_mode)) {
1143 ALOGE("%s: MM_CAMERA_OP_MODE_CAPTURE failed", __func__);
1144 ret = FAILED_TRANSACTION;
1145 goto end;
1146 }
1147
1148 /* For raw snapshot, we do not know the dimension as it
1149 depends on sensor to sensor. We call getDimension which will
1150 give us raw width and height */
1151 memset(&dim, 0, sizeof(cam_ctrl_dimension_t));
1152 ret = cam_config_get_parm(mCameraId, MM_CAMERA_PARM_DIMENSION, &dim);
1153 if (MM_CAMERA_OK != ret) {
1154 ALOGE("%s: error - can't get dimension!", __func__);
1155 ALOGV("%s: X", __func__);
1156 goto end;
1157 }
1158 ALOGV("%s: Raw Snapshot dimension: %dx%d", __func__,
1159 dim.raw_picture_width,
1160 dim.raw_picture_height);
1161
1162
1163 ret = initRawSnapshotChannel(&dim, num_of_snapshots);
1164 if (NO_ERROR != ret) {
1165 ALOGE("%s: error - can't init nonZSL stream!", __func__);
1166 goto end;
1167 }
1168
1169 ret = initRawSnapshotBuffers(&dim, num_of_snapshots);
1170 if ( NO_ERROR != ret ){
1171 ALOGE("%s: Failure allocating memory for Raw Snapshot buffers",
1172 __func__);
1173 goto end;
1174 }
1175 setSnapshotState(SNAPSHOT_STATE_INITIALIZED);
1176
1177 end:
1178 if (ret != NO_ERROR) {
1179 handleError();
1180 }
1181 ALOGV("%s: X", __func__);
1182 return ret;
1183 }
1184
initFullLiveshot(void)1185 status_t QCameraStream_Snapshot::initFullLiveshot(void)
1186 {
1187 status_t ret = NO_ERROR;
1188 cam_ctrl_dimension_t dim;
1189 bool matching = true;
1190
1191 memset(&dim, 0, sizeof(cam_ctrl_dimension_t));
1192 ret = cam_config_get_parm(mCameraId, MM_CAMERA_PARM_DIMENSION, &dim);
1193 if (MM_CAMERA_OK != ret) {
1194 ALOGE("%s: error - can't get dimension!", __func__);
1195 return ret;
1196 }
1197 #if 1
1198 /* First check if the picture resolution is the same, if not, change it*/
1199 mHalCamCtrl->getPictureSize(&mPictureWidth, &mPictureHeight);
1200 ALOGV("%s: Picture size received: %d x %d", __func__,
1201 mPictureWidth, mPictureHeight);
1202
1203 //Use main image as input to encoder to generate thumbnail
1204 mThumbnailWidth = dim.picture_width;
1205 mThumbnailHeight = dim.picture_height;
1206 matching = (mPictureWidth == dim.picture_width) &&
1207 (mPictureHeight == dim.picture_height);
1208
1209 //Actual thumbnail size requested
1210 mPostviewWidth = mHalCamCtrl->mParameters.getInt(QCameraParameters::KEY_JPEG_THUMBNAIL_WIDTH);
1211 mPostviewHeight = mHalCamCtrl->mParameters.getInt(QCameraParameters::KEY_JPEG_THUMBNAIL_HEIGHT);
1212
1213 mDropThumbnail = false;
1214 if (mPostviewWidth == 0 && mPostviewHeight == 0) {
1215 mPostviewWidth = THUMBNAIL_DEFAULT_WIDTH;
1216 mPostviewHeight = THUMBNAIL_DEFAULT_HEIGHT;
1217 mDropThumbnail = true;
1218 }
1219
1220 if (!matching) {
1221 dim.picture_width = mPictureWidth;
1222 dim.picture_height = mPictureHeight;
1223 dim.ui_thumbnail_height = mThumbnailHeight;
1224 dim.ui_thumbnail_width = mThumbnailWidth;
1225 }
1226 ALOGV("%s: Picture size to set: %d x %d", __func__,
1227 dim.picture_width, dim.picture_height);
1228 ret = cam_config_set_parm(mCameraId, MM_CAMERA_PARM_DIMENSION,&dim);
1229 #endif
1230 /* Initialize stream - set format, acquire channel */
1231 ret = initSnapshotFormat(&dim);
1232 if (NO_ERROR != ret) {
1233 ALOGE("%s: error - can't init nonZSL stream!", __func__);
1234 return ret;
1235 }
1236 ret = initSnapshotBuffers(&dim, 1);
1237 if ( NO_ERROR != ret ){
1238 ALOGE("%s: Failure allocating memory for Snapshot buffers", __func__);
1239 return ret;
1240 }
1241
1242 return ret;
1243 }
1244
initZSLSnapshot(void)1245 status_t QCameraStream_Snapshot::initZSLSnapshot(void)
1246 {
1247 status_t ret = NO_ERROR;
1248 cam_ctrl_dimension_t dim;
1249 mm_camera_op_mode_type_t op_mode;
1250
1251 ALOGV("%s: E", __func__);
1252
1253 ALOGV("%s: Get current dimension", __func__);
1254 /* Query mm_camera to get current dimension */
1255 memset(&dim, 0, sizeof(cam_ctrl_dimension_t));
1256 ret = cam_config_get_parm(mCameraId,
1257 MM_CAMERA_PARM_DIMENSION, &dim);
1258 if (NO_ERROR != ret) {
1259 ALOGE("%s: error - can't get preview dimension!", __func__);
1260 ret = FAILED_TRANSACTION;
1261 goto end;
1262 }
1263
1264 /* config the parmeters and see if we need to re-init the stream*/
1265 ALOGV("%s: Configure Snapshot Dimension", __func__);
1266 ret = configSnapshotDimension(&dim);
1267 if (ret != NO_ERROR) {
1268 ALOGE("%s: Setting snapshot dimension failed", __func__);
1269 goto end;
1270 }
1271
1272 /* Initialize stream - set format, acquire channel */
1273 ret = initSnapshotFormat(&dim);
1274 if (NO_ERROR != ret) {
1275 ALOGE("%s: error - can't init nonZSL stream!", __func__);
1276 goto end;
1277 }
1278
1279 /* For ZSL we'll have to allocate buffers for internal queue
1280 maintained by mm-camera lib plus around 3 buffers used for
1281 data handling by lower layer.*/
1282
1283 ret = initSnapshotBuffers(&dim, mHalCamCtrl->getZSLQueueDepth() + 3);
1284 if ( NO_ERROR != ret ){
1285 ALOGE("%s: Failure allocating memory for Snapshot buffers", __func__);
1286 goto end;
1287 }
1288 /*register main and thumbnail buffers at back-end for frameproc*/
1289 for (int i = 0; i < mHalCamCtrl->getZSLQueueDepth() + 3; i++) {
1290 if (NO_ERROR != mHalCamCtrl->sendMappingBuf(MSM_V4L2_EXT_CAPTURE_MODE_MAIN, i,
1291 mSnapshotStreamBuf.frame[i].fd, mHalCamCtrl->mSnapshotMemory.size, mCameraId,
1292 CAM_SOCK_MSG_TYPE_FD_MAPPING)) {
1293 ALOGE("%s: sending mapping data Msg Failed", __func__);
1294 }
1295 }
1296
1297 end:
1298 /* Based on what state we are in, we'll need to handle error -
1299 like deallocating memory if we have already allocated */
1300 if (ret != NO_ERROR) {
1301 handleError();
1302 }
1303 ALOGV("%s: X", __func__);
1304 return ret;
1305
1306 }
1307
1308 status_t QCameraStream_Snapshot::
takePictureJPEG(void)1309 takePictureJPEG(void)
1310 {
1311 status_t ret = NO_ERROR;
1312
1313 ALOGV("%s: E", __func__);
1314
1315 if (mHalCamCtrl->mHdrMode == HDR_MODE) {
1316 hdrRawCount = 0;
1317 hdrJpegCount = 0;
1318 }
1319 /* Take snapshot */
1320 ALOGV("%s: Call MM_CAMERA_OPS_SNAPSHOT", __func__);
1321 if (NO_ERROR != cam_ops_action(mCameraId,
1322 true,
1323 MM_CAMERA_OPS_SNAPSHOT,
1324 this)) {
1325 ALOGE("%s: Failure taking snapshot", __func__);
1326 ret = FAILED_TRANSACTION;
1327 goto end;
1328 }
1329
1330 /* TBD: Temp: to be removed once event callback
1331 is implemented in mm-camera lib */
1332 pthread_attr_t attr;
1333 pthread_attr_init(&attr);
1334 pthread_attr_setdetachstate(&attr, PTHREAD_CREATE_DETACHED);
1335 pthread_create(&mSnapshotThread,&attr,
1336 snapshot_thread, (void *)this);
1337
1338 end:
1339 if (ret != NO_ERROR) {
1340 handleError();
1341 }
1342
1343 ALOGV("%s: X", __func__);
1344 return ret;
1345
1346 }
1347
1348 status_t QCameraStream_Snapshot::
takePictureRaw(void)1349 takePictureRaw(void)
1350 {
1351 status_t ret = NO_ERROR;
1352
1353 ALOGV("%s: E", __func__);
1354
1355 /* Take snapshot */
1356 ALOGV("%s: Call MM_CAMERA_OPS_SNAPSHOT", __func__);
1357 if (NO_ERROR != cam_ops_action(mCameraId,
1358 true,
1359 MM_CAMERA_OPS_RAW,
1360 this)) {
1361 ALOGE("%s: Failure taking snapshot", __func__);
1362 ret = FAILED_TRANSACTION;
1363 goto end;
1364 }
1365
1366 /* TBD: Temp: to be removed once event callback
1367 is implemented in mm-camera lib */
1368 /* Wait for snapshot frame callback to return*/
1369 pthread_attr_t attr;
1370 pthread_attr_init(&attr);
1371 pthread_attr_setdetachstate(&attr, PTHREAD_CREATE_DETACHED);
1372 pthread_create(&mSnapshotThread,&attr,
1373 snapshot_thread, (void *)this);
1374
1375 end:
1376 if (ret != NO_ERROR) {
1377 handleError();
1378 }
1379 ALOGV("%s: X", __func__);
1380 return ret;
1381
1382 }
1383
1384 status_t QCameraStream_Snapshot::
takePictureLiveshot(mm_camera_ch_data_buf_t * recvd_frame)1385 takePictureLiveshot(mm_camera_ch_data_buf_t* recvd_frame)
1386 {
1387 status_t ret = NO_ERROR;
1388 int mJpegMaxSize;
1389 int mNuberOfVFEOutputs = 0;
1390 common_crop_t crop_info;
1391 camera_notify_callback notifyCb;
1392 camera_data_callback dataCb;
1393 cam_ctrl_dimension_t dim;
1394
1395 mStopCallbackLock.lock();
1396 if (!mHalCamCtrl->mStateLiveshot) {
1397 ALOGE("%s: Picture Cancelled", __func__);
1398 mStopCallbackLock.unlock();
1399 return FAILED_TRANSACTION;
1400 }
1401
1402 ret = cam_config_get_parm(mHalCamCtrl->mCameraId,MM_CAMERA_PARM_VFE_OUTPUT_ENABLE,
1403 &mNuberOfVFEOutputs);
1404 if (ret != MM_CAMERA_OK) {
1405 ALOGE("get parm MM_CAMERA_PARM_VFE_OUTPUT_ENABLE failed");
1406 cam_evt_buf_done(mHalCamCtrl->mCameraId, recvd_frame);
1407 mStopCallbackLock.unlock();
1408 return FAILED_TRANSACTION;
1409 }
1410
1411 mm_camera_ch_data_buf_t* frame =
1412 (mm_camera_ch_data_buf_t *)malloc(sizeof(mm_camera_ch_data_buf_t));
1413 if (frame == NULL) {
1414 ALOGE("%s: Error allocating memory to save received_frame structure.", __func__);
1415 cam_evt_buf_done(mHalCamCtrl->mCameraId, recvd_frame);
1416 mStopCallbackLock.unlock();
1417 return FAILED_TRANSACTION;
1418 }
1419 memcpy(frame, recvd_frame, sizeof(mm_camera_ch_data_buf_t));
1420
1421 if (mNuberOfVFEOutputs == 1){
1422 ALOGV("<DEBUG> Liveshot buffer idx:%d",frame->def.idx);
1423 frame->snapshot.main.frame = frame->def.frame;
1424 frame->snapshot.main.idx = frame->def.idx;
1425 frame->snapshot.thumbnail.frame = frame->def.frame;
1426 frame->snapshot.thumbnail.idx = frame->def.idx;
1427 } else {
1428 ALOGV("<DEBUG> Liveshot buffer idx:%d",frame->video.video.idx);
1429 frame->snapshot.main.frame = frame->video.video.frame;
1430 frame->snapshot.main.idx = frame->video.video.idx;
1431 frame->snapshot.thumbnail.frame = frame->video.video.frame;
1432 frame->snapshot.thumbnail.idx = frame->video.video.idx;
1433 }
1434
1435 memset(&dim, 0, sizeof(cam_ctrl_dimension_t));
1436 ret = cam_config_get_parm(mHalCamCtrl->mCameraId, MM_CAMERA_PARM_DIMENSION, &dim);
1437 if (MM_CAMERA_OK != ret) {
1438 ALOGE("%s: X error - can't get dimension!", __func__);
1439 cam_evt_buf_done(mHalCamCtrl->mCameraId, recvd_frame);
1440 setModeLiveSnapshot(false);
1441 mStopCallbackLock.unlock();
1442 return FAILED_TRANSACTION;
1443 }
1444 dim.picture_width = dim.video_width;
1445 dim.picture_height = dim.video_height;
1446 dim.ui_thumbnail_width = dim.video_width;
1447 dim.ui_thumbnail_height = dim.video_height;
1448
1449 if (mNuberOfVFEOutputs == 1){
1450 dim.main_img_format = dim.prev_format;
1451 dim.thumb_format = dim.prev_format;
1452 } else {
1453 dim.main_img_format = dim.enc_format;
1454 dim.thumb_format = dim.enc_format;
1455 }
1456 initSnapshotBuffers(&dim,1);
1457
1458 /* set flag to indicate we are doing livesnapshot */
1459 resetSnapshotCounters( );
1460 setModeLiveSnapshot(true);
1461
1462 mStopCallbackLock.unlock();
1463 if (mHalCamCtrl->mStateLiveshot) {
1464 if(!mHalCamCtrl->mShutterSoundPlayed) {
1465 notifyShutter(&crop_info, true);
1466 }
1467 notifyShutter(&crop_info, false);
1468 mHalCamCtrl->mShutterSoundPlayed = false;
1469 }
1470 mStopCallbackLock.lock();
1471
1472 // send upperlayer callback for raw image (data or notify, not both)
1473 if((mHalCamCtrl->mDataCb) && (mHalCamCtrl->mMsgEnabled & CAMERA_MSG_RAW_IMAGE)){
1474 dataCb = mHalCamCtrl->mDataCb;
1475 } else {
1476 dataCb = NULL;
1477 }
1478 if((mHalCamCtrl->mNotifyCb) && (mHalCamCtrl->mMsgEnabled & CAMERA_MSG_RAW_IMAGE_NOTIFY)){
1479 notifyCb = mHalCamCtrl->mNotifyCb;
1480 } else {
1481 notifyCb = NULL;
1482 }
1483
1484 mPictureWidth = dim.picture_width;
1485 mPictureHeight = dim.picture_height;
1486 mThumbnailWidth = dim.ui_thumbnail_width;
1487 mThumbnailHeight = dim.ui_thumbnail_height;
1488 mPictureFormat = dim.main_img_format;
1489 mThumbnailFormat = dim.thumb_format;
1490
1491 mJpegMaxSize = mPictureWidth * mPictureHeight * 1.5;
1492
1493 ALOGV("Liveshot res = %d X %d, Thumabnail = %d % %d",
1494 mPictureWidth,mPictureHeight,mThumbnailWidth,mThumbnailHeight);
1495
1496 memset(&crop_info, 0, sizeof(common_crop_t));
1497 crop_info.in1_w = mPictureWidth;
1498 crop_info.in1_h = mPictureHeight;
1499 /* For low power live snapshot the thumbnail output size is set to default size.
1500 In case of live snapshot video buffer = thumbnail buffer. For higher resolutions
1501 the thumnail will be dropped if its more than 64KB. To avoid thumbnail drop
1502 set thumbnail as configured by application. This will be a size lower than video size*/
1503 mDropThumbnail = false;
1504 if(mHalCamCtrl->thumbnailWidth == 0 && mHalCamCtrl->thumbnailHeight == 0) {
1505 ALOGE("Live Snapshot thumbnail will be dropped as indicated by application");
1506 mDropThumbnail = true;
1507 }
1508 crop_info.out1_w = mHalCamCtrl->thumbnailWidth;
1509 crop_info.out1_h = mHalCamCtrl->thumbnailHeight;
1510 ret = encodeData(frame, &crop_info, mJpegMaxSize, 0);
1511 if (ret != NO_ERROR) {
1512 ALOGE("%s: Failure configuring JPEG encoder", __func__);
1513 setModeLiveSnapshot(false);
1514 mStopCallbackLock.unlock();
1515 ret = FAILED_TRANSACTION;
1516 goto end;
1517 }
1518 mStopCallbackLock.unlock();
1519 if (dataCb && mHalCamCtrl->mStateLiveshot) {
1520 dataCb(CAMERA_MSG_RAW_IMAGE, mHalCamCtrl->mRecordingMemory.camera_memory[frame->video.video.idx],
1521 1, NULL, mHalCamCtrl->mCallbackCookie);
1522 }
1523 if (notifyCb && mHalCamCtrl->mStateLiveshot) {
1524 notifyCb(CAMERA_MSG_RAW_IMAGE_NOTIFY, 0, 0, mHalCamCtrl->mCallbackCookie);
1525 }
1526 end:
1527 ALOGV("%s: X", __func__);
1528 return ret;
1529 }
1530
1531 status_t QCameraStream_Snapshot::
takePictureZSL(void)1532 takePictureZSL(void)
1533 {
1534 status_t ret = NO_ERROR;
1535 mm_camera_ops_parm_get_buffered_frame_t param;
1536
1537 ALOGV("%s: E", __func__);
1538
1539 memset(¶m, 0, sizeof(param));
1540 param.ch_type = MM_CAMERA_CH_SNAPSHOT;
1541
1542 /* Take snapshot */
1543 ALOGV("%s: Call MM_CAMERA_OPS_GET_BUFFERED_FRAME", __func__);
1544
1545 mNumOfSnapshot = mHalCamCtrl->getNumOfSnapshots();
1546 // it's just for stabilization for dequeuing zsl buffer frame
1547 // 13.2 ~ 22.4fps
1548 usleep(80000);
1549 if (NO_ERROR != cam_ops_action(mCameraId,
1550 true,
1551 MM_CAMERA_OPS_GET_BUFFERED_FRAME,
1552 ¶m)) {
1553 ALOGE("%s: Failure getting zsl frame(s)", __func__);
1554 ret = FAILED_TRANSACTION;
1555 goto end;
1556 }
1557
1558 /* TBD: Temp: to be removed once event callback
1559 is implemented in mm-camera lib */
1560 /* pthread_attr_t attr;
1561 pthread_attr_init(&attr);
1562 pthread_attr_setdetachstate(&attr, PTHREAD_CREATE_DETACHED);
1563 pthread_create(&mSnapshotThread,&attr,
1564 snapshot_thread, (void *)this);
1565 */
1566 end:
1567 ALOGV("%s: X", __func__);
1568 return ret;
1569 }
1570
1571 status_t QCameraStream_Snapshot::
startStreamZSL(void)1572 startStreamZSL(void)
1573 {
1574 status_t ret = NO_ERROR;
1575
1576 ALOGV("%s: E", __func__);
1577
1578 /* Start ZSL - it'll start queuing the frames */
1579 ALOGV("%s: Call MM_CAMERA_OPS_ZSL", __func__);
1580 if (NO_ERROR != cam_ops_action(mCameraId,
1581 true,
1582 MM_CAMERA_OPS_ZSL,
1583 this)) {
1584 ALOGE("%s: Failure starting ZSL stream", __func__);
1585 ret = FAILED_TRANSACTION;
1586 goto end;
1587 }
1588
1589 end:
1590 ALOGV("%s: X", __func__);
1591 return ret;
1592
1593 }
1594
1595 status_t QCameraStream_Snapshot::
encodeData(mm_camera_ch_data_buf_t * recvd_frame,common_crop_t * crop_info,int frame_len,bool enqueued)1596 encodeData(mm_camera_ch_data_buf_t* recvd_frame,
1597 common_crop_t *crop_info,
1598 int frame_len,
1599 bool enqueued)
1600 {
1601 status_t ret = NO_ERROR;
1602 cam_ctrl_dimension_t dimension;
1603 struct msm_frame *postviewframe;
1604 struct msm_frame *mainframe;
1605 common_crop_t crop;
1606 cam_point_t main_crop_offset;
1607 cam_point_t thumb_crop_offset;
1608 int width, height;
1609 uint8_t *thumbnail_buf;
1610 uint32_t thumbnail_fd;
1611 uint8_t hw_encode = true;
1612 int mNuberOfVFEOutputs = 0;
1613
1614 omx_jpeg_encode_params encode_params;
1615
1616 /* If it's the only frame, we directly pass to encoder.
1617 If not, we'll queue it and check during next jpeg .
1618 Also, if the queue isn't empty then we need to queue this
1619 one too till its turn comes (only if it's not already
1620 queued up there)*/
1621 ALOGV("%s: getSnapshotState()=%d, enqueued =%d, Q empty=%d", __func__, getSnapshotState(), enqueued, mSnapshotQueue.isEmpty());
1622 ALOGV("%s: mNumOfRecievedJPEG=%d, mNumOfSnapshot =%d", __func__, mNumOfRecievedJPEG, mNumOfSnapshot);
1623 if(mHalCamCtrl->thumbnailWidth == 0 || mHalCamCtrl->thumbnailHeight == 0) {
1624 ALOGV("Snapshot thumbnail will be dropped as indicated by application");
1625 mDropThumbnail = true;
1626 }
1627 if((getSnapshotState() == SNAPSHOT_STATE_JPEG_ENCODING) ||
1628 (!mSnapshotQueue.isEmpty() && !enqueued)){ /*busy and new buffer*/
1629 /* encoding is going on. Just queue the frame for now.*/
1630 ALOGV("%s: JPEG encoding in progress."
1631 "Enqueuing frame id(%d) for later processing.", __func__,
1632 recvd_frame->snapshot.main.idx);
1633 mSnapshotQueue.enqueue((void *)recvd_frame);
1634 } else if (enqueued ||
1635 (mNumOfRecievedJPEG != mNumOfSnapshot && mNumOfRecievedJPEG != 0)) { /*not busy, not first*/
1636 ALOGV("%s: JPG not busy, not first frame.", __func__);
1637
1638 // For full-size live shot, use mainimage to generate thumbnail
1639 if (isFullSizeLiveshot()) {
1640 postviewframe = recvd_frame->snapshot.main.frame;
1641 } else {
1642 postviewframe = recvd_frame->snapshot.thumbnail.frame;
1643 }
1644 mainframe = recvd_frame->snapshot.main.frame;
1645 cam_config_get_parm(mHalCamCtrl->mCameraId, MM_CAMERA_PARM_DIMENSION, &dimension);
1646 ALOGV("%s: main_fmt =%d, tb_fmt =%d", __func__, dimension.main_img_format, dimension.thumb_format);
1647 /*since this is the continue job, we only care about the input buffer*/
1648 encode_params.thumbnail_buf = (uint8_t *)postviewframe->buffer;
1649 encode_params.thumbnail_fd = postviewframe->fd;
1650 encode_params.snapshot_buf = (uint8_t *)mainframe->buffer;
1651 encode_params.snapshot_fd = mainframe->fd;
1652 encode_params.dimension = &dimension;
1653 /*update exif parameters in HAL*/
1654 mHalCamCtrl->setExifTags();
1655
1656 encode_params.exif_data = mHalCamCtrl->getExifData();
1657 encode_params.exif_numEntries = mHalCamCtrl->getExifTableNumEntries();
1658 if (!omxJpegEncodeNext(&encode_params)){
1659 ALOGE("%s: Failure! JPEG encoder returned error.", __func__);
1660 ret = FAILED_TRANSACTION;
1661 goto end;
1662 }
1663 /* Save the pointer to the frame sent for encoding. we'll need it to
1664 tell kernel that we are done with the frame.*/
1665 mCurrentFrameEncoded = recvd_frame;
1666 setSnapshotState(SNAPSHOT_STATE_JPEG_ENCODING);
1667 } else { /*not busy and new buffer (first job)*/
1668
1669 ALOGV("%s: JPG Idle and first frame.", __func__);
1670
1671 // For full-size live shot, use mainimage to generate thumbnail
1672 if (isFullSizeLiveshot()){
1673 postviewframe = recvd_frame->snapshot.main.frame;
1674 } else {
1675 postviewframe = recvd_frame->snapshot.thumbnail.frame;
1676 }
1677 mainframe = recvd_frame->snapshot.main.frame;
1678 cam_config_get_parm(mHalCamCtrl->mCameraId, MM_CAMERA_PARM_DIMENSION, &dimension);
1679 ALOGV("%s: main_fmt =%d, tb_fmt =%d", __func__, dimension.main_img_format, dimension.thumb_format);
1680
1681 dimension.orig_picture_dx = mPictureWidth;
1682 dimension.orig_picture_dy = mPictureHeight;
1683
1684 if(!mDropThumbnail) {
1685 if(isZSLMode()) {
1686 ALOGV("Setting input thumbnail size to previewWidth= %d previewheight= %d in ZSL mode",
1687 mHalCamCtrl->mPreviewWidth, mHalCamCtrl->mPreviewHeight);
1688 dimension.thumbnail_width = width = mHalCamCtrl->mPreviewWidth;
1689 dimension.thumbnail_height = height = mHalCamCtrl->mPreviewHeight;
1690 } else {
1691 dimension.thumbnail_width = width = mThumbnailWidth;
1692 dimension.thumbnail_height = height = mThumbnailHeight;
1693 }
1694 } else {
1695 dimension.thumbnail_width = width = 0;
1696 dimension.thumbnail_height = height = 0;
1697 }
1698 dimension.main_img_format = mPictureFormat;
1699 dimension.thumb_format = mThumbnailFormat;
1700
1701 /*TBD: Move JPEG handling to the mm-camera library */
1702 ALOGV("Setting callbacks, initializing encoder and start encoding.");
1703 ALOGV(" Passing my obj: %x", (unsigned int) this);
1704 set_callbacks(snapshot_jpeg_fragment_cb, snapshot_jpeg_cb, this,
1705 mHalCamCtrl->mJpegMemory.camera_memory[0]->data, &mJpegOffset);
1706
1707 if (isLiveSnapshot() || isFullSizeLiveshot()) {
1708 /* determine the target type */
1709 ret = cam_config_get_parm(mCameraId,MM_CAMERA_PARM_VFE_OUTPUT_ENABLE,
1710 &mNuberOfVFEOutputs);
1711 if (ret != MM_CAMERA_OK) {
1712 ALOGE("get parm MM_CAMERA_PARM_VFE_OUTPUT_ENABLE failed");
1713 ret = BAD_VALUE;
1714 }
1715 /* VFE 2x has hardware limitation:
1716 * It can't support concurrent
1717 * video encoding and jpeg encoding
1718 * So switch to software for liveshot
1719 */
1720 if (mNuberOfVFEOutputs == 1)
1721 hw_encode = false;
1722 }
1723 ALOGV("%s: hw_encode: %d\n",__func__, hw_encode);
1724
1725 if(omxJpegStart(hw_encode) != NO_ERROR){
1726 ALOGE("Error In omxJpegStart!!! Return");
1727 ret = FAILED_TRANSACTION;
1728 goto end;
1729 }
1730
1731 if (mHalCamCtrl->getJpegQuality())
1732 mm_jpeg_encoder_setMainImageQuality(mHalCamCtrl->getJpegQuality());
1733 else
1734 mm_jpeg_encoder_setMainImageQuality(85);
1735
1736 ALOGV("%s: Dimension to encode: main: %dx%d thumbnail: %dx%d", __func__,
1737 dimension.orig_picture_dx, dimension.orig_picture_dy,
1738 dimension.thumbnail_width, dimension.thumbnail_height);
1739
1740 /*TBD: Pass 0 as cropinfo for now as v4l2 doesn't provide
1741 cropinfo. It'll be changed later.*/
1742 memset(&crop,0,sizeof(common_crop_t));
1743 memset(&main_crop_offset,0,sizeof(cam_point_t));
1744 memset(&thumb_crop_offset,0,sizeof(cam_point_t));
1745
1746 /* Setting crop info */
1747
1748 /*Main image*/
1749 crop.in2_w=mCrop.snapshot.main_crop.width;// dimension.picture_width
1750 crop.in2_h=mCrop.snapshot.main_crop.height;// dimension.picture_height;
1751 if (!mJpegDownscaling) {
1752 crop.out2_w = mPictureWidth;
1753 crop.out2_h = mPictureHeight;
1754 } else {
1755 crop.out2_w = mActualPictureWidth;
1756 crop.out2_h = mActualPictureHeight;
1757 if (!crop.in2_w || !crop.in2_h) {
1758 crop.in2_w = mPictureWidth;
1759 crop.in2_h = mPictureHeight;
1760 }
1761 }
1762 main_crop_offset.x=mCrop.snapshot.main_crop.left;
1763 main_crop_offset.y=mCrop.snapshot.main_crop.top;
1764 /*Thumbnail image*/
1765 crop.in1_w=mCrop.snapshot.thumbnail_crop.width; //dimension.thumbnail_width;
1766 crop.in1_h=mCrop.snapshot.thumbnail_crop.height; // dimension.thumbnail_height;
1767 if(isLiveSnapshot() || isFullSizeLiveshot() || isZSLMode()) {
1768 crop.out1_w= mHalCamCtrl->thumbnailWidth;
1769 crop.out1_h= mHalCamCtrl->thumbnailHeight;
1770 ALOGV("Thumbnail width= %d height= %d for livesnapshot", crop.out1_w, crop.out1_h);
1771 } else {
1772 crop.out1_w = width;
1773 crop.out1_h = height;
1774 }
1775 thumb_crop_offset.x=mCrop.snapshot.thumbnail_crop.left;
1776 thumb_crop_offset.y=mCrop.snapshot.thumbnail_crop.top;
1777
1778 if (crop.out1_w > crop.out2_w || crop.out1_h > crop.out2_h) {
1779 crop.out1_w = crop.out2_w;
1780 crop.out1_h = crop.out2_h;
1781 }
1782 //update exif parameters in HAL
1783 mHalCamCtrl->initExifData();
1784
1785 /*Fill in the encode parameters*/
1786 encode_params.dimension = (const cam_ctrl_dimension_t *)&dimension;
1787 //if (!isFullSizeLiveshot()) {
1788 encode_params.thumbnail_buf = (uint8_t *)postviewframe->buffer;
1789 encode_params.thumbnail_fd = postviewframe->fd;
1790 encode_params.thumbnail_offset = postviewframe->phy_offset;
1791 encode_params.thumb_crop_offset = &thumb_crop_offset;
1792 //}
1793 encode_params.snapshot_buf = (uint8_t *)mainframe->buffer;
1794 encode_params.snapshot_fd = mainframe->fd;
1795 encode_params.snapshot_offset = mainframe->phy_offset;
1796 encode_params.scaling_params = &crop;
1797 encode_params.exif_data = mHalCamCtrl->getExifData();
1798 encode_params.exif_numEntries = mHalCamCtrl->getExifTableNumEntries();
1799
1800 if (isLiveSnapshot() && !isFullSizeLiveshot())
1801 encode_params.a_cbcroffset = mainframe->cbcr_off;
1802 else
1803 encode_params.a_cbcroffset = -1;
1804 encode_params.main_crop_offset = &main_crop_offset;
1805
1806 if (mDropThumbnail)
1807 encode_params.hasThumbnail = 0;
1808 else
1809 encode_params.hasThumbnail = 1;
1810 encode_params.thumb_crop_offset = &thumb_crop_offset;
1811 encode_params.main_format = dimension.main_img_format;
1812 encode_params.thumbnail_format = dimension.thumb_format;
1813
1814 if (!omxJpegEncode(&encode_params)){
1815 ALOGE("%s: Failure! JPEG encoder returned error.", __func__);
1816 ret = FAILED_TRANSACTION;
1817 goto end;
1818 }
1819
1820 /* Save the pointer to the frame sent for encoding. we'll need it to
1821 tell kernel that we are done with the frame.*/
1822 mCurrentFrameEncoded = recvd_frame;
1823 setSnapshotState(SNAPSHOT_STATE_JPEG_ENCODING);
1824 }
1825
1826 end:
1827 ALOGV("%s: X", __func__);
1828 return ret;
1829 }
1830
1831 /* Called twice - 1st to play shutter sound and 2nd to configure
1832 overlay/surfaceflinger for postview */
notifyShutter(common_crop_t * crop,bool mPlayShutterSoundOnly)1833 void QCameraStream_Snapshot::notifyShutter(common_crop_t *crop,
1834 bool mPlayShutterSoundOnly)
1835 {
1836 ALOGV("%s: E", __func__);
1837 if(!mActive && !isLiveSnapshot()) {
1838 ALOGE("__debbug: Snapshot thread stopped \n");
1839 return;
1840 }
1841 if(mHalCamCtrl->mNotifyCb && !mHalCamCtrl->mSnapCbDisabled)
1842 mHalCamCtrl->mNotifyCb(CAMERA_MSG_SHUTTER, 0, mPlayShutterSoundOnly,
1843 mHalCamCtrl->mCallbackCookie);
1844 ALOGV("%s: X", __func__);
1845 }
1846
1847 status_t QCameraStream_Snapshot::
encodeDisplayAndSave(mm_camera_ch_data_buf_t * recvd_frame,bool enqueued)1848 encodeDisplayAndSave(mm_camera_ch_data_buf_t* recvd_frame,
1849 bool enqueued)
1850 {
1851 status_t ret = NO_ERROR;
1852 struct msm_frame *postview_frame;
1853 struct ion_flush_data cache_inv_data;
1854 int ion_fd;
1855 int buf_index = 0;
1856 ssize_t offset_addr = 0;
1857 common_crop_t dummy_crop;
1858 /* send frame for encoding */
1859 ALOGV("%s: Send frame for encoding", __func__);
1860 /*TBD: Pass 0 as cropinfo for now as v4l2 doesn't provide
1861 cropinfo. It'll be changed later.*/
1862 if(!mActive) {
1863 ALOGE("Cancel Picture.. Stop is called");
1864 return NO_ERROR;
1865 }
1866 if(isZSLMode()){
1867 ALOGV("%s: set JPEG rotation in ZSL mode", __func__);
1868 mHalCamCtrl->setJpegRotation(isZSLMode());
1869 }
1870 #ifdef USE_ION
1871 /*Clean out(Write-back) cache before sending for JPEG*/
1872 memset(&cache_inv_data, 0, sizeof(struct ion_flush_data));
1873 cache_inv_data.vaddr = (void*)recvd_frame->snapshot.main.frame->buffer;
1874 cache_inv_data.fd = recvd_frame->snapshot.main.frame->fd;
1875 cache_inv_data.handle = recvd_frame->snapshot.main.frame->fd_data.handle;
1876 cache_inv_data.length = recvd_frame->snapshot.main.frame->ion_alloc.len;
1877 ion_fd = recvd_frame->snapshot.main.frame->ion_dev_fd;
1878 if(ion_fd > 0) {
1879 if(mHalCamCtrl->cache_ops(ion_fd, &cache_inv_data, ION_IOC_CLEAN_INV_CACHES) < 0)
1880 ALOGE("%s: Cache Invalidate failed\n", __func__);
1881 else {
1882 ALOGV("%s: Successful cache invalidate\n", __func__);
1883 if(!isFullSizeLiveshot()) {
1884 ion_fd = recvd_frame->snapshot.thumbnail.frame->ion_dev_fd;
1885 cache_inv_data.vaddr = (void*)recvd_frame->snapshot.thumbnail.frame->buffer;
1886 cache_inv_data.fd = recvd_frame->snapshot.thumbnail.frame->fd;
1887 cache_inv_data.handle = recvd_frame->snapshot.thumbnail.frame->fd_data.handle;
1888 cache_inv_data.length = recvd_frame->snapshot.thumbnail.frame->ion_alloc.len;
1889 if(mHalCamCtrl->cache_ops(ion_fd, &cache_inv_data, ION_IOC_CLEAN_INV_CACHES) < 0)
1890 ALOGE("%s: Cache Invalidate failed\n", __func__);
1891 else
1892 ALOGV("%s: Successful cache invalidate\n", __func__);
1893 }
1894 }
1895 }
1896 #endif
1897 memset(&dummy_crop,0,sizeof(common_crop_t));
1898 ret = encodeData(recvd_frame, &dummy_crop, mSnapshotStreamBuf.frame_len,
1899 enqueued);
1900 if (ret != NO_ERROR) {
1901 ALOGE("%s: Failure configuring JPEG encoder", __func__);
1902
1903 goto end;
1904 }
1905
1906 /* Display postview image*/
1907 /* If it's burst mode, we won't be displaying postview of all the captured
1908 images - only the first one */
1909 ALOGV("%s: Burst mode flag %d", __func__, mBurstModeFlag);
1910
1911 end:
1912 ALOGV("%s: X", __func__);
1913 return ret;
1914 }
1915
receiveRawPicture(mm_camera_ch_data_buf_t * recvd_frame)1916 status_t QCameraStream_Snapshot::receiveRawPicture(mm_camera_ch_data_buf_t* recvd_frame)
1917 {
1918 int buf_index = 0;
1919 common_crop_t crop;
1920 int rc = NO_ERROR;
1921 int cur_lux_idx = 0;
1922
1923 camera_notify_callback notifyCb;
1924 camera_data_callback dataCb, jpgDataCb;
1925
1926 ALOGD("%s: E ", __func__);
1927 if(!mActive) {
1928 ALOGD("%s: Stop receiving raw pic before acquiring lock", __func__);
1929 return NO_ERROR;
1930 }
1931 mStopCallbackLock.lock( );
1932 ALOGI("%s after mStopCallbackLock.lock()", __func__);
1933 if(!mActive) {
1934 mStopCallbackLock.unlock();
1935 ALOGV("%s: Stop receiving raw pic ", __func__);
1936 return NO_ERROR;
1937 }
1938
1939 if(getSnapshotState() == SNAPSHOT_STATE_ERROR) {
1940 cam_evt_buf_done(mCameraId, recvd_frame);
1941 }
1942
1943 mHalCamCtrl->dumpFrameToFile(recvd_frame->snapshot.main.frame, HAL_DUMP_FRM_MAIN);
1944 if (!isFullSizeLiveshot())
1945 mHalCamCtrl->dumpFrameToFile(recvd_frame->snapshot.thumbnail.frame,
1946 HAL_DUMP_FRM_THUMBNAIL);
1947
1948 /* If it's raw snapshot, we just want to tell upperlayer to save the image*/
1949 if(mSnapshotFormat == PICTURE_FORMAT_RAW) {
1950 ALOGD("%s: Call notifyShutter 2nd time in case of RAW", __func__);
1951 // mStopCallbackLock.unlock();
1952 if(!mHalCamCtrl->mShutterSoundPlayed) {
1953 notifyShutter(&crop, true);
1954 }
1955 notifyShutter(&crop, false);
1956 mHalCamCtrl->mShutterSoundPlayed = false;
1957
1958 // mStopCallbackLock.lock( );
1959 ALOGD("%s: Sending Raw Snapshot Callback to Upperlayer", __func__);
1960 buf_index = recvd_frame->def.idx;
1961
1962 if (mHalCamCtrl->mDataCb && mActive &&
1963 (mHalCamCtrl->mMsgEnabled & CAMERA_MSG_COMPRESSED_IMAGE)){
1964 dataCb = mHalCamCtrl->mDataCb;
1965 } else {
1966 dataCb = NULL;
1967 }
1968 // mStopCallbackLock.unlock();
1969
1970 if(mActive && dataCb && !mHalCamCtrl->mSnapCbDisabled) {
1971 dataCb(
1972 CAMERA_MSG_COMPRESSED_IMAGE,
1973 mHalCamCtrl->mRawMemory.camera_memory[buf_index], 0, NULL,
1974 mHalCamCtrl->mCallbackCookie);
1975 }
1976 /* TBD: Temp: To be removed once event handling is enabled */
1977 mm_app_snapshot_done();
1978 mStopCallbackLock.unlock();
1979 } else {
1980 /*TBD: v4l2 doesn't have support to provide cropinfo along with
1981 frame. We'll need to query.*/
1982 memset(&crop, 0, sizeof(common_crop_t));
1983
1984 if(isZSLMode()){
1985 //Changes to stop sending Preview Frames when Snapshot issued
1986 //in ZSL case.
1987 mHalCamCtrl->mPauseFramedispatch = true;
1988 }
1989
1990 ALOGV("%s: Call notifyShutter 2nd time", __func__);
1991 /* The recvd_frame structre we receive from lower library is a local
1992 variable. So we'll need to save this structure so that we won't
1993 be later pointing to garbage data when that variable goes out of
1994 scope */
1995 mm_camera_ch_data_buf_t* frame =
1996 (mm_camera_ch_data_buf_t *)malloc(sizeof(mm_camera_ch_data_buf_t));
1997 if (frame == NULL) {
1998 ALOGE("%s: Error allocating memory to save received_frame structure.", __func__);
1999 cam_evt_buf_done(mCameraId, recvd_frame);
2000 mStopCallbackLock.unlock();
2001 return BAD_VALUE;
2002 }
2003 memcpy(frame, recvd_frame, sizeof(mm_camera_ch_data_buf_t));
2004 rc = cam_config_get_parm(mCameraId, MM_CAMERA_PARM_LUX_IDX, &cur_lux_idx);
2005
2006 if (cur_lux_idx > 370) {
2007 static int input_width = 0, input_height = 0;
2008 static int ret = 0;
2009 unsigned char *dnr_buffer;
2010 input_width = mPictureWidth;
2011 input_height = mPictureHeight;
2012
2013 ALOGV("%s: received frame %d * %d", __func__, input_width, input_height);
2014 {
2015 dnr_buffer = (uint8_t *)malloc(input_width*input_height*3/2);
2016 if (dnr_buffer == NULL)
2017 ALOGE("dnr_buffer alloc fail");
2018 ALOGV("dnr_buffer allocated size : %d", input_width*input_height*3/2);
2019 memcpy(dnr_buffer, (uint8_t *)frame->snapshot.main.frame->buffer, input_width*input_height*3/2);
2020 ALOGV("dnr_buffer memcpy completed.");
2021 }
2022 ALOGV("[DNR] DNR Processing Start.... %d * %d\n", mPictureWidth, mPictureHeight);
2023 ret = NO_ERROR;
2024 if (mHalCamCtrl->LINK_morpho_DNR_ProcessFrame)
2025 ret = (int)mHalCamCtrl->LINK_morpho_DNR_ProcessFrame(dnr_buffer, mPictureWidth, mPictureHeight, 1, 1); //bright->normal->dark
2026 ALOGV("[DNR] DNR Processing result.... ret = %d\n", ret);
2027 memcpy((uint8_t *)recvd_frame->snapshot.main.frame->buffer, (uint8_t *)dnr_buffer, mPictureWidth*mPictureHeight*3/2);
2028 ALOGV("[DNR] DNR Processing END....\n");
2029 if(dnr_buffer)
2030 free(dnr_buffer);
2031 }
2032 //mStopCallbackLock.lock();
2033
2034 // only in ZSL mode and Wavelet Denoise is enabled, we will send frame to deamon to do WDN
2035 if (isZSLMode() && mHalCamCtrl->isWDenoiseEnabled()) {
2036 if(mIsDoingWDN){
2037 mWDNQueue.enqueue((void *)frame);
2038 ALOGV("%s: Wavelet denoise is going on, queue frame", __func__);
2039 rc = NO_ERROR;
2040 } else {
2041 ALOGV("%s: Start Wavelet denoise", __func__);
2042 mIsDoingWDN = true; // set the falg to true because we are going to do WDN
2043
2044 // No WDN is going on so far, we will start it here
2045 rc = doWaveletDenoise(frame);
2046 if ( NO_ERROR != rc ) {
2047 ALOGE("%s: Error while doing wavelet denoise", __func__);
2048 mIsDoingWDN = false;
2049 }
2050 }
2051 } else if (mHdrInfo.hdr_on) {
2052 mHdrInfo.recvd_frame[mHdrInfo.num_raw_received] = frame;
2053 mHdrInfo.num_raw_received++;
2054 ALOGV("%s Total %d Received %d frames, still need to receive %d frames", __func__,
2055 mHdrInfo.num_frame, mHdrInfo.num_raw_received, (mHdrInfo.num_frame - mHdrInfo.num_raw_received));
2056 if (mHdrInfo.num_raw_received == mHdrInfo.num_frame) {
2057 ALOGV(" Received all %d YUV frames, Invoke HDR", mHdrInfo.num_raw_received);
2058 doHdrProcessing();
2059 }
2060 }
2061 else {
2062 ALOGV("%s: encodeDisplayAndSave ", __func__);
2063 rc = encodeDisplayAndSave(frame, 0);
2064 }
2065
2066
2067 // send upperlayer callback for raw image (data or notify, not both)
2068 if((mHalCamCtrl->mDataCb) && (mHalCamCtrl->mMsgEnabled & CAMERA_MSG_RAW_IMAGE)){
2069 dataCb = mHalCamCtrl->mDataCb;
2070 } else {
2071 dataCb = NULL;
2072 }
2073 if((mHalCamCtrl->mNotifyCb) && (mHalCamCtrl->mMsgEnabled & CAMERA_MSG_RAW_IMAGE_NOTIFY)){
2074 notifyCb = mHalCamCtrl->mNotifyCb;
2075 } else {
2076 notifyCb = NULL;
2077 }
2078
2079 mSnapshotDataCallingBack = 1;
2080 if (!mActive) {
2081 ALOGE("%s Snapshot thread is stoped, deinit buffer and exit", __func__);
2082 goto end;
2083 }
2084
2085 mStopCallbackLock.unlock();
2086 if(!mHalCamCtrl->mShutterSoundPlayed) {
2087 notifyShutter(&crop, true);
2088 }
2089 notifyShutter(&crop, false);
2090 mHalCamCtrl->mShutterSoundPlayed = false;
2091 mStopCallbackLock.lock();
2092
2093 if(mHalCamCtrl->mHdrMode == HDR_MODE) {
2094 if ((hdrRawCount % 3) != 2) {
2095 mStopCallbackLock.unlock();
2096 return NO_ERROR;
2097 }
2098 else {
2099 hdrRawCount++;
2100 }
2101 }
2102
2103 if (rc != NO_ERROR)
2104 {
2105 ALOGE("%s: Error while encoding/displaying/saving image", __func__);
2106 cam_evt_buf_done(mCameraId, recvd_frame);
2107
2108 if(mHalCamCtrl->mDataCb &&
2109 (mHalCamCtrl->mMsgEnabled & CAMERA_MSG_COMPRESSED_IMAGE)) {
2110 /* get picture failed. Give jpeg callback with NULL data
2111 * to the application to restore to preview mode
2112 */
2113 jpgDataCb = mHalCamCtrl->mDataCb;
2114 } else {
2115 jpgDataCb = NULL;
2116 }
2117 ALOGE("%s: encode err so data cb", __func__);
2118 if (mActive && dataCb && !mHalCamCtrl->mSnapCbDisabled) {
2119 dataCb(CAMERA_MSG_RAW_IMAGE, mHalCamCtrl->mSnapshotMemory.camera_memory[0],
2120 1, NULL, mHalCamCtrl->mCallbackCookie);
2121 }
2122 if (mActive && notifyCb && !mHalCamCtrl->mSnapCbDisabled) {
2123 notifyCb(CAMERA_MSG_RAW_IMAGE_NOTIFY, 0, 0, mHalCamCtrl->mCallbackCookie);
2124 }
2125 if (mActive && jpgDataCb && !mHalCamCtrl->mSnapCbDisabled) {
2126 jpgDataCb(CAMERA_MSG_COMPRESSED_IMAGE,
2127 NULL, 0, NULL,
2128 mHalCamCtrl->mCallbackCookie);
2129 }
2130
2131 if (frame != NULL) {
2132 free(frame);
2133 }
2134 } else {
2135 ALOGI("%s: NO Error while encoding/displaying/saving image", __func__);
2136 if (mActive && dataCb && !mHalCamCtrl->mSnapCbDisabled) {
2137 dataCb(CAMERA_MSG_RAW_IMAGE, mHalCamCtrl->mSnapshotMemory.camera_memory[0],
2138 1, NULL, mHalCamCtrl->mCallbackCookie);
2139 }
2140 if (mActive && notifyCb && !mHalCamCtrl->mSnapCbDisabled) {
2141 notifyCb(CAMERA_MSG_RAW_IMAGE_NOTIFY, 0, 0, mHalCamCtrl->mCallbackCookie);
2142 }
2143
2144 if (!isZSLMode() &&
2145 (!isLiveSnapshot() && !isFullSizeLiveshot())) {
2146 if(mHalCamCtrl->mDataCb &&
2147 (mHalCamCtrl->mMsgEnabled & CAMERA_MSG_POSTVIEW_FRAME)) {
2148 mHalCamCtrl->mDataCb(CAMERA_MSG_POSTVIEW_FRAME,mHalCamCtrl->mThumbnailMemory.camera_memory[0],
2149 0, NULL, mHalCamCtrl->mCallbackCookie);
2150 }
2151 }
2152 }
2153 end: mSnapshotDataCallingBack = 0;
2154 if (mFreeSnapshotBufAfterDataCb) {
2155 deInitBuffer();
2156 mFreeSnapshotBufAfterDataCb = 0;
2157 }
2158 ALOGI("%s before mStopCallbackLock.unlock()", __func__);
2159 mStopCallbackLock.unlock();
2160 ALOGI("%s After mStopCallbackLock.unlock()", __func__);
2161 }
2162
2163 ALOGV("%s: X", __func__);
2164 return NO_ERROR;
2165 }
2166
2167 //-------------------------------------------------------------------
2168 // Helper Functions
2169 //-------------------------------------------------------------------
handleError()2170 void QCameraStream_Snapshot::handleError()
2171 {
2172 mm_camera_channel_type_t ch_type;
2173 ALOGV("%s: E", __func__);
2174
2175 /* Depending upon the state we'll have to
2176 handle error */
2177 switch(getSnapshotState()) {
2178 case SNAPSHOT_STATE_JPEG_ENCODING:
2179 if(mJpegHeap != NULL) mJpegHeap.clear();
2180 mJpegHeap = NULL;
2181
2182 case SNAPSHOT_STATE_YUV_RECVD:
2183 case SNAPSHOT_STATE_IMAGE_CAPTURE_STRTD:
2184 stopPolling();
2185 case SNAPSHOT_STATE_INITIALIZED:
2186 case SNAPSHOT_STATE_BUF_INITIALIZED:
2187 if (mSnapshotFormat == PICTURE_FORMAT_JPEG) {
2188 deinitSnapshotBuffers();
2189 }else
2190 {
2191 deinitRawSnapshotBuffers();
2192 }
2193 case SNAPSHOT_STATE_BUF_NOTIF_REGD:
2194 case SNAPSHOT_STATE_CH_ACQUIRED:
2195 if (mSnapshotFormat == PICTURE_FORMAT_JPEG) {
2196 deinitSnapshotChannel(MM_CAMERA_CH_SNAPSHOT);
2197 }else
2198 {
2199 deinitSnapshotChannel(MM_CAMERA_CH_RAW);
2200 }
2201 default:
2202 /* Set the state to ERROR */
2203 setSnapshotState(SNAPSHOT_STATE_ERROR);
2204 break;
2205 }
2206
2207 ALOGV("%s: X", __func__);
2208 }
2209
setSnapshotState(int state)2210 void QCameraStream_Snapshot::setSnapshotState(int state)
2211 {
2212 ALOGV("%s: Setting snapshot state to: %d",
2213 __func__, state);
2214 mSnapshotState = state;
2215 }
2216
getSnapshotState()2217 int QCameraStream_Snapshot::getSnapshotState()
2218 {
2219 return mSnapshotState;
2220 }
2221
setModeLiveSnapshot(bool value)2222 void QCameraStream_Snapshot::setModeLiveSnapshot(bool value)
2223 {
2224 mModeLiveSnapshot = value;
2225 }
2226
isLiveSnapshot(void)2227 bool QCameraStream_Snapshot::isLiveSnapshot(void)
2228 {
2229 return mModeLiveSnapshot;
2230 }
isZSLMode()2231 bool QCameraStream_Snapshot::isZSLMode()
2232 {
2233 return (myMode & CAMERA_ZSL_MODE);
2234 }
2235
setFullSizeLiveshot(bool value)2236 void QCameraStream_Snapshot::setFullSizeLiveshot(bool value)
2237 {
2238 mFullLiveshot = value;
2239 }
2240
isFullSizeLiveshot()2241 bool QCameraStream_Snapshot::isFullSizeLiveshot()
2242 {
2243 return mFullLiveshot;
2244 }
2245
resetSnapshotCounters(void)2246 void QCameraStream_Snapshot::resetSnapshotCounters(void )
2247 {
2248 mNumOfSnapshot = mHalCamCtrl->getNumOfSnapshots();
2249 if (mNumOfSnapshot <= 0) {
2250 mNumOfSnapshot = 1;
2251 }
2252 mNumOfRecievedJPEG = 0;
2253 ALOGV("%s: Number of images to be captured: %d", __func__, mNumOfSnapshot);
2254 }
2255
2256 //------------------------------------------------------------------
2257 // Constructor and Destructor
2258 //------------------------------------------------------------------
2259 QCameraStream_Snapshot::
QCameraStream_Snapshot(int cameraId,camera_mode_t mode)2260 QCameraStream_Snapshot(int cameraId, camera_mode_t mode)
2261 : QCameraStream(cameraId,mode),
2262 mSnapshotFormat(PICTURE_FORMAT_JPEG),
2263 mPictureWidth(0), mPictureHeight(0),
2264 mPictureFormat(CAMERA_YUV_420_NV21),
2265 mPostviewWidth(0), mPostviewHeight(0),
2266 mThumbnailWidth(0), mThumbnailHeight(0),
2267 mThumbnailFormat(CAMERA_YUV_420_NV21),
2268 mJpegOffset(0),
2269 mSnapshotState(SNAPSHOT_STATE_UNINIT),
2270 mNumOfSnapshot(1),
2271 mModeLiveSnapshot(false),
2272 mBurstModeFlag(false),
2273 mActualPictureWidth(0),
2274 mActualPictureHeight(0),
2275 mJpegDownscaling(false),
2276 mJpegHeap(NULL),
2277 mDisplayHeap(NULL),
2278 mPostviewHeap(NULL),
2279 mCurrentFrameEncoded(NULL),
2280 mJpegSessionId(0),
2281 mFullLiveshot(false),
2282 mDropThumbnail(false)
2283 {
2284 ALOGV("%s: E", __func__);
2285
2286 /*initialize snapshot queue*/
2287 mSnapshotQueue.init();
2288 memset (&mHdrInfo, 0, sizeof(snap_hdr_record_t ));
2289
2290 /*initialize WDN queue*/
2291 mWDNQueue.init();
2292 mIsDoingWDN = false;
2293
2294 memset(&mSnapshotStreamBuf, 0, sizeof(mSnapshotStreamBuf));
2295 memset(&mPostviewStreamBuf, 0, sizeof(mPostviewStreamBuf));
2296 mSnapshotBufferNum = 0;
2297 mMainSize = 0;
2298 mThumbSize = 0;
2299 for(int i = 0; i < mMaxSnapshotBufferCount; i++) {
2300 mMainfd[i] = 0;
2301 mThumbfd[i] = 0;
2302 mCameraMemoryPtrMain[i] = NULL;
2303 mCameraMemoryPtrThumb[i] = NULL;
2304 }
2305 /*load the jpeg lib*/
2306 mJpegSessionId = omxJpegOpen( );
2307 ALOGV("%s: X", __func__);
2308 }
2309
2310
~QCameraStream_Snapshot()2311 QCameraStream_Snapshot::~QCameraStream_Snapshot() {
2312 ALOGV("%s: E", __func__);
2313
2314 /* deinit snapshot queue */
2315 if (mSnapshotQueue.isInitialized()) {
2316 mSnapshotQueue.deinit();
2317 }
2318 /* deinit snapshot queue */
2319 if (mWDNQueue.isInitialized()) {
2320 mWDNQueue.deinit();
2321 }
2322
2323 if(mActive) {
2324 stop();
2325 }
2326 if(mInit) {
2327 release();
2328 }
2329 mInit = false;
2330 mActive = false;
2331 if (mJpegSessionId > 0) {
2332 omxJpegClose( );
2333 mJpegSessionId = 0;
2334 }
2335 ALOGV("%s: X", __func__);
2336
2337 }
2338
2339 //------------------------------------------------------------------
2340 // Public Members
2341 //------------------------------------------------------------------
init()2342 status_t QCameraStream_Snapshot::init()
2343 {
2344 status_t ret = NO_ERROR;
2345 mm_camera_op_mode_type_t op_mode;
2346
2347 ALOGV("%s: E", __func__);
2348 /* Check the state. If we have already started snapshot
2349 process just return*/
2350 if (getSnapshotState() != SNAPSHOT_STATE_UNINIT) {
2351 ret = isZSLMode() ? NO_ERROR : INVALID_OPERATION;
2352 ALOGE("%s: Trying to take picture while snapshot is in progress",
2353 __func__);
2354 goto end;
2355 }
2356 mInit = true;
2357
2358 end:
2359 /*if (ret == NO_ERROR) {
2360 setSnapshotState(SNAPSHOT_STATE_INITIALIZED);
2361 }*/
2362 ALOGV("%s: X", __func__);
2363 return ret;
2364 }
2365
start(void)2366 status_t QCameraStream_Snapshot::start(void) {
2367 status_t ret = NO_ERROR;
2368
2369 ALOGV("%s: E", __func__);
2370
2371 Mutex::Autolock lock(mStopCallbackLock);
2372 mSnapshotDataCallingBack = 0;
2373 mFreeSnapshotBufAfterDataCb = 0;
2374 mHalCamCtrl->mSnapCbDisabled = false;
2375
2376 /* Keep track of number of snapshots to take - in case of
2377 multiple snapshot/burst mode */
2378
2379 if(mHalCamCtrl->isRawSnapshot()) {
2380 ALOGV("%s: Acquire Raw Snapshot Channel", __func__);
2381 ret = cam_ops_ch_acquire(mCameraId, MM_CAMERA_CH_RAW);
2382 if (NO_ERROR != ret) {
2383 ALOGE("%s: Failure Acquiring Raw Snapshot Channel error =%d\n",
2384 __func__, ret);
2385 ret = FAILED_TRANSACTION;
2386 goto end;
2387 }
2388 /* Snapshot channel is acquired */
2389 setSnapshotState(SNAPSHOT_STATE_CH_ACQUIRED);
2390 ALOGV("%s: Register buffer notification. My object: %x",
2391 __func__, (unsigned int) this);
2392 (void) cam_evt_register_buf_notify(mCameraId, MM_CAMERA_CH_RAW,
2393 snapshot_notify_cb,
2394 MM_CAMERA_REG_BUF_CB_INFINITE,
2395 0,
2396 this);
2397 /* Set the state to buffer notification completed */
2398 setSnapshotState(SNAPSHOT_STATE_BUF_NOTIF_REGD);
2399 }else{
2400 ALOGV("%s: Acquire Snapshot Channel", __func__);
2401 ret = cam_ops_ch_acquire(mCameraId, MM_CAMERA_CH_SNAPSHOT);
2402 if (NO_ERROR != ret) {
2403 ALOGE("%s: Failure Acquiring Snapshot Channel error =%d\n", __func__, ret);
2404 ret = FAILED_TRANSACTION;
2405 goto end;
2406 }
2407 /* Snapshot channel is acquired */
2408 setSnapshotState(SNAPSHOT_STATE_CH_ACQUIRED);
2409 ALOGV("%s: Register buffer notification. My object: %x",
2410 __func__, (unsigned int) this);
2411 (void) cam_evt_register_buf_notify(mCameraId, MM_CAMERA_CH_SNAPSHOT,
2412 snapshot_notify_cb,
2413 MM_CAMERA_REG_BUF_CB_INFINITE,
2414 0,
2415 this);
2416 /* Set the state to buffer notification completed */
2417 setSnapshotState(SNAPSHOT_STATE_BUF_NOTIF_REGD);
2418 }
2419
2420 if (isZSLMode()) {
2421 prepareHardware();
2422 ret = initZSLSnapshot();
2423 if(ret != NO_ERROR) {
2424 ALOGE("%s : Error while Initializing ZSL snapshot",__func__);
2425 goto end;
2426 }
2427 mHalCamCtrl->setExifTags();
2428 /* In case of ZSL, start will only start snapshot stream and
2429 continuously queue the frames in a queue. When user clicks
2430 shutter we'll call get buffer from the queue and pass it on */
2431 ret = startStreamZSL();
2432 goto end;
2433 }
2434
2435 if (isFullSizeLiveshot())
2436 ret = initFullLiveshot();
2437
2438 /* Check if it's a raw snapshot or JPEG*/
2439 if(mHalCamCtrl->isRawSnapshot()) {
2440 mSnapshotFormat = PICTURE_FORMAT_RAW;
2441 ret = initRawSnapshot(mNumOfSnapshot);
2442 }else{
2443 //JPEG
2444 mSnapshotFormat = PICTURE_FORMAT_JPEG;
2445 if (mHdrInfo.hdr_on) {
2446 ret = initJPEGSnapshot(mHdrInfo.num_frame);
2447 } else {
2448 ret = initJPEGSnapshot(mNumOfSnapshot);
2449 }
2450 }
2451 if(ret != NO_ERROR) {
2452 ALOGE("%s : Error while Initializing snapshot",__func__);
2453 goto end;
2454 }
2455
2456 //Update Exiftag values.
2457 mHalCamCtrl->setExifTags();
2458
2459 if (mSnapshotFormat == PICTURE_FORMAT_RAW) {
2460 ret = takePictureRaw();
2461 goto end;
2462 }
2463 else{
2464 ret = takePictureJPEG();
2465 goto end;
2466 }
2467
2468 end:
2469 if (ret == NO_ERROR) {
2470 setSnapshotState(SNAPSHOT_STATE_IMAGE_CAPTURE_STRTD);
2471 mActive = true;
2472 } else {
2473 deInitBuffer();
2474 }
2475
2476 ALOGV("%s: X", __func__);
2477 return ret;
2478 }
2479
stopPolling(void)2480 void QCameraStream_Snapshot::stopPolling(void)
2481 {
2482 mm_camera_ops_type_t ops_type;
2483
2484 if (mSnapshotFormat == PICTURE_FORMAT_JPEG) {
2485 ops_type = isZSLMode() ? MM_CAMERA_OPS_ZSL : MM_CAMERA_OPS_SNAPSHOT;
2486 }else
2487 ops_type = MM_CAMERA_OPS_RAW;
2488
2489 if( NO_ERROR != cam_ops_action(mCameraId, false,
2490 ops_type, this)) {
2491 ALOGE("%s: Failure stopping snapshot", __func__);
2492 }
2493 }
2494
stop(void)2495 void QCameraStream_Snapshot::stop(void)
2496 {
2497 mm_camera_ops_type_t ops_type;
2498 status_t ret = NO_ERROR;
2499
2500 ALOGV("%s: E", __func__);
2501
2502 if(!mActive && !isLiveSnapshot()) {
2503 ALOGV("%s: Not Active return now", __func__);
2504 return;
2505 }
2506 mActive = false;
2507 mHalCamCtrl->mSnapCbDisabled = true;
2508 Mutex::Autolock lock(mStopCallbackLock);
2509
2510 if(isLiveSnapshot()) {
2511 if(mHalCamCtrl->mStateLiveshot) {
2512 if(getSnapshotState() == SNAPSHOT_STATE_JPEG_ENCODING) {
2513 ALOGI("Destroy Liveshot Jpeg Instance");
2514 omxJpegAbort();
2515 }
2516 ALOGI("%s: De Intialized the JPEG buffers", __func__);
2517 deInitBuffer();
2518 mHalCamCtrl->mStateLiveshot = false;
2519 return;
2520 }
2521 else {
2522 ALOGI("%s: JPEG buffers are de Intialized and just return", __func__);
2523 return;
2524 }
2525 }
2526 if (getSnapshotState() != SNAPSHOT_STATE_UNINIT) {
2527 /* Stop polling for further frames */
2528 stopPolling();
2529
2530 if(getSnapshotState() == SNAPSHOT_STATE_JPEG_ENCODING) {
2531 ALOGV("Destroy Jpeg Instance");
2532 omxJpegAbort();
2533
2534 }
2535 /* Depending upon current state, we'll need to allocate-deallocate-deinit*/
2536 if (mSnapshotDataCallingBack) {
2537 mFreeSnapshotBufAfterDataCb = 1;
2538 }
2539 else {
2540 mFreeSnapshotBufAfterDataCb = 0;
2541 deInitBuffer();
2542 }
2543 }
2544
2545 if(mSnapshotFormat == PICTURE_FORMAT_RAW) {
2546 ret= QCameraStream::deinitChannel(mCameraId, MM_CAMERA_CH_RAW);
2547 if(ret != MM_CAMERA_OK) {
2548 ALOGE("%s:Deinit RAW channel failed=%d\n", __func__, ret);
2549 }
2550 (void)cam_evt_register_buf_notify(mCameraId, MM_CAMERA_CH_RAW,
2551 NULL,
2552 (mm_camera_register_buf_cb_type_t)NULL,
2553 NULL,
2554 NULL);
2555 } else {
2556 ret= QCameraStream::deinitChannel(mCameraId, MM_CAMERA_CH_SNAPSHOT);
2557 if(ret != MM_CAMERA_OK) {
2558 ALOGE("%s:Deinit Snapshot channel failed=%d\n", __func__, ret);
2559 }
2560 (void)cam_evt_register_buf_notify(mCameraId, MM_CAMERA_CH_SNAPSHOT,
2561 NULL,
2562 (mm_camera_register_buf_cb_type_t)NULL,
2563 NULL,
2564 NULL);
2565 }
2566
2567 /* release is generally called in case of explicit call from
2568 upper-layer during disconnect. So we need to deinit everything
2569 whatever state we are in */
2570 ALOGV("Calling omxjpegjoin from release\n");
2571 omxJpegFinish();
2572 #if 0
2573 omxJpegClose();
2574 #endif
2575 mFullLiveshot = false;
2576 ALOGV("%s: X", __func__);
2577
2578 }
2579
release()2580 void QCameraStream_Snapshot::release()
2581 {
2582 status_t ret = NO_ERROR;
2583 ALOGV("%s: E", __func__);
2584 //Mutex::Autolock l(&snapshotLock);
2585
2586 if(!mInit){
2587 ALOGE("%s : Stream not Initalized",__func__);
2588 return;
2589 }
2590
2591 if(mActive) {
2592 this->stop();
2593 mActive = false;
2594 }
2595
2596 /* release is generally called in case of explicit call from
2597 upper-layer during disconnect. So we need to deinit everything
2598 whatever state we are in */
2599
2600 //deinit();
2601 mInit = false;
2602 ALOGV("%s: X", __func__);
2603
2604 }
2605
prepareHardware()2606 void QCameraStream_Snapshot::prepareHardware()
2607 {
2608 ALOGV("%s: E", __func__);
2609
2610 /* Prepare snapshot*/
2611 cam_ops_action(mCameraId,
2612 true,
2613 MM_CAMERA_OPS_PREPARE_SNAPSHOT,
2614 this);
2615 ALOGV("%s: X", __func__);
2616 }
2617
getRawHeap() const2618 sp<IMemoryHeap> QCameraStream_Snapshot::getRawHeap() const
2619 {
2620 return ((mDisplayHeap != NULL) ? mDisplayHeap->mHeap : NULL);
2621 }
2622
2623 QCameraStream*
createInstance(int cameraId,camera_mode_t mode)2624 QCameraStream_Snapshot::createInstance(int cameraId,
2625 camera_mode_t mode)
2626 {
2627
2628 QCameraStream* pme = new QCameraStream_Snapshot(cameraId, mode);
2629
2630 return pme;
2631 }
2632
deleteInstance(QCameraStream * p)2633 void QCameraStream_Snapshot::deleteInstance(QCameraStream *p)
2634 {
2635 if (p){
2636 p->release();
2637 delete p;
2638 p = NULL;
2639 }
2640 }
2641
notifyWDenoiseEvent(cam_ctrl_status_t status,void * cookie)2642 void QCameraStream_Snapshot::notifyWDenoiseEvent(cam_ctrl_status_t status, void * cookie)
2643 {
2644 camera_notify_callback notifyCb;
2645 camera_data_callback dataCb, jpgDataCb;
2646 int rc = NO_ERROR;
2647 mm_camera_ch_data_buf_t *frame = (mm_camera_ch_data_buf_t *)cookie;
2648
2649 ALOGV("%s: WDN Done status (%d) received",__func__,status);
2650 Mutex::Autolock lock(mStopCallbackLock);
2651 if(!mActive) {
2652 ALOGD("%s: Stop receiving raw pic ", __func__);
2653 return;
2654 }
2655 if (frame == NULL) {
2656 ALOGE("%s: cookie is returned NULL", __func__);
2657 } else {
2658 #if 0
2659 // first unmapping the fds
2660 mHalCamCtrl->sendUnMappingBuf(MSM_V4L2_EXT_CAPTURE_MODE_MAIN, frame->snapshot.main.idx, mCameraId,
2661 CAM_SOCK_MSG_TYPE_FD_UNMAPPING);
2662 mHalCamCtrl->sendUnMappingBuf(MSM_V4L2_EXT_CAPTURE_MODE_THUMBNAIL, frame->snapshot.thumbnail.idx, mCameraId,
2663 CAM_SOCK_MSG_TYPE_FD_UNMAPPING);
2664 #endif
2665
2666 // then do JPEG encoding
2667 rc = encodeDisplayAndSave(frame, 0);
2668 }
2669
2670 // send upperlayer callback for raw image (data or notify, not both)
2671 if((mHalCamCtrl->mDataCb) && (mHalCamCtrl->mMsgEnabled & CAMERA_MSG_RAW_IMAGE)){
2672 dataCb = mHalCamCtrl->mDataCb;
2673 } else {
2674 dataCb = NULL;
2675 }
2676 if((mHalCamCtrl->mNotifyCb) && (mHalCamCtrl->mMsgEnabled & CAMERA_MSG_RAW_IMAGE_NOTIFY)){
2677 notifyCb = mHalCamCtrl->mNotifyCb;
2678 } else {
2679 notifyCb = NULL;
2680 }
2681 if(mHalCamCtrl->mDataCb &&
2682 (mHalCamCtrl->mMsgEnabled & CAMERA_MSG_COMPRESSED_IMAGE)) {
2683 /* get picture failed. Give jpeg callback with NULL data
2684 * to the application to restore to preview mode
2685 */
2686 jpgDataCb = mHalCamCtrl->mDataCb;
2687 } else {
2688 jpgDataCb = NULL;
2689 }
2690
2691 // launch next WDN if there is more in WDN Queue
2692 lauchNextWDenoiseFromQueue();
2693
2694 // mStopCallbackLock.unlock();
2695
2696 if (rc != NO_ERROR)
2697 {
2698 ALOGE("%s: Error while encoding/displaying/saving image", __func__);
2699 if (frame) {
2700 cam_evt_buf_done(mCameraId, frame);
2701 }
2702
2703 if (mActive && dataCb && !mHalCamCtrl->mSnapCbDisabled) {
2704 dataCb(CAMERA_MSG_RAW_IMAGE, mHalCamCtrl->mSnapshotMemory.camera_memory[0],
2705 1, NULL, mHalCamCtrl->mCallbackCookie);
2706 }
2707 if (mActive && notifyCb && !mHalCamCtrl->mSnapCbDisabled) {
2708 notifyCb(CAMERA_MSG_RAW_IMAGE_NOTIFY, 0, 0, mHalCamCtrl->mCallbackCookie);
2709 }
2710 if (mActive && jpgDataCb && !mHalCamCtrl->mSnapCbDisabled) {
2711 jpgDataCb(CAMERA_MSG_COMPRESSED_IMAGE,
2712 NULL, 0, NULL,
2713 mHalCamCtrl->mCallbackCookie);
2714 }
2715
2716 if (frame != NULL) {
2717 free(frame);
2718 }
2719 }
2720 }
2721
lauchNextWDenoiseFromQueue()2722 void QCameraStream_Snapshot::lauchNextWDenoiseFromQueue()
2723 {
2724 do {
2725 mm_camera_ch_data_buf_t *frame = NULL;
2726 if ( mWDNQueue.isEmpty() ||
2727 (NULL == (frame = (mm_camera_ch_data_buf_t *)mWDNQueue.dequeue())) ) {
2728 // set the flag back to false when no WDN going on
2729 mIsDoingWDN = false;
2730 break;
2731 }
2732
2733 if ( NO_ERROR != doWaveletDenoise(frame) ) {
2734 ALOGE("%s: Error while doing wavelet denoise", __func__);
2735 if (frame != NULL) {
2736 free(frame);
2737 }
2738 } else {
2739 // we sent out req for WDN, so we can break here
2740 ALOGV("%s: Send out req for doing wavelet denoise, return here", __func__);
2741 break;
2742 }
2743 } while (true);
2744 }
2745
doWaveletDenoise(mm_camera_ch_data_buf_t * frame)2746 status_t QCameraStream_Snapshot::doWaveletDenoise(mm_camera_ch_data_buf_t* frame)
2747 {
2748 status_t ret = NO_ERROR;
2749 cam_sock_packet_t packet;
2750 cam_ctrl_dimension_t dim;
2751
2752 ALOGV("%s: E", __func__);
2753
2754 #if 0
2755 // get dim on the fly
2756 memset(&dim, 0, sizeof(cam_ctrl_dimension_t));
2757 ret = cam_config_get_parm(mCameraId, MM_CAMERA_PARM_DIMENSION, &dim);
2758 if (NO_ERROR != ret) {
2759 ALOGE("%s: error - can't get dimension!", __func__);
2760 return FAILED_TRANSACTION;
2761 }
2762
2763 // send main frame mapping through domain socket
2764 if (NO_ERROR != mHalCamCtrl->sendMappingBuf(MSM_V4L2_EXT_CAPTURE_MODE_MAIN,
2765 frame->snapshot.main.idx,
2766 frame->snapshot.main.frame->fd,
2767 dim.picture_frame_offset.frame_len, mCameraId,
2768 CAM_SOCK_MSG_TYPE_FD_MAPPING)) {
2769 ALOGE("%s: sending main frame mapping buf msg Failed", __func__);
2770 ret = FAILED_TRANSACTION;
2771 goto end;
2772 }
2773
2774 // send thumbnail frame mapping through domain socket
2775 if (NO_ERROR != mHalCamCtrl->sendMappingBuf(MSM_V4L2_EXT_CAPTURE_MODE_THUMBNAIL,
2776 frame->snapshot.thumbnail.idx,
2777 frame->snapshot.thumbnail.frame->fd,
2778 dim.display_frame_offset.frame_len, mCameraId,
2779 CAM_SOCK_MSG_TYPE_FD_MAPPING)) {
2780 ALOGE("%s: sending thumbnail frame mapping buf msg Failed", __func__);
2781 ret = FAILED_TRANSACTION;
2782 goto end;
2783 }
2784
2785 #endif
2786 // ask deamon to start wdn operation
2787 if (NO_ERROR != sendWDenoiseStartMsg(frame)) {
2788 ALOGE("%s: sending thumbnail frame mapping buf msg Failed", __func__);
2789 ret = FAILED_TRANSACTION;
2790 goto end;
2791 }
2792
2793 end:
2794 ALOGV("%s: X", __func__);
2795 return ret;
2796 }
2797
sendWDenoiseStartMsg(mm_camera_ch_data_buf_t * frame)2798 status_t QCameraStream_Snapshot::sendWDenoiseStartMsg(mm_camera_ch_data_buf_t * frame)
2799 {
2800 cam_sock_packet_t packet;
2801 memset(&packet, 0, sizeof(cam_sock_packet_t));
2802 packet.msg_type = CAM_SOCK_MSG_TYPE_WDN_START;
2803 packet.payload.wdn_start.cookie = (unsigned long)frame;
2804 packet.payload.wdn_start.num_frames = MM_MAX_WDN_NUM;
2805 packet.payload.wdn_start.ext_mode[0] = MSM_V4L2_EXT_CAPTURE_MODE_MAIN;
2806 packet.payload.wdn_start.ext_mode[1] = MSM_V4L2_EXT_CAPTURE_MODE_THUMBNAIL;
2807 packet.payload.wdn_start.frame_idx[0] = frame->snapshot.main.idx;
2808 packet.payload.wdn_start.frame_idx[1] = frame->snapshot.thumbnail.idx;
2809 if ( cam_ops_sendmsg(mCameraId, &packet, sizeof(packet), 0) <= 0 ) {
2810 ALOGE("%s: sending start wavelet denoise msg failed", __func__);
2811 return FAILED_TRANSACTION;
2812 }
2813 return NO_ERROR;
2814 }
2815
doHdrProcessing()2816 status_t QCameraStream_Snapshot::doHdrProcessing( )
2817 {
2818 status_t rc = NO_ERROR;
2819 cam_sock_packet_t packet;
2820 int i;
2821 memset(&packet, 0, sizeof(cam_sock_packet_t));
2822 packet.msg_type = CAM_SOCK_MSG_TYPE_HDR_START;
2823 packet.payload.hdr_pkg.cookie = (unsigned long)this;
2824 packet.payload.hdr_pkg.num_hdr_frames = mHdrInfo.num_frame;
2825 ALOGV("%s num frames = %d ", __func__, mHdrInfo.num_frame);
2826 for (i = 0; i < mHdrInfo.num_frame; i++) {
2827 packet.payload.hdr_pkg.hdr_main_idx[i] =mHdrInfo.recvd_frame[i]->snapshot.main.idx;
2828 packet.payload.hdr_pkg.hdr_thm_idx[i] = mHdrInfo.recvd_frame[i]->snapshot.thumbnail.idx;
2829 packet.payload.hdr_pkg.exp[i] = mHdrInfo.exp[i];
2830 ALOGV("%s Adding buffer M %d T %d Exp %d into hdr pkg ", __func__,
2831 packet.payload.hdr_pkg.hdr_main_idx[i],
2832 packet.payload.hdr_pkg.hdr_thm_idx[i],
2833 packet.payload.hdr_pkg.exp[i]);
2834 }
2835 if (cam_ops_sendmsg(mCameraId, &packet, sizeof(packet), 0) <= 0) {
2836 ALOGE("%s: sending start HDR msg failed", __func__);
2837 rc= FAILED_TRANSACTION;
2838 }
2839 return rc;
2840 }
2841
InitHdrInfoForSnapshot(bool Hdr_on,int number_frames,int * exp)2842 void QCameraStream_Snapshot::InitHdrInfoForSnapshot(bool Hdr_on, int number_frames, int *exp )
2843 {
2844 mHdrInfo.hdr_on = Hdr_on;
2845 mHdrInfo.num_frame = number_frames;
2846 mHdrInfo.num_raw_received = 0;
2847
2848 if(number_frames) {
2849 memcpy(mHdrInfo.exp, exp, sizeof(int)*number_frames);
2850 }
2851 memset(&mHdrInfo.recvd_frame, 0,
2852 sizeof(mm_camera_ch_data_buf_t *)*MAX_HDR_EXP_FRAME_NUM);
2853 }
2854
2855
notifyHdrEvent(cam_ctrl_status_t status,void * cookie)2856 void QCameraStream_Snapshot::notifyHdrEvent(cam_ctrl_status_t status, void * cookie)
2857 {
2858 camera_notify_callback notifyCb;
2859 camera_data_callback dataCb, jpgDataCb;
2860 int rc[3];
2861 mm_camera_ch_data_buf_t *frame;
2862 int i;
2863
2864 ALOGV("%s: HDR Done status (%d) received",__func__,status);
2865 Mutex::Autolock lock(mStopCallbackLock);
2866 /* Regular frame */
2867 frame = mHdrInfo.recvd_frame[0];
2868 rc[0] = encodeDisplayAndSave(frame, 0);
2869 /* HDR frame */
2870 frame = mHdrInfo.recvd_frame[2];
2871 rc[2] = encodeDisplayAndSave(frame,0);
2872
2873 // send upperlayer callback for raw image (data or notify, not both)
2874 if((mHalCamCtrl->mDataCb) && (mHalCamCtrl->mMsgEnabled & CAMERA_MSG_RAW_IMAGE)){
2875 dataCb = mHalCamCtrl->mDataCb;
2876 } else {
2877 dataCb = NULL;
2878 }
2879 if((mHalCamCtrl->mNotifyCb) && (mHalCamCtrl->mMsgEnabled & CAMERA_MSG_RAW_IMAGE_NOTIFY)){
2880 notifyCb = mHalCamCtrl->mNotifyCb;
2881 } else {
2882 notifyCb = NULL;
2883 }
2884 if(mHalCamCtrl->mDataCb &&
2885 (mHalCamCtrl->mMsgEnabled & CAMERA_MSG_COMPRESSED_IMAGE)) {
2886 /* get picture failed. Give jpeg callback with NULL data
2887 * to the application to restore to preview mode
2888 */
2889 jpgDataCb = mHalCamCtrl->mDataCb;
2890 } else {
2891 jpgDataCb = NULL;
2892 }
2893
2894 mStopCallbackLock.unlock();
2895
2896 for (i =0; i<= 2; i++) {
2897 if(i==1)
2898 continue;
2899 if (rc[i] != NO_ERROR)
2900 {
2901 ALOGE("%s: Error while encoding/displaying/saving image", __func__);
2902 if (frame) {
2903 cam_evt_buf_done(mCameraId, mHdrInfo.recvd_frame[i]);
2904 }
2905
2906 if (dataCb) {
2907 dataCb(CAMERA_MSG_RAW_IMAGE, mHalCamCtrl->mSnapshotMemory.camera_memory[0],
2908 1, NULL, mHalCamCtrl->mCallbackCookie);
2909 }
2910 if (notifyCb) {
2911 notifyCb(CAMERA_MSG_RAW_IMAGE_NOTIFY, 0, 0, mHalCamCtrl->mCallbackCookie);
2912 }
2913 if (jpgDataCb) {
2914 jpgDataCb(CAMERA_MSG_COMPRESSED_IMAGE,
2915 NULL, 0, NULL,
2916 mHalCamCtrl->mCallbackCookie);
2917 }
2918
2919 if ( mHdrInfo.recvd_frame[i] != NULL) {
2920 free( mHdrInfo.recvd_frame[i]);
2921 mHdrInfo.recvd_frame[i] = NULL;
2922 }
2923 }
2924 }
2925
2926 if (mHdrInfo.recvd_frame[1]) {
2927 cam_evt_buf_done(mCameraId, mHdrInfo.recvd_frame[1]);
2928 free( mHdrInfo.recvd_frame[1]);
2929 mHdrInfo.recvd_frame[1] = NULL;
2930 }
2931 }
2932
setSnapJpegCbState(bool state)2933 void QCameraStream_Snapshot::setSnapJpegCbState(bool state)
2934 {
2935 ALOGE("%s: mSnapJpegCbRunning=%d. ", __func__, mHalCamCtrl->mSnapJpegCbRunning);
2936 mHalCamCtrl->mSnapJpegCbLock.lock();
2937 mHalCamCtrl->mSnapJpegCbRunning = state;
2938 if(state==false)
2939 mHalCamCtrl->mSnapJpegCbWait.signal();
2940 mHalCamCtrl->mSnapJpegCbLock.unlock();
2941 }
2942
getSnapJpegCbState()2943 bool QCameraStream_Snapshot::getSnapJpegCbState()
2944 {
2945 return mHalCamCtrl->mSnapJpegCbRunning;
2946 }
2947
2948 }; // namespace android
2949
2950