blob: c8f94e5ffb1875290b8f4ea1b01470a579cce59f [file] [log] [blame]
Priya Komarlingamb85535d2009-11-30 13:06:01 -08001/*
2** Copyright 2008, Google Inc.
Nishant Panditc8c1ee72009-12-03 16:24:02 +05303** Copyright (c) 2009, Code Aurora Forum. All rights reserved.
Priya Komarlingamb85535d2009-11-30 13:06:01 -08004**
5** Licensed under the Apache License, Version 2.0 (the "License");
6** you may not use this file except in compliance with the License.
7** You may obtain a copy of the License at
8**
9** http://www.apache.org/licenses/LICENSE-2.0
10**
11** Unless required by applicable law or agreed to in writing, software
12** distributed under the License is distributed on an "AS IS" BASIS,
13** WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
14** See the License for the specific language governing permissions and
15** limitations under the License.
16*/
17
18//#define LOG_NDEBUG 0
19#define LOG_TAG "QualcommCameraHardware"
20#include <utils/Log.h>
21
22#include "QualcommCameraHardware.h"
23
24#include <utils/Errors.h>
25#include <utils/threads.h>
26#include <binder/MemoryHeapPmem.h>
27#include <utils/String16.h>
28#include <sys/types.h>
29#include <sys/stat.h>
30#include <unistd.h>
Sravankb4f5f1c2010-01-21 11:06:17 +053031#include <fcntl.h>
Apurva Rajguru8d1773b2009-12-02 14:21:23 -080032#include <cutils/properties.h>
Apurva Rajguru66bdd7f2009-12-10 19:28:02 -080033#include <math.h>
Priya Komarlingamb85535d2009-11-30 13:06:01 -080034#if HAVE_ANDROID_OS
35#include <linux/android_pmem.h>
36#endif
37#include <linux/ioctl.h>
38#include <ui/CameraParameters.h>
39
Mohan Kandra284966d2010-01-05 13:39:15 -080040#include "linux/msm_mdp.h"
41#include <linux/fb.h>
42
Priya Komarlingamb85535d2009-11-30 13:06:01 -080043#define LIKELY(exp) __builtin_expect(!!(exp), 1)
44#define UNLIKELY(exp) __builtin_expect(!!(exp), 0)
45
46extern "C" {
47#include <fcntl.h>
48#include <time.h>
49#include <pthread.h>
50#include <stdio.h>
51#include <string.h>
52#include <unistd.h>
53#include <termios.h>
54#include <assert.h>
55#include <stdlib.h>
56#include <ctype.h>
57#include <signal.h>
58#include <errno.h>
59#include <sys/mman.h>
60#include <sys/system_properties.h>
61#include <sys/time.h>
62#include <stdlib.h>
63
64#include <media/msm_camera.h>
65
66#include <camera.h>
67#include <camframe.h>
68#include <mm-still/jpeg/jpege.h>
Apurva Rajguru66bdd7f2009-12-10 19:28:02 -080069#include <jpeg_encoder.h>
Priya Komarlingamb85535d2009-11-30 13:06:01 -080070
Srinivasan Kannan3b9e8df2009-12-05 12:21:46 -080071#define DEFAULT_PICTURE_WIDTH 1024
72#define DEFAULT_PICTURE_HEIGHT 768
Priya Komarlingamb85535d2009-11-30 13:06:01 -080073#define THUMBNAIL_BUFFER_SIZE (THUMBNAIL_WIDTH * THUMBNAIL_HEIGHT * 3/2)
74#define MAX_ZOOM_LEVEL 5
75#define NOT_FOUND -1
76
Sravankb4f5f1c2010-01-21 11:06:17 +053077// Number of video buffers held by kernal (initially 1,2 &3)
78#define ACTIVE_VIDEO_BUFFERS 3
79
Priya Komarlingamb85535d2009-11-30 13:06:01 -080080#if DLOPEN_LIBMMCAMERA
81#include <dlfcn.h>
82
83void* (*LINK_cam_conf)(void *data);
84void* (*LINK_cam_frame)(void *data);
85bool (*LINK_jpeg_encoder_init)();
86void (*LINK_jpeg_encoder_join)();
87bool (*LINK_jpeg_encoder_encode)(const cam_ctrl_dimension_t *dimen,
88 const uint8_t *thumbnailbuf, int thumbnailfd,
89 const uint8_t *snapshotbuf, int snapshotfd,
Apurva Rajguru66bdd7f2009-12-10 19:28:02 -080090 common_crop_t *scaling_parms, exif_tags_info_t *exif_data,
91 int exif_table_numEntries);
Priya Komarlingamb85535d2009-11-30 13:06:01 -080092int (*LINK_camframe_terminate)(void);
Sravankb4f5f1c2010-01-21 11:06:17 +053093//for 720p
94// Function to add a video buffer to free Q
95void (*LINK_camframe_free_video)(struct msm_frame *frame);
96// Function pointer , called by camframe when a video frame is available.
97void (**LINK_camframe_video_callback)(struct msm_frame * frame);
98// To flush free Q in cam frame.
99void (*LINK_cam_frame_flush_free_video)(void);
100
Priya Komarlingamb85535d2009-11-30 13:06:01 -0800101int8_t (*LINK_jpeg_encoder_setMainImageQuality)(uint32_t quality);
102int8_t (*LINK_jpeg_encoder_setThumbnailQuality)(uint32_t quality);
103int8_t (*LINK_jpeg_encoder_setRotation)(uint32_t rotation);
104int8_t (*LINK_jpeg_encoder_setLocation)(const camera_position_type *location);
105const struct camera_size_type *(*LINK_default_sensor_get_snapshot_sizes)(int *len);
106int (*LINK_launch_cam_conf_thread)(void);
107int (*LINK_release_cam_conf_thread)(void);
108int8_t (*LINK_zoom_crop_upscale)(uint32_t width, uint32_t height,
109 uint32_t cropped_width, uint32_t cropped_height, uint8_t *img_buf);
110
111// callbacks
112void (**LINK_mmcamera_camframe_callback)(struct msm_frame *frame);
113void (**LINK_mmcamera_jpegfragment_callback)(uint8_t *buff_ptr,
114 uint32_t buff_size);
115void (**LINK_mmcamera_jpeg_callback)(jpeg_event_t status);
116void (**LINK_mmcamera_shutter_callback)(common_crop_t *crop);
Kiran Kumar H N215cac42009-12-08 01:53:46 -0800117void (**LINK_camframe_timeout_callback)(void);
Priya Komarlingamb85535d2009-11-30 13:06:01 -0800118#else
119#define LINK_cam_conf cam_conf
120#define LINK_cam_frame cam_frame
121#define LINK_jpeg_encoder_init jpeg_encoder_init
122#define LINK_jpeg_encoder_join jpeg_encoder_join
123#define LINK_jpeg_encoder_encode jpeg_encoder_encode
124#define LINK_camframe_terminate camframe_terminate
125#define LINK_jpeg_encoder_setMainImageQuality jpeg_encoder_setMainImageQuality
126#define LINK_jpeg_encoder_setThumbnailQuality jpeg_encoder_setThumbnailQuality
127#define LINK_jpeg_encoder_setRotation jpeg_encoder_setRotation
128#define LINK_jpeg_encoder_setLocation jpeg_encoder_setLocation
129#define LINK_default_sensor_get_snapshot_sizes default_sensor_get_snapshot_sizes
130#define LINK_launch_cam_conf_thread launch_cam_conf_thread
131#define LINK_release_cam_conf_thread release_cam_conf_thread
132#define LINK_zoom_crop_upscale zoom_crop_upscale
133extern void (*mmcamera_camframe_callback)(struct msm_frame *frame);
134extern void (*mmcamera_jpegfragment_callback)(uint8_t *buff_ptr,
135 uint32_t buff_size);
136extern void (*mmcamera_jpeg_callback)(jpeg_event_t status);
137extern void (*mmcamera_shutter_callback)(common_crop_t *crop);
138#endif
139
140} // extern "C"
141
142#ifndef HAVE_CAMERA_SIZE_TYPE
143struct camera_size_type {
144 int width;
145 int height;
146};
147#endif
148
Kiran Kumar H N326cc4c2010-01-08 12:29:26 -0800149typedef struct crop_info_struct {
150 uint32_t x;
151 uint32_t y;
152 uint32_t w;
153 uint32_t h;
154} zoom_crop_info;
155
Mohan Kandra740cfce2010-01-07 12:58:24 -0800156union zoomimage
Mohan Kandra284966d2010-01-05 13:39:15 -0800157{
158 char d[sizeof(struct mdp_blit_req_list) + sizeof(struct mdp_blit_req) * 1];
159 struct mdp_blit_req_list list;
160} zoomImage;
161
Srinivasan Kannan3b9e8df2009-12-05 12:21:46 -0800162//Default to WVGA
Srinivasan Kannanfa7edae2009-12-16 18:02:01 -0800163#define DEFAULT_PREVIEW_SETTING 1
Priya Komarlingamb85535d2009-11-30 13:06:01 -0800164static const camera_size_type preview_sizes[] = {
Srinivasan Kannanfa7edae2009-12-16 18:02:01 -0800165 { 1280, 720 }, // 720P, reserved
Priya Komarlingamb85535d2009-11-30 13:06:01 -0800166 { 800, 480 }, // WVGA
167 { 720, 480 },
168 { 640, 480 }, // VGA
169 { 576, 432 },
170 { 480, 320 }, // HVGA
171 { 384, 288 },
172 { 352, 288 }, // CIF
173 { 320, 240 }, // QVGA
174 { 240, 160 }, // SQVGA
175 { 176, 144 }, // QCIF
176};
177#define PREVIEW_SIZE_COUNT (sizeof(preview_sizes)/sizeof(camera_size_type))
178
Apurva Rajguru1db0c392009-11-30 21:39:04 -0800179//static const camera_size_type* picture_sizes;
180//static int PICTURE_SIZE_COUNT;
181/* TODO
182 * Ideally this should be a populated by lower layers.
183 * But currently this is no API to do that at lower layer.
184 * Hence populating with default sizes for now. This needs
185 * to be changed once the API is supported.
186 */
Srinivasan Kannan3b9e8df2009-12-05 12:21:46 -0800187//sorted on column basis
Apurva Rajguru1db0c392009-11-30 21:39:04 -0800188static const camera_size_type picture_sizes[] = {
189 { 2592, 1944 }, // 5MP
Srinivasan Kannan3b9e8df2009-12-05 12:21:46 -0800190 { 2048, 1536 }, // 3MP QXGA
191 { 1920, 1080 }, //HD1080
192 { 1600, 1200 }, // 2MP UXGA
193 { 1280, 768 }, //WXGA
194 { 1280, 720 }, //HD720
195 { 1024, 768}, // 1MP XGA
196 { 800, 600 }, //SVGA
Apurva Rajguru1db0c392009-11-30 21:39:04 -0800197 { 800, 480 }, // WVGA
198 { 640, 480 }, // VGA
Srinivasan Kannan3b9e8df2009-12-05 12:21:46 -0800199 { 352, 288 }, //CIF
200 { 320, 240 }, // QVGA
201 { 176, 144 } // QCIF
Apurva Rajguru1db0c392009-11-30 21:39:04 -0800202};
203static int PICTURE_SIZE_COUNT = sizeof(picture_sizes)/sizeof(camera_size_type);
Srinivasan Kannan3b9e8df2009-12-05 12:21:46 -0800204static const camera_size_type * picture_sizes_ptr;
205static int supportedPictureSizesCount;
Priya Komarlingamb85535d2009-11-30 13:06:01 -0800206
Srinivasan Kannan80d878f2009-12-18 15:06:02 -0800207#ifdef Q12
208#undef Q12
209#endif
210
211#define Q12 4096
212
Kiran Kumar H N8ff7b982010-01-25 13:54:39 -0800213static const target_map targetList [] = {
214 { "msm7625", TARGET_MSM7625 },
215 { "msm7627", TARGET_MSM7627 },
216 { "qsd8250", TARGET_QSD8250 },
217 { "msm7630", TARGET_MSM7630 }
218};
219static targetType mCurrentTarget = TARGET_MAX;
220
Srinivasan Kannan80d878f2009-12-18 15:06:02 -0800221typedef struct {
222 uint32_t aspect_ratio;
223 uint32_t width;
224 uint32_t height;
225} thumbnail_size_type;
226
227static thumbnail_size_type thumbnail_sizes[] = {
228 { 7281, 512, 288 }, //1.777778
229 { 6826, 480, 288 }, //1.666667
230 { 5461, 512, 384 }, //1.333333
231 { 5006, 352, 288 }, //1.222222
232};
233#define THUMBNAIL_SIZE_COUNT (sizeof(thumbnail_sizes)/sizeof(thumbnail_size_type))
234#define DEFAULT_THUMBNAIL_SETTING 2
235#define THUMBNAIL_WIDTH_STR "512"
236#define THUMBNAIL_HEIGHT_STR "384"
237#define THUMBNAIL_SMALL_HEIGHT 144
238
Priya Komarlingamb85535d2009-11-30 13:06:01 -0800239static int attr_lookup(const str_map arr[], int len, const char *name)
240{
241 if (name) {
242 for (int i = 0; i < len; i++) {
243 if (!strcmp(arr[i].desc, name))
244 return arr[i].val;
245 }
246 }
247 return NOT_FOUND;
248}
249
250// round to the next power of two
251static inline unsigned clp2(unsigned x)
252{
253 x = x - 1;
254 x = x | (x >> 1);
255 x = x | (x >> 2);
256 x = x | (x >> 4);
257 x = x | (x >> 8);
258 x = x | (x >>16);
259 return x + 1;
260}
261
Apurva Rajguru66bdd7f2009-12-10 19:28:02 -0800262static int exif_table_numEntries = 0;
263#define MAX_EXIF_TABLE_ENTRIES 7
264exif_tags_info_t exif_data[MAX_EXIF_TABLE_ENTRIES];
Kiran Kumar H N326cc4c2010-01-08 12:29:26 -0800265static zoom_crop_info zoomCropInfo;
266static void *mLastQueuedFrame = NULL;
Apurva Rajguru66bdd7f2009-12-10 19:28:02 -0800267
Priya Komarlingamb85535d2009-11-30 13:06:01 -0800268namespace android {
Srinivasan Kannan39dae8e2009-12-03 15:52:34 -0800269
270static const int PICTURE_FORMAT_JPEG = 1;
271static const int PICTURE_FORMAT_RAW = 2;
272
Priya Komarlingamb85535d2009-11-30 13:06:01 -0800273// from aeecamera.h
274static const str_map whitebalance[] = {
275 { CameraParameters::WHITE_BALANCE_AUTO, CAMERA_WB_AUTO },
276 { CameraParameters::WHITE_BALANCE_INCANDESCENT, CAMERA_WB_INCANDESCENT },
277 { CameraParameters::WHITE_BALANCE_FLUORESCENT, CAMERA_WB_FLUORESCENT },
278 { CameraParameters::WHITE_BALANCE_DAYLIGHT, CAMERA_WB_DAYLIGHT },
279 { CameraParameters::WHITE_BALANCE_CLOUDY_DAYLIGHT, CAMERA_WB_CLOUDY_DAYLIGHT }
280};
281
282// from camera_effect_t. This list must match aeecamera.h
283static const str_map effects[] = {
284 { CameraParameters::EFFECT_NONE, CAMERA_EFFECT_OFF },
285 { CameraParameters::EFFECT_MONO, CAMERA_EFFECT_MONO },
286 { CameraParameters::EFFECT_NEGATIVE, CAMERA_EFFECT_NEGATIVE },
287 { CameraParameters::EFFECT_SOLARIZE, CAMERA_EFFECT_SOLARIZE },
288 { CameraParameters::EFFECT_SEPIA, CAMERA_EFFECT_SEPIA },
289 { CameraParameters::EFFECT_POSTERIZE, CAMERA_EFFECT_POSTERIZE },
290 { CameraParameters::EFFECT_WHITEBOARD, CAMERA_EFFECT_WHITEBOARD },
291 { CameraParameters::EFFECT_BLACKBOARD, CAMERA_EFFECT_BLACKBOARD },
292 { CameraParameters::EFFECT_AQUA, CAMERA_EFFECT_AQUA }
293};
294
295// from qcamera/common/camera.h
Apurva Rajguru55562b02009-12-03 12:25:35 -0800296static const str_map autoexposure[] = {
297 { CameraParameters::AUTO_EXPOSURE_FRAME_AVG, CAMERA_AEC_FRAME_AVERAGE },
298 { CameraParameters::AUTO_EXPOSURE_CENTER_WEIGHTED, CAMERA_AEC_CENTER_WEIGHTED },
299 { CameraParameters::AUTO_EXPOSURE_SPOT_METERING, CAMERA_AEC_SPOT_METERING }
300};
301
302// from qcamera/common/camera.h
Priya Komarlingamb85535d2009-11-30 13:06:01 -0800303static const str_map antibanding[] = {
304 { CameraParameters::ANTIBANDING_OFF, CAMERA_ANTIBANDING_OFF },
305 { CameraParameters::ANTIBANDING_50HZ, CAMERA_ANTIBANDING_50HZ },
306 { CameraParameters::ANTIBANDING_60HZ, CAMERA_ANTIBANDING_60HZ },
307 { CameraParameters::ANTIBANDING_AUTO, CAMERA_ANTIBANDING_AUTO }
308};
309
310/* Mapping from MCC to antibanding type */
311struct country_map {
312 uint32_t country_code;
313 camera_antibanding_type type;
314};
315
316static struct country_map country_numeric[] = {
317 { 202, CAMERA_ANTIBANDING_50HZ }, // Greece
318 { 204, CAMERA_ANTIBANDING_50HZ }, // Netherlands
319 { 206, CAMERA_ANTIBANDING_50HZ }, // Belgium
320 { 208, CAMERA_ANTIBANDING_50HZ }, // France
321 { 212, CAMERA_ANTIBANDING_50HZ }, // Monaco
322 { 213, CAMERA_ANTIBANDING_50HZ }, // Andorra
323 { 214, CAMERA_ANTIBANDING_50HZ }, // Spain
324 { 216, CAMERA_ANTIBANDING_50HZ }, // Hungary
325 { 219, CAMERA_ANTIBANDING_50HZ }, // Croatia
326 { 220, CAMERA_ANTIBANDING_50HZ }, // Serbia
327 { 222, CAMERA_ANTIBANDING_50HZ }, // Italy
328 { 226, CAMERA_ANTIBANDING_50HZ }, // Romania
329 { 228, CAMERA_ANTIBANDING_50HZ }, // Switzerland
330 { 230, CAMERA_ANTIBANDING_50HZ }, // Czech Republic
331 { 231, CAMERA_ANTIBANDING_50HZ }, // Slovakia
332 { 232, CAMERA_ANTIBANDING_50HZ }, // Austria
333 { 234, CAMERA_ANTIBANDING_50HZ }, // United Kingdom
334 { 235, CAMERA_ANTIBANDING_50HZ }, // United Kingdom
335 { 238, CAMERA_ANTIBANDING_50HZ }, // Denmark
336 { 240, CAMERA_ANTIBANDING_50HZ }, // Sweden
337 { 242, CAMERA_ANTIBANDING_50HZ }, // Norway
338 { 244, CAMERA_ANTIBANDING_50HZ }, // Finland
339 { 246, CAMERA_ANTIBANDING_50HZ }, // Lithuania
340 { 247, CAMERA_ANTIBANDING_50HZ }, // Latvia
341 { 248, CAMERA_ANTIBANDING_50HZ }, // Estonia
342 { 250, CAMERA_ANTIBANDING_50HZ }, // Russian Federation
343 { 255, CAMERA_ANTIBANDING_50HZ }, // Ukraine
344 { 257, CAMERA_ANTIBANDING_50HZ }, // Belarus
345 { 259, CAMERA_ANTIBANDING_50HZ }, // Moldova
346 { 260, CAMERA_ANTIBANDING_50HZ }, // Poland
347 { 262, CAMERA_ANTIBANDING_50HZ }, // Germany
348 { 266, CAMERA_ANTIBANDING_50HZ }, // Gibraltar
349 { 268, CAMERA_ANTIBANDING_50HZ }, // Portugal
350 { 270, CAMERA_ANTIBANDING_50HZ }, // Luxembourg
351 { 272, CAMERA_ANTIBANDING_50HZ }, // Ireland
352 { 274, CAMERA_ANTIBANDING_50HZ }, // Iceland
353 { 276, CAMERA_ANTIBANDING_50HZ }, // Albania
354 { 278, CAMERA_ANTIBANDING_50HZ }, // Malta
355 { 280, CAMERA_ANTIBANDING_50HZ }, // Cyprus
356 { 282, CAMERA_ANTIBANDING_50HZ }, // Georgia
357 { 283, CAMERA_ANTIBANDING_50HZ }, // Armenia
358 { 284, CAMERA_ANTIBANDING_50HZ }, // Bulgaria
359 { 286, CAMERA_ANTIBANDING_50HZ }, // Turkey
360 { 288, CAMERA_ANTIBANDING_50HZ }, // Faroe Islands
361 { 290, CAMERA_ANTIBANDING_50HZ }, // Greenland
362 { 293, CAMERA_ANTIBANDING_50HZ }, // Slovenia
363 { 294, CAMERA_ANTIBANDING_50HZ }, // Macedonia
364 { 295, CAMERA_ANTIBANDING_50HZ }, // Liechtenstein
365 { 297, CAMERA_ANTIBANDING_50HZ }, // Montenegro
366 { 302, CAMERA_ANTIBANDING_60HZ }, // Canada
367 { 310, CAMERA_ANTIBANDING_60HZ }, // United States of America
368 { 311, CAMERA_ANTIBANDING_60HZ }, // United States of America
369 { 312, CAMERA_ANTIBANDING_60HZ }, // United States of America
370 { 313, CAMERA_ANTIBANDING_60HZ }, // United States of America
371 { 314, CAMERA_ANTIBANDING_60HZ }, // United States of America
372 { 315, CAMERA_ANTIBANDING_60HZ }, // United States of America
373 { 316, CAMERA_ANTIBANDING_60HZ }, // United States of America
374 { 330, CAMERA_ANTIBANDING_60HZ }, // Puerto Rico
375 { 334, CAMERA_ANTIBANDING_60HZ }, // Mexico
376 { 338, CAMERA_ANTIBANDING_50HZ }, // Jamaica
377 { 340, CAMERA_ANTIBANDING_50HZ }, // Martinique
378 { 342, CAMERA_ANTIBANDING_50HZ }, // Barbados
379 { 346, CAMERA_ANTIBANDING_60HZ }, // Cayman Islands
380 { 350, CAMERA_ANTIBANDING_60HZ }, // Bermuda
381 { 352, CAMERA_ANTIBANDING_50HZ }, // Grenada
382 { 354, CAMERA_ANTIBANDING_60HZ }, // Montserrat
383 { 362, CAMERA_ANTIBANDING_50HZ }, // Netherlands Antilles
384 { 363, CAMERA_ANTIBANDING_60HZ }, // Aruba
385 { 364, CAMERA_ANTIBANDING_60HZ }, // Bahamas
386 { 365, CAMERA_ANTIBANDING_60HZ }, // Anguilla
387 { 366, CAMERA_ANTIBANDING_50HZ }, // Dominica
388 { 368, CAMERA_ANTIBANDING_60HZ }, // Cuba
389 { 370, CAMERA_ANTIBANDING_60HZ }, // Dominican Republic
390 { 372, CAMERA_ANTIBANDING_60HZ }, // Haiti
391 { 401, CAMERA_ANTIBANDING_50HZ }, // Kazakhstan
392 { 402, CAMERA_ANTIBANDING_50HZ }, // Bhutan
393 { 404, CAMERA_ANTIBANDING_50HZ }, // India
394 { 405, CAMERA_ANTIBANDING_50HZ }, // India
395 { 410, CAMERA_ANTIBANDING_50HZ }, // Pakistan
396 { 413, CAMERA_ANTIBANDING_50HZ }, // Sri Lanka
397 { 414, CAMERA_ANTIBANDING_50HZ }, // Myanmar
398 { 415, CAMERA_ANTIBANDING_50HZ }, // Lebanon
399 { 416, CAMERA_ANTIBANDING_50HZ }, // Jordan
400 { 417, CAMERA_ANTIBANDING_50HZ }, // Syria
401 { 418, CAMERA_ANTIBANDING_50HZ }, // Iraq
402 { 419, CAMERA_ANTIBANDING_50HZ }, // Kuwait
403 { 420, CAMERA_ANTIBANDING_60HZ }, // Saudi Arabia
404 { 421, CAMERA_ANTIBANDING_50HZ }, // Yemen
405 { 422, CAMERA_ANTIBANDING_50HZ }, // Oman
406 { 424, CAMERA_ANTIBANDING_50HZ }, // United Arab Emirates
407 { 425, CAMERA_ANTIBANDING_50HZ }, // Israel
408 { 426, CAMERA_ANTIBANDING_50HZ }, // Bahrain
409 { 427, CAMERA_ANTIBANDING_50HZ }, // Qatar
410 { 428, CAMERA_ANTIBANDING_50HZ }, // Mongolia
411 { 429, CAMERA_ANTIBANDING_50HZ }, // Nepal
412 { 430, CAMERA_ANTIBANDING_50HZ }, // United Arab Emirates
413 { 431, CAMERA_ANTIBANDING_50HZ }, // United Arab Emirates
414 { 432, CAMERA_ANTIBANDING_50HZ }, // Iran
415 { 434, CAMERA_ANTIBANDING_50HZ }, // Uzbekistan
416 { 436, CAMERA_ANTIBANDING_50HZ }, // Tajikistan
417 { 437, CAMERA_ANTIBANDING_50HZ }, // Kyrgyz Rep
418 { 438, CAMERA_ANTIBANDING_50HZ }, // Turkmenistan
419 { 440, CAMERA_ANTIBANDING_60HZ }, // Japan
420 { 441, CAMERA_ANTIBANDING_60HZ }, // Japan
421 { 452, CAMERA_ANTIBANDING_50HZ }, // Vietnam
422 { 454, CAMERA_ANTIBANDING_50HZ }, // Hong Kong
423 { 455, CAMERA_ANTIBANDING_50HZ }, // Macao
424 { 456, CAMERA_ANTIBANDING_50HZ }, // Cambodia
425 { 457, CAMERA_ANTIBANDING_50HZ }, // Laos
426 { 460, CAMERA_ANTIBANDING_50HZ }, // China
427 { 466, CAMERA_ANTIBANDING_60HZ }, // Taiwan
428 { 470, CAMERA_ANTIBANDING_50HZ }, // Bangladesh
429 { 472, CAMERA_ANTIBANDING_50HZ }, // Maldives
430 { 502, CAMERA_ANTIBANDING_50HZ }, // Malaysia
431 { 505, CAMERA_ANTIBANDING_50HZ }, // Australia
432 { 510, CAMERA_ANTIBANDING_50HZ }, // Indonesia
433 { 514, CAMERA_ANTIBANDING_50HZ }, // East Timor
434 { 515, CAMERA_ANTIBANDING_60HZ }, // Philippines
435 { 520, CAMERA_ANTIBANDING_50HZ }, // Thailand
436 { 525, CAMERA_ANTIBANDING_50HZ }, // Singapore
437 { 530, CAMERA_ANTIBANDING_50HZ }, // New Zealand
438 { 535, CAMERA_ANTIBANDING_60HZ }, // Guam
439 { 536, CAMERA_ANTIBANDING_50HZ }, // Nauru
440 { 537, CAMERA_ANTIBANDING_50HZ }, // Papua New Guinea
441 { 539, CAMERA_ANTIBANDING_50HZ }, // Tonga
442 { 541, CAMERA_ANTIBANDING_50HZ }, // Vanuatu
443 { 542, CAMERA_ANTIBANDING_50HZ }, // Fiji
444 { 544, CAMERA_ANTIBANDING_60HZ }, // American Samoa
445 { 545, CAMERA_ANTIBANDING_50HZ }, // Kiribati
446 { 546, CAMERA_ANTIBANDING_50HZ }, // New Caledonia
447 { 548, CAMERA_ANTIBANDING_50HZ }, // Cook Islands
448 { 602, CAMERA_ANTIBANDING_50HZ }, // Egypt
449 { 603, CAMERA_ANTIBANDING_50HZ }, // Algeria
450 { 604, CAMERA_ANTIBANDING_50HZ }, // Morocco
451 { 605, CAMERA_ANTIBANDING_50HZ }, // Tunisia
452 { 606, CAMERA_ANTIBANDING_50HZ }, // Libya
453 { 607, CAMERA_ANTIBANDING_50HZ }, // Gambia
454 { 608, CAMERA_ANTIBANDING_50HZ }, // Senegal
455 { 609, CAMERA_ANTIBANDING_50HZ }, // Mauritania
456 { 610, CAMERA_ANTIBANDING_50HZ }, // Mali
457 { 611, CAMERA_ANTIBANDING_50HZ }, // Guinea
458 { 613, CAMERA_ANTIBANDING_50HZ }, // Burkina Faso
459 { 614, CAMERA_ANTIBANDING_50HZ }, // Niger
460 { 616, CAMERA_ANTIBANDING_50HZ }, // Benin
461 { 617, CAMERA_ANTIBANDING_50HZ }, // Mauritius
462 { 618, CAMERA_ANTIBANDING_50HZ }, // Liberia
463 { 619, CAMERA_ANTIBANDING_50HZ }, // Sierra Leone
464 { 620, CAMERA_ANTIBANDING_50HZ }, // Ghana
465 { 621, CAMERA_ANTIBANDING_50HZ }, // Nigeria
466 { 622, CAMERA_ANTIBANDING_50HZ }, // Chad
467 { 623, CAMERA_ANTIBANDING_50HZ }, // Central African Republic
468 { 624, CAMERA_ANTIBANDING_50HZ }, // Cameroon
469 { 625, CAMERA_ANTIBANDING_50HZ }, // Cape Verde
470 { 627, CAMERA_ANTIBANDING_50HZ }, // Equatorial Guinea
471 { 631, CAMERA_ANTIBANDING_50HZ }, // Angola
472 { 633, CAMERA_ANTIBANDING_50HZ }, // Seychelles
473 { 634, CAMERA_ANTIBANDING_50HZ }, // Sudan
474 { 636, CAMERA_ANTIBANDING_50HZ }, // Ethiopia
475 { 637, CAMERA_ANTIBANDING_50HZ }, // Somalia
476 { 638, CAMERA_ANTIBANDING_50HZ }, // Djibouti
477 { 639, CAMERA_ANTIBANDING_50HZ }, // Kenya
478 { 640, CAMERA_ANTIBANDING_50HZ }, // Tanzania
479 { 641, CAMERA_ANTIBANDING_50HZ }, // Uganda
480 { 642, CAMERA_ANTIBANDING_50HZ }, // Burundi
481 { 643, CAMERA_ANTIBANDING_50HZ }, // Mozambique
482 { 645, CAMERA_ANTIBANDING_50HZ }, // Zambia
483 { 646, CAMERA_ANTIBANDING_50HZ }, // Madagascar
484 { 647, CAMERA_ANTIBANDING_50HZ }, // France
485 { 648, CAMERA_ANTIBANDING_50HZ }, // Zimbabwe
486 { 649, CAMERA_ANTIBANDING_50HZ }, // Namibia
487 { 650, CAMERA_ANTIBANDING_50HZ }, // Malawi
488 { 651, CAMERA_ANTIBANDING_50HZ }, // Lesotho
489 { 652, CAMERA_ANTIBANDING_50HZ }, // Botswana
490 { 653, CAMERA_ANTIBANDING_50HZ }, // Swaziland
491 { 654, CAMERA_ANTIBANDING_50HZ }, // Comoros
492 { 655, CAMERA_ANTIBANDING_50HZ }, // South Africa
493 { 657, CAMERA_ANTIBANDING_50HZ }, // Eritrea
494 { 702, CAMERA_ANTIBANDING_60HZ }, // Belize
495 { 704, CAMERA_ANTIBANDING_60HZ }, // Guatemala
496 { 706, CAMERA_ANTIBANDING_60HZ }, // El Salvador
497 { 708, CAMERA_ANTIBANDING_60HZ }, // Honduras
498 { 710, CAMERA_ANTIBANDING_60HZ }, // Nicaragua
499 { 712, CAMERA_ANTIBANDING_60HZ }, // Costa Rica
500 { 714, CAMERA_ANTIBANDING_60HZ }, // Panama
501 { 722, CAMERA_ANTIBANDING_50HZ }, // Argentina
502 { 724, CAMERA_ANTIBANDING_60HZ }, // Brazil
503 { 730, CAMERA_ANTIBANDING_50HZ }, // Chile
504 { 732, CAMERA_ANTIBANDING_60HZ }, // Colombia
505 { 734, CAMERA_ANTIBANDING_60HZ }, // Venezuela
506 { 736, CAMERA_ANTIBANDING_50HZ }, // Bolivia
507 { 738, CAMERA_ANTIBANDING_60HZ }, // Guyana
508 { 740, CAMERA_ANTIBANDING_60HZ }, // Ecuador
509 { 742, CAMERA_ANTIBANDING_50HZ }, // French Guiana
510 { 744, CAMERA_ANTIBANDING_50HZ }, // Paraguay
511 { 746, CAMERA_ANTIBANDING_60HZ }, // Suriname
512 { 748, CAMERA_ANTIBANDING_50HZ }, // Uruguay
513 { 750, CAMERA_ANTIBANDING_50HZ }, // Falkland Islands
514};
515
516#define country_number (sizeof(country_numeric) / sizeof(country_map))
517
518/* Look up pre-sorted antibanding_type table by current MCC. */
519static camera_antibanding_type camera_get_location(void) {
520 char value[PROP_VALUE_MAX];
521 char country_value[PROP_VALUE_MAX];
522 uint32_t country_code, count;
523 memset(value, 0x00, sizeof(value));
524 memset(country_value, 0x00, sizeof(country_value));
525 if (!__system_property_get("gsm.operator.numeric", value)) {
526 return CAMERA_ANTIBANDING_60HZ;
527 }
528 memcpy(country_value, value, 3);
529 country_code = atoi(country_value);
530 LOGD("value:%s, country value:%s, country code:%d\n",
531 value, country_value, country_code);
532 int left = 0;
533 int right = country_number - 1;
534 while (left <= right) {
535 int index = (left + right) >> 1;
536 if (country_numeric[index].country_code == country_code)
537 return country_numeric[index].type;
538 else if (country_numeric[index].country_code > country_code)
539 right = index - 1;
540 else
541 left = index + 1;
542 }
543 return CAMERA_ANTIBANDING_60HZ;
544}
545
546// from camera.h, led_mode_t
547static const str_map flash[] = {
548 { CameraParameters::FLASH_MODE_OFF, LED_MODE_OFF },
549 { CameraParameters::FLASH_MODE_AUTO, LED_MODE_AUTO },
550 { CameraParameters::FLASH_MODE_ON, LED_MODE_ON }
551};
552
Nishant Panditc8c1ee72009-12-03 16:24:02 +0530553// from mm-camera/common/camera.h.
554static const str_map iso[] = {
555 { CameraParameters::ISO_AUTO, CAMERA_ISO_AUTO},
556 { CameraParameters::ISO_HJR, CAMERA_ISO_DEBLUR},
557 { CameraParameters::ISO_100, CAMERA_ISO_100},
558 { CameraParameters::ISO_200, CAMERA_ISO_200},
559 { CameraParameters::ISO_400, CAMERA_ISO_400},
560 { CameraParameters::ISO_800, CAMERA_ISO_800 }
561};
562
563
Priya Komarlingamb85535d2009-11-30 13:06:01 -0800564#define DONT_CARE 0
565static const str_map focus_modes[] = {
Srinivasan Kannan71229622009-12-04 12:05:58 -0800566 { CameraParameters::FOCUS_MODE_AUTO, AF_MODE_AUTO},
567 { CameraParameters::FOCUS_MODE_INFINITY, DONT_CARE },
568 { CameraParameters::FOCUS_MODE_NORMAL, AF_MODE_NORMAL },
569 { CameraParameters::FOCUS_MODE_MACRO, AF_MODE_MACRO }
Priya Komarlingamb85535d2009-11-30 13:06:01 -0800570};
571
Nishant Panditc8c1ee72009-12-03 16:24:02 +0530572static const str_map lensshade[] = {
573 { CameraParameters::LENSSHADE_ENABLE, TRUE },
574 { CameraParameters::LENSSHADE_DISABLE, FALSE }
575};
576
Srinivasan Kannan71229622009-12-04 12:05:58 -0800577struct SensorType {
578 const char *name;
579 int rawPictureWidth;
580 int rawPictureHeight;
581 bool hasAutoFocusSupport;
Srinivasan Kannan3b9e8df2009-12-05 12:21:46 -0800582 int max_supported_snapshot_width;
583 int max_supported_snapshot_height;
Srinivasan Kannan71229622009-12-04 12:05:58 -0800584};
585
586static SensorType sensorTypes[] = {
Srinivasan Kannan3b9e8df2009-12-05 12:21:46 -0800587 { "5mp", 2608, 1960, true, 2592, 1944 },
588 { "3mp", 2064, 1544, false, 2048, 1536 },
589 { "2mp", 3200, 1200, false, 1600, 1200 } };
590
Srinivasan Kannan71229622009-12-04 12:05:58 -0800591
592static SensorType * sensorType;
593
Srinivasan Kannan39dae8e2009-12-03 15:52:34 -0800594static const str_map picture_formats[] = {
595 {CameraParameters::PIXEL_FORMAT_JPEG, PICTURE_FORMAT_JPEG},
596 {CameraParameters::PIXEL_FORMAT_RAW, PICTURE_FORMAT_RAW}
597};
598
Priya Komarlingamb85535d2009-11-30 13:06:01 -0800599static bool parameter_string_initialized = false;
600static String8 preview_size_values;
601static String8 picture_size_values;
602static String8 antibanding_values;
603static String8 effect_values;
Apurva Rajguru55562b02009-12-03 12:25:35 -0800604static String8 autoexposure_values;
Priya Komarlingamb85535d2009-11-30 13:06:01 -0800605static String8 whitebalance_values;
606static String8 flash_values;
607static String8 focus_mode_values;
Nishant Panditc8c1ee72009-12-03 16:24:02 +0530608static String8 iso_values;
609static String8 lensshade_values;
Srinivasan Kannan39dae8e2009-12-03 15:52:34 -0800610static String8 picture_format_values;
611
Priya Komarlingamb85535d2009-11-30 13:06:01 -0800612
613static String8 create_sizes_str(const camera_size_type *sizes, int len) {
614 String8 str;
615 char buffer[32];
616
617 if (len > 0) {
618 sprintf(buffer, "%dx%d", sizes[0].width, sizes[0].height);
619 str.append(buffer);
620 }
621 for (int i = 1; i < len; i++) {
622 sprintf(buffer, ",%dx%d", sizes[i].width, sizes[i].height);
623 str.append(buffer);
624 }
625 return str;
626}
627
628static String8 create_values_str(const str_map *values, int len) {
629 String8 str;
630
631 if (len > 0) {
632 str.append(values[0].desc);
633 }
634 for (int i = 1; i < len; i++) {
635 str.append(",");
636 str.append(values[i].desc);
637 }
638 return str;
639}
640
Sravankb4f5f1c2010-01-21 11:06:17 +0530641extern "C" {
642//------------------------------------------------------------------------
643// : 720p busyQ funcitons
644// --------------------------------------------------------------------
645static struct fifo_queue g_busy_frame_queue =
646 {0, 0, 0, PTHREAD_MUTEX_INITIALIZER, PTHREAD_COND_INITIALIZER};
647};
648/*===========================================================================
649 * FUNCTION cam_frame_wait_video
650 *
651 * DESCRIPTION this function waits a video in the busy queue
652 * ===========================================================================*/
653
654static void cam_frame_wait_video (void)
655{
656 LOGV("cam_frame_wait_video E ");
657 if ((g_busy_frame_queue.num_of_frames) <=0){
658 pthread_cond_wait(&(g_busy_frame_queue.wait), &(g_busy_frame_queue.mut));
659 }
660 LOGV("cam_frame_wait_video X");
661 return;
662}
663
664/*===========================================================================
665 * FUNCTION cam_frame_flush_video
666 *
667 * DESCRIPTION this function deletes all the buffers in busy queue
668 * ===========================================================================*/
669void cam_frame_flush_video (void)
670{
671 LOGV("cam_frame_flush_video: in n = %d\n", g_busy_frame_queue.num_of_frames);
672 pthread_mutex_lock(&(g_busy_frame_queue.mut));
673
674 while (g_busy_frame_queue.front)
675 {
676 //dequeue from the busy queue
677 struct fifo_node *node = dequeue (&g_busy_frame_queue);
678 if(node)
679 free(node);
680
681 LOGV("cam_frame_flush_video: node \n");
682 }
683 pthread_mutex_unlock(&(g_busy_frame_queue.mut));
684 LOGV("cam_frame_flush_video: out n = %d\n", g_busy_frame_queue.num_of_frames);
685 return ;
686}
687/*===========================================================================
688 * FUNCTION cam_frame_get_video
689 *
690 * DESCRIPTION this function returns a video frame from the head
691 * ===========================================================================*/
692static struct msm_frame * cam_frame_get_video()
693{
694 struct msm_frame *p = NULL;
695 LOGV("cam_frame_get_video... in\n");
696 LOGV("cam_frame_get_video... got lock\n");
697 if (g_busy_frame_queue.front)
698 {
699 //dequeue
700 struct fifo_node *node = dequeue (&g_busy_frame_queue);
701 if (node)
702 {
703 p = (struct msm_frame *)node->f;
704 free (node);
705 }
706 LOGV("cam_frame_get_video... out = %x\n", p->buffer);
707 }
708 return p;
709}
710
711/*===========================================================================
712 * FUNCTION cam_frame_post_video
713 *
714 * DESCRIPTION this function add a busy video frame to the busy queue tails
715 * ===========================================================================*/
716static void cam_frame_post_video (struct msm_frame *p)
717{
718 if (!p)
719 {
720 LOGE("post video , buffer is null");
721 return;
722 }
723 LOGV("cam_frame_post_video... in = %x\n", (unsigned int)(p->buffer));
724 pthread_mutex_lock(&(g_busy_frame_queue.mut));
725 LOGV("post_video got lock. q count before enQ %d", g_busy_frame_queue.num_of_frames);
726 //enqueue to busy queue
727 struct fifo_node *node = (struct fifo_node *)malloc (sizeof (struct fifo_node));
728 if (node)
729 {
730 LOGV(" post video , enqueing in busy queue");
731 node->f = p;
732 node->next = NULL;
733 enqueue (&g_busy_frame_queue, node);
734 LOGV("post_video got lock. q count after enQ %d", g_busy_frame_queue.num_of_frames);
735 }
736 else
737 {
738 LOGE("cam_frame_post_video error... out of memory\n");
739 }
740
741 pthread_mutex_unlock(&(g_busy_frame_queue.mut));
742 pthread_cond_signal(&(g_busy_frame_queue.wait));
743
744 LOGV("cam_frame_post_video... out = %x\n", p->buffer);
745
746 return;
747}
748
Kiran Kumar H N8ff7b982010-01-25 13:54:39 -0800749void QualcommCameraHardware::storeTargetType(void) {
750 char mDeviceName[PROPERTY_VALUE_MAX];
751 property_get("ro.product.device",mDeviceName," ");
752 mCurrentTarget = TARGET_MAX;
753 for( int i = 0; i < TARGET_MAX ; i++) {
754 if( !strncmp(mDeviceName, targetList[i].targetStr, 7)) {
755 mCurrentTarget = targetList[i].targetEnum;
756 break;
757 }
758 }
759 LOGV(" Storing the current target type as %d ", mCurrentTarget );
760 return;
761}
762
Sravankb4f5f1c2010-01-21 11:06:17 +0530763//-------------------------------------------------------------------------------------
Priya Komarlingamb85535d2009-11-30 13:06:01 -0800764static Mutex singleton_lock;
765static bool singleton_releasing;
766static Condition singleton_wait;
767
768static void receive_camframe_callback(struct msm_frame *frame);
Sravankb4f5f1c2010-01-21 11:06:17 +0530769static void receive_camframe_video_callback(struct msm_frame *frame); // 720p
Priya Komarlingamb85535d2009-11-30 13:06:01 -0800770static void receive_jpeg_fragment_callback(uint8_t *buff_ptr, uint32_t buff_size);
771static void receive_jpeg_callback(jpeg_event_t status);
772static void receive_shutter_callback(common_crop_t *crop);
Kiran Kumar H N215cac42009-12-08 01:53:46 -0800773static void receive_camframetimeout_callback(void);
Mohan Kandra284966d2010-01-05 13:39:15 -0800774static int fb_fd = -1;
775static int32_t mMaxZoom = 0;
776static bool native_get_maxzoom(int camfd, void *pZm);
Priya Komarlingamb85535d2009-11-30 13:06:01 -0800777
Mohan Kandrad9efed92010-01-15 19:08:39 -0800778static int dstOffset = 0;
779
780/* When using MDP zoom, double the preview buffers. The usage of these
781 * buffers is as follows:
782 * 1. As all the buffers comes under a single FD, and at initial registration,
783 * this FD will be passed to surface flinger, surface flinger can have access
784 * to all the buffers when needed.
785 * 2. Only "kPreviewBufferCount" buffers (SrcSet) will be registered with the
786 * camera driver to receive preview frames. The remaining buffers (DstSet),
787 * will be used at HAL and by surface flinger only when crop information
788 * is present in the frame.
789 * 3. When there is no crop information, there will be no call to MDP zoom,
790 * and the buffers in SrcSet will be passed to surface flinger to display.
791 * 4. With crop information present, MDP zoom will be called, and the final
792 * data will be placed in a buffer from DstSet, and this buffer will be given
793 * to surface flinger to display.
794 */
795#define NUM_MORE_BUFS 2
796
Priya Komarlingamb85535d2009-11-30 13:06:01 -0800797QualcommCameraHardware::QualcommCameraHardware()
798 : mParameters(),
799 mCameraRunning(false),
800 mPreviewInitialized(false),
801 mFrameThreadRunning(false),
802 mSnapshotThreadRunning(false),
Srinivasan Kannan39dae8e2009-12-03 15:52:34 -0800803 mSnapshotFormat(0),
Priya Komarlingamb85535d2009-11-30 13:06:01 -0800804 mReleasedRecordingFrame(false),
805 mPreviewFrameSize(0),
806 mRawSize(0),
807 mCameraControlFd(-1),
808 mAutoFocusThreadRunning(false),
809 mAutoFocusFd(-1),
Kiran Kumar H N215cac42009-12-08 01:53:46 -0800810 mBrightness(0),
Priya Komarlingamb85535d2009-11-30 13:06:01 -0800811 mInPreviewCallback(false),
Kiran Kumar H N215cac42009-12-08 01:53:46 -0800812 mUseOverlay(0),
813 mOverlay(0),
Priya Komarlingamb85535d2009-11-30 13:06:01 -0800814 mMsgEnabled(0),
815 mNotifyCallback(0),
816 mDataCallback(0),
817 mDataCallbackTimestamp(0),
Mohan Kandra740cfce2010-01-07 12:58:24 -0800818 mCallbackCookie(0),
819 mDebugFps(0)
Priya Komarlingamb85535d2009-11-30 13:06:01 -0800820{
821 memset(&mDimension, 0, sizeof(mDimension));
822 memset(&mCrop, 0, sizeof(mCrop));
Kiran Kumar H N326cc4c2010-01-08 12:29:26 -0800823 memset(&zoomCropInfo, 0, sizeof(zoom_crop_info));
Kiran Kumar H N8ff7b982010-01-25 13:54:39 -0800824 storeTargetType();
Mohan Kandra740cfce2010-01-07 12:58:24 -0800825 char value[PROPERTY_VALUE_MAX];
826 property_get("persist.debug.sf.showfps", value, "0");
827 mDebugFps = atoi(value);
Kiran Kumar H N8ff7b982010-01-25 13:54:39 -0800828 if( mCurrentTarget == TARGET_MSM7630 )
Sravankb4f5f1c2010-01-21 11:06:17 +0530829 kPreviewBufferCountActual = kPreviewBufferCount;
830 else
831 kPreviewBufferCountActual = kPreviewBufferCount + NUM_MORE_BUFS;
Priya Komarlingamb85535d2009-11-30 13:06:01 -0800832 LOGV("constructor EX");
833}
834
Srinivasan Kannan3b9e8df2009-12-05 12:21:46 -0800835
836//filter Picture sizes based on max width and height
837void QualcommCameraHardware::filterPictureSizes(){
838 int i;
839 for(i=0;i<PICTURE_SIZE_COUNT;i++){
840 if(((picture_sizes[i].width <=
841 sensorType->max_supported_snapshot_width) &&
842 (picture_sizes[i].height <=
843 sensorType->max_supported_snapshot_height))){
844 picture_sizes_ptr = picture_sizes + i;
845 supportedPictureSizesCount = PICTURE_SIZE_COUNT - i ;
846 return ;
847 }
848 }
849}
850
Priya Komarlingamb85535d2009-11-30 13:06:01 -0800851void QualcommCameraHardware::initDefaultParameters()
852{
853 LOGV("initDefaultParameters E");
854
855 // Initialize constant parameter strings. This will happen only once in the
856 // lifetime of the mediaserver process.
857 if (!parameter_string_initialized) {
Srinivasan Kannan71229622009-12-04 12:05:58 -0800858 findSensorType();
Priya Komarlingamb85535d2009-11-30 13:06:01 -0800859 antibanding_values = create_values_str(
860 antibanding, sizeof(antibanding) / sizeof(str_map));
861 effect_values = create_values_str(
862 effects, sizeof(effects) / sizeof(str_map));
Apurva Rajguru55562b02009-12-03 12:25:35 -0800863 autoexposure_values = create_values_str(
864 autoexposure, sizeof(autoexposure) / sizeof(str_map));
Priya Komarlingamb85535d2009-11-30 13:06:01 -0800865 whitebalance_values = create_values_str(
866 whitebalance, sizeof(whitebalance) / sizeof(str_map));
867 preview_size_values = create_sizes_str(
868 preview_sizes, PREVIEW_SIZE_COUNT);
Srinivasan Kannan3b9e8df2009-12-05 12:21:46 -0800869 //filter picture sizes
870 filterPictureSizes();
Priya Komarlingamb85535d2009-11-30 13:06:01 -0800871 picture_size_values = create_sizes_str(
Srinivasan Kannan3b9e8df2009-12-05 12:21:46 -0800872 picture_sizes_ptr, supportedPictureSizesCount);
873
Priya Komarlingamb85535d2009-11-30 13:06:01 -0800874 flash_values = create_values_str(
875 flash, sizeof(flash) / sizeof(str_map));
Srinivasan Kannan71229622009-12-04 12:05:58 -0800876 if(sensorType->hasAutoFocusSupport){
877 focus_mode_values = create_values_str(
878 focus_modes, sizeof(focus_modes) / sizeof(str_map));
879 }
Nishant Panditc8c1ee72009-12-03 16:24:02 +0530880 iso_values = create_values_str(
881 iso,sizeof(iso)/sizeof(str_map));
882 lensshade_values = create_values_str(
883 lensshade,sizeof(lensshade)/sizeof(str_map));
Srinivasan Kannan39dae8e2009-12-03 15:52:34 -0800884 picture_format_values = create_values_str(
885 picture_formats, sizeof(picture_formats)/sizeof(str_map));
Priya Komarlingamb85535d2009-11-30 13:06:01 -0800886 parameter_string_initialized = true;
887 }
888
889 const camera_size_type *ps = &preview_sizes[DEFAULT_PREVIEW_SETTING];
890 mParameters.setPreviewSize(ps->width, ps->height);
891 mDimension.display_width = ps->width;
892 mDimension.display_height = ps->height;
893 mParameters.setPreviewFrameRate(15);
894 mParameters.setPreviewFormat("yuv420sp"); // informative
895
896 mParameters.setPictureSize(DEFAULT_PICTURE_WIDTH, DEFAULT_PICTURE_HEIGHT);
897 mParameters.setPictureFormat("jpeg"); // informative
898
899 mParameters.set(CameraParameters::KEY_JPEG_QUALITY, "100"); // max quality
900 mParameters.set(CameraParameters::KEY_JPEG_THUMBNAIL_WIDTH,
901 THUMBNAIL_WIDTH_STR); // informative
902 mParameters.set(CameraParameters::KEY_JPEG_THUMBNAIL_HEIGHT,
903 THUMBNAIL_HEIGHT_STR); // informative
Srinivasan Kannan80d878f2009-12-18 15:06:02 -0800904 mDimension.ui_thumbnail_width =
905 thumbnail_sizes[DEFAULT_THUMBNAIL_SETTING].width;
906 mDimension.ui_thumbnail_height =
907 thumbnail_sizes[DEFAULT_THUMBNAIL_SETTING].height;
Priya Komarlingamb85535d2009-11-30 13:06:01 -0800908 mParameters.set(CameraParameters::KEY_JPEG_THUMBNAIL_QUALITY, "90");
909
910 mParameters.set(CameraParameters::KEY_ANTIBANDING,
911 CameraParameters::ANTIBANDING_AUTO);
912 mParameters.set(CameraParameters::KEY_EFFECT,
913 CameraParameters::EFFECT_NONE);
Apurva Rajguru55562b02009-12-03 12:25:35 -0800914 mParameters.set(CameraParameters::KEY_AUTO_EXPOSURE,
915 CameraParameters::AUTO_EXPOSURE_FRAME_AVG);
Priya Komarlingamb85535d2009-11-30 13:06:01 -0800916 mParameters.set(CameraParameters::KEY_WHITE_BALANCE,
917 CameraParameters::WHITE_BALANCE_AUTO);
918 mParameters.set(CameraParameters::KEY_FOCUS_MODE,
919 CameraParameters::FOCUS_MODE_AUTO);
Priya Komarlingam044c7b52010-01-22 18:21:23 -0800920 mParameters.set(CameraParameters::KEY_SUPPORTED_PREVIEW_FORMATS,
921 "yuv420sp");
Priya Komarlingamb85535d2009-11-30 13:06:01 -0800922
923 mParameters.set(CameraParameters::KEY_SUPPORTED_PREVIEW_SIZES,
924 preview_size_values.string());
925 mParameters.set(CameraParameters::KEY_SUPPORTED_PICTURE_SIZES,
926 picture_size_values.string());
927 mParameters.set(CameraParameters::KEY_SUPPORTED_ANTIBANDING,
928 antibanding_values);
929 mParameters.set(CameraParameters::KEY_SUPPORTED_EFFECTS, effect_values);
Apurva Rajguru55562b02009-12-03 12:25:35 -0800930 mParameters.set(CameraParameters::KEY_SUPPORTED_AUTO_EXPOSURE, autoexposure_values);
Priya Komarlingamb85535d2009-11-30 13:06:01 -0800931 mParameters.set(CameraParameters::KEY_SUPPORTED_WHITE_BALANCE,
932 whitebalance_values);
933 mParameters.set(CameraParameters::KEY_SUPPORTED_FOCUS_MODES,
934 focus_mode_values);
Srinivasan Kannan39dae8e2009-12-03 15:52:34 -0800935 mParameters.set(CameraParameters::KEY_SUPPORTED_PICTURE_FORMATS,
936 picture_format_values);
Priya Komarlingamb85535d2009-11-30 13:06:01 -0800937
938 if (mSensorInfo.flash_enabled) {
939 mParameters.set(CameraParameters::KEY_FLASH_MODE,
940 CameraParameters::FLASH_MODE_OFF);
941 mParameters.set(CameraParameters::KEY_SUPPORTED_FLASH_MODES,
942 flash_values);
943 }
944
Srinivasan Kannanbddfd502010-01-03 17:27:36 -0800945 mParameters.set(CameraParameters::KEY_MAX_SHARPNESS,
946 CAMERA_MAX_SHARPNESS);
947 mParameters.set(CameraParameters::KEY_MAX_CONTRAST,
948 CAMERA_MAX_CONTRAST);
949 mParameters.set(CameraParameters::KEY_MAX_SATURATION,
950 CAMERA_MAX_SATURATION);
951
Nishant Panditc8c1ee72009-12-03 16:24:02 +0530952 mParameters.set("luma-adaptation", "18");
Priya Komarlingamb85535d2009-11-30 13:06:01 -0800953 mParameters.set("zoom-supported", "true");
954 mParameters.set("max-zoom", MAX_ZOOM_LEVEL);
955 mParameters.set("zoom", 0);
Srinivasan Kannan39dae8e2009-12-03 15:52:34 -0800956 mParameters.set(CameraParameters::KEY_PICTURE_FORMAT,
957 CameraParameters::PIXEL_FORMAT_JPEG);
Priya Komarlingamb85535d2009-11-30 13:06:01 -0800958
Kiran Kumar H N595970b2010-01-12 10:41:09 -0800959 mParameters.set(CameraParameters::KEY_SHARPNESS,
960 CAMERA_DEF_SHARPNESS);
961 mParameters.set(CameraParameters::KEY_CONTRAST,
962 CAMERA_DEF_CONTRAST);
963 mParameters.set(CameraParameters::KEY_SATURATION,
964 CAMERA_DEF_SATURATION);
965
Nishant Panditc8c1ee72009-12-03 16:24:02 +0530966 mParameters.set(CameraParameters::KEY_ISO_MODE,
967 CameraParameters::ISO_AUTO);
968 mParameters.set(CameraParameters::KEY_LENSSHADE,
969 CameraParameters::LENSSHADE_ENABLE);
970 mParameters.set(CameraParameters::KEY_SUPPORTED_ISO_MODES,
971 iso_values);
972 mParameters.set(CameraParameters::KEY_SUPPORTED_LENSSHADE_MODES,
973 lensshade_values);
974
Priya Komarlingamb85535d2009-11-30 13:06:01 -0800975 if (setParameters(mParameters) != NO_ERROR) {
976 LOGE("Failed to set default parameters?!");
977 }
978
Kiran Kumar H N5efb3ff2009-12-07 01:02:44 -0800979 mUseOverlay = useOverlay();
980
Kiran Kumar H N215cac42009-12-08 01:53:46 -0800981 /* Initialize the camframe_timeout_flag*/
982 Mutex::Autolock l(&mCamframeTimeoutLock);
983 camframe_timeout_flag = FALSE;
Kiran Kumar H N326cc4c2010-01-08 12:29:26 -0800984 mPostViewHeap = NULL;
Kiran Kumar H N215cac42009-12-08 01:53:46 -0800985
Priya Komarlingamb85535d2009-11-30 13:06:01 -0800986 LOGV("initDefaultParameters X");
987}
988
Srinivasan Kannan71229622009-12-04 12:05:58 -0800989void QualcommCameraHardware::findSensorType(){
990 mDimension.picture_width = DEFAULT_PICTURE_WIDTH;
991 mDimension.picture_height = DEFAULT_PICTURE_HEIGHT;
992 bool ret = native_set_parm(CAMERA_SET_PARM_DIMENSION,
993 sizeof(cam_ctrl_dimension_t), &mDimension);
994 if (ret) {
995 unsigned int i;
996 for (i = 0; i < sizeof(sensorTypes) / sizeof(SensorType); i++) {
997 if (sensorTypes[i].rawPictureHeight
998 == mDimension.raw_picture_height) {
999 sensorType = sensorTypes + i;
1000 return;
1001 }
1002 }
1003 }
1004 //default to 5 mp
1005 sensorType = sensorTypes;
1006 return;
1007}
1008
Priya Komarlingamb85535d2009-11-30 13:06:01 -08001009#define ROUND_TO_PAGE(x) (((x)+0xfff)&~0xfff)
1010
1011bool QualcommCameraHardware::startCamera()
1012{
1013 LOGV("startCamera E");
Kiran Kumar H N8ff7b982010-01-25 13:54:39 -08001014 if( mCurrentTarget == TARGET_MAX ) {
1015 LOGE(" Unable to determine the target type. Camera will not work ");
1016 return false;
1017 }
Priya Komarlingamb85535d2009-11-30 13:06:01 -08001018#if DLOPEN_LIBMMCAMERA
1019 libmmcamera = ::dlopen("liboemcamera.so", RTLD_NOW);
1020 LOGV("loading liboemcamera at %p", libmmcamera);
1021 if (!libmmcamera) {
1022 LOGE("FATAL ERROR: could not dlopen liboemcamera.so: %s", dlerror());
1023 return false;
1024 }
1025
1026 *(void **)&LINK_cam_frame =
1027 ::dlsym(libmmcamera, "cam_frame");
1028 *(void **)&LINK_camframe_terminate =
1029 ::dlsym(libmmcamera, "camframe_terminate");
1030
1031 *(void **)&LINK_jpeg_encoder_init =
1032 ::dlsym(libmmcamera, "jpeg_encoder_init");
1033
1034 *(void **)&LINK_jpeg_encoder_encode =
1035 ::dlsym(libmmcamera, "jpeg_encoder_encode");
1036
1037 *(void **)&LINK_jpeg_encoder_join =
1038 ::dlsym(libmmcamera, "jpeg_encoder_join");
1039
1040 *(void **)&LINK_mmcamera_camframe_callback =
1041 ::dlsym(libmmcamera, "mmcamera_camframe_callback");
1042
1043 *LINK_mmcamera_camframe_callback = receive_camframe_callback;
1044
1045 *(void **)&LINK_mmcamera_jpegfragment_callback =
1046 ::dlsym(libmmcamera, "mmcamera_jpegfragment_callback");
1047
1048 *LINK_mmcamera_jpegfragment_callback = receive_jpeg_fragment_callback;
1049
1050 *(void **)&LINK_mmcamera_jpeg_callback =
1051 ::dlsym(libmmcamera, "mmcamera_jpeg_callback");
1052
1053 *LINK_mmcamera_jpeg_callback = receive_jpeg_callback;
1054
Kiran Kumar H N215cac42009-12-08 01:53:46 -08001055 *(void **)&LINK_camframe_timeout_callback =
1056 ::dlsym(libmmcamera, "camframe_timeout_callback");
1057
1058 *LINK_camframe_timeout_callback = receive_camframetimeout_callback;
1059
Sravankb4f5f1c2010-01-21 11:06:17 +05301060 // 720 p new recording functions
1061 *(void **)&LINK_cam_frame_flush_free_video = ::dlsym(libmmcamera, "cam_frame_flush_free_video");
1062
1063 *(void **)&LINK_camframe_free_video = ::dlsym(libmmcamera, "cam_frame_add_free_video");
1064
1065 *(void **)&LINK_camframe_video_callback = ::dlsym(libmmcamera, "mmcamera_camframe_videocallback");
1066 *LINK_camframe_video_callback = receive_camframe_video_callback;
Apurva Rajguru1db0c392009-11-30 21:39:04 -08001067/* Disabling until support is available.
Priya Komarlingamb85535d2009-11-30 13:06:01 -08001068 *(void **)&LINK_mmcamera_shutter_callback =
1069 ::dlsym(libmmcamera, "mmcamera_shutter_callback");
1070
1071 *LINK_mmcamera_shutter_callback = receive_shutter_callback;
Apurva Rajguru1db0c392009-11-30 21:39:04 -08001072*/
Priya Komarlingamb85535d2009-11-30 13:06:01 -08001073 *(void**)&LINK_jpeg_encoder_setMainImageQuality =
1074 ::dlsym(libmmcamera, "jpeg_encoder_setMainImageQuality");
Kiran Kumar H N8861f302010-01-05 12:01:41 -08001075
Priya Komarlingamb85535d2009-11-30 13:06:01 -08001076 *(void**)&LINK_jpeg_encoder_setThumbnailQuality =
1077 ::dlsym(libmmcamera, "jpeg_encoder_setThumbnailQuality");
1078
1079 *(void**)&LINK_jpeg_encoder_setRotation =
1080 ::dlsym(libmmcamera, "jpeg_encoder_setRotation");
1081
Kiran Kumar H N8861f302010-01-05 12:01:41 -08001082/* Disabling until support is available.
Priya Komarlingamb85535d2009-11-30 13:06:01 -08001083 *(void**)&LINK_jpeg_encoder_setLocation =
1084 ::dlsym(libmmcamera, "jpeg_encoder_setLocation");
Apurva Rajguru1db0c392009-11-30 21:39:04 -08001085*/
Priya Komarlingamb85535d2009-11-30 13:06:01 -08001086 *(void **)&LINK_cam_conf =
1087 ::dlsym(libmmcamera, "cam_conf");
1088
Apurva Rajguru1db0c392009-11-30 21:39:04 -08001089/* Disabling until support is available.
Priya Komarlingamb85535d2009-11-30 13:06:01 -08001090 *(void **)&LINK_default_sensor_get_snapshot_sizes =
1091 ::dlsym(libmmcamera, "default_sensor_get_snapshot_sizes");
Apurva Rajguru1db0c392009-11-30 21:39:04 -08001092*/
Priya Komarlingamb85535d2009-11-30 13:06:01 -08001093 *(void **)&LINK_launch_cam_conf_thread =
1094 ::dlsym(libmmcamera, "launch_cam_conf_thread");
1095
1096 *(void **)&LINK_release_cam_conf_thread =
1097 ::dlsym(libmmcamera, "release_cam_conf_thread");
1098
Apurva Rajguru1db0c392009-11-30 21:39:04 -08001099/* Disabling until support is available.
Priya Komarlingamb85535d2009-11-30 13:06:01 -08001100 *(void **)&LINK_zoom_crop_upscale =
1101 ::dlsym(libmmcamera, "zoom_crop_upscale");
Apurva Rajguru1db0c392009-11-30 21:39:04 -08001102*/
Priya Komarlingamb85535d2009-11-30 13:06:01 -08001103
1104#else
1105 mmcamera_camframe_callback = receive_camframe_callback;
1106 mmcamera_jpegfragment_callback = receive_jpeg_fragment_callback;
1107 mmcamera_jpeg_callback = receive_jpeg_callback;
1108 mmcamera_shutter_callback = receive_shutter_callback;
1109#endif // DLOPEN_LIBMMCAMERA
1110
1111 /* The control thread is in libcamera itself. */
1112 mCameraControlFd = open(MSM_CAMERA_CONTROL, O_RDWR);
Kiran Kumar H N585bc362010-01-19 13:04:44 -08001113 if (mCameraControlFd < 0) {
1114 LOGE("startCamera X: %s open failed: %s!",
1115 MSM_CAMERA_CONTROL,
1116 strerror(errno));
1117 return false;
Priya Komarlingamb85535d2009-11-30 13:06:01 -08001118 }
1119
Kiran Kumar H N8ff7b982010-01-25 13:54:39 -08001120 if( mCurrentTarget != TARGET_MSM7630 ){
Mohan Kandra284966d2010-01-05 13:39:15 -08001121 fb_fd = open("/dev/graphics/fb0", O_RDWR);
1122 if (fb_fd < 0) {
1123 LOGE("startCamera: fb0 open failed: %s!", strerror(errno));
1124 return FALSE;
1125 }
1126 }
1127
Priya Komarlingamb85535d2009-11-30 13:06:01 -08001128 /* This will block until the control thread is launched. After that, sensor
1129 * information becomes available.
1130 */
1131
1132 if (LINK_launch_cam_conf_thread()) {
1133 LOGE("failed to launch the camera config thread");
1134 return false;
1135 }
1136
1137 memset(&mSensorInfo, 0, sizeof(mSensorInfo));
1138 if (ioctl(mCameraControlFd,
1139 MSM_CAM_IOCTL_GET_SENSOR_INFO,
1140 &mSensorInfo) < 0)
1141 LOGW("%s: cannot retrieve sensor info!", __FUNCTION__);
1142 else
1143 LOGI("%s: camsensor name %s, flash %d", __FUNCTION__,
1144 mSensorInfo.name, mSensorInfo.flash_enabled);
Apurva Rajguru1db0c392009-11-30 21:39:04 -08001145/* Disabling until support is available.
Priya Komarlingamb85535d2009-11-30 13:06:01 -08001146 picture_sizes = LINK_default_sensor_get_snapshot_sizes(&PICTURE_SIZE_COUNT);
1147 if (!picture_sizes || !PICTURE_SIZE_COUNT) {
1148 LOGE("startCamera X: could not get snapshot sizes");
1149 return false;
1150 }
Apurva Rajguru1db0c392009-11-30 21:39:04 -08001151*/
Priya Komarlingamb85535d2009-11-30 13:06:01 -08001152 LOGV("startCamera X");
1153 return true;
1154}
1155
1156status_t QualcommCameraHardware::dump(int fd,
1157 const Vector<String16>& args) const
1158{
1159 const size_t SIZE = 256;
1160 char buffer[SIZE];
1161 String8 result;
1162
1163 // Dump internal primitives.
1164 result.append("QualcommCameraHardware::dump");
1165 snprintf(buffer, 255, "mMsgEnabled (%d)\n", mMsgEnabled);
1166 result.append(buffer);
1167 int width, height;
1168 mParameters.getPreviewSize(&width, &height);
1169 snprintf(buffer, 255, "preview width(%d) x height (%d)\n", width, height);
1170 result.append(buffer);
1171 mParameters.getPictureSize(&width, &height);
1172 snprintf(buffer, 255, "raw width(%d) x height (%d)\n", width, height);
1173 result.append(buffer);
1174 snprintf(buffer, 255,
1175 "preview frame size(%d), raw size (%d), jpeg size (%d) "
1176 "and jpeg max size (%d)\n", mPreviewFrameSize, mRawSize,
1177 mJpegSize, mJpegMaxSize);
1178 result.append(buffer);
1179 write(fd, result.string(), result.size());
1180
1181 // Dump internal objects.
Mohan Kandrad9efed92010-01-15 19:08:39 -08001182 if (mPreviewHeap != 0) {
1183 mPreviewHeap->dump(fd, args);
Priya Komarlingamb85535d2009-11-30 13:06:01 -08001184 }
1185 if (mRawHeap != 0) {
1186 mRawHeap->dump(fd, args);
1187 }
1188 if (mJpegHeap != 0) {
1189 mJpegHeap->dump(fd, args);
1190 }
Srinivasan Kannan39dae8e2009-12-03 15:52:34 -08001191 if(mRawSnapshotAshmemHeap != 0 ){
1192 mRawSnapshotAshmemHeap->dump(fd, args);
1193 }
Priya Komarlingamb85535d2009-11-30 13:06:01 -08001194 mParameters.dump(fd, args);
1195 return NO_ERROR;
1196}
1197
Mohan Kandra284966d2010-01-05 13:39:15 -08001198static bool native_get_maxzoom(int camfd, void *pZm)
1199{
1200 LOGV("native_get_maxzoom E");
1201
1202 struct msm_ctrl_cmd ctrlCmd;
1203 int32_t *pZoom = (int32_t *)pZm;
1204
1205 ctrlCmd.type = CAMERA_GET_PARM_MAXZOOM;
1206 ctrlCmd.timeout_ms = 5000;
1207 ctrlCmd.length = sizeof(int32_t);
1208 ctrlCmd.value = pZoom;
1209 ctrlCmd.resp_fd = camfd;
1210
1211 if (ioctl(camfd, MSM_CAM_IOCTL_CTRL_COMMAND, &ctrlCmd) < 0) {
1212 LOGE("native_get_maxzoom: ioctl fd %d error %s",
1213 camfd,
1214 strerror(errno));
1215 return false;
1216 }
1217 LOGE("ctrlCmd.value = %d", *(int32_t *)ctrlCmd.value);
1218 memcpy(pZoom, (int32_t *)ctrlCmd.value, sizeof(int32_t));
1219
1220 LOGV("native_get_maxzoom X");
1221 return true;
1222}
1223
Priya Komarlingamb85535d2009-11-30 13:06:01 -08001224static bool native_set_afmode(int camfd, isp3a_af_mode_t af_type)
1225{
1226 int rc;
1227 struct msm_ctrl_cmd ctrlCmd;
1228
1229 ctrlCmd.timeout_ms = 5000;
1230 ctrlCmd.type = CAMERA_SET_PARM_AUTO_FOCUS;
1231 ctrlCmd.length = sizeof(af_type);
1232 ctrlCmd.value = &af_type;
1233 ctrlCmd.resp_fd = camfd; // FIXME: this will be put in by the kernel
1234
1235 if ((rc = ioctl(camfd, MSM_CAM_IOCTL_CTRL_COMMAND, &ctrlCmd)) < 0)
1236 LOGE("native_set_afmode: ioctl fd %d error %s\n",
1237 camfd,
1238 strerror(errno));
1239
1240 LOGV("native_set_afmode: ctrlCmd.status == %d\n", ctrlCmd.status);
1241 return rc >= 0 && ctrlCmd.status == CAMERA_EXIT_CB_DONE;
1242}
1243
1244static bool native_cancel_afmode(int camfd, int af_fd)
1245{
1246 int rc;
1247 struct msm_ctrl_cmd ctrlCmd;
1248
1249 ctrlCmd.timeout_ms = 0;
1250 ctrlCmd.type = CAMERA_AUTO_FOCUS_CANCEL;
1251 ctrlCmd.length = 0;
1252 ctrlCmd.value = NULL;
1253 ctrlCmd.resp_fd = -1; // there's no response fd
1254
1255 if ((rc = ioctl(camfd, MSM_CAM_IOCTL_CTRL_COMMAND_2, &ctrlCmd)) < 0)
1256 {
1257 LOGE("native_cancel_afmode: ioctl fd %d error %s\n",
1258 camfd,
1259 strerror(errno));
1260 return false;
1261 }
1262
1263 return true;
1264}
1265
1266static bool native_start_preview(int camfd)
1267{
1268 struct msm_ctrl_cmd ctrlCmd;
1269
1270 ctrlCmd.timeout_ms = 5000;
1271 ctrlCmd.type = CAMERA_START_PREVIEW;
1272 ctrlCmd.length = 0;
1273 ctrlCmd.resp_fd = camfd; // FIXME: this will be put in by the kernel
1274
1275 if (ioctl(camfd, MSM_CAM_IOCTL_CTRL_COMMAND, &ctrlCmd) < 0) {
1276 LOGE("native_start_preview: MSM_CAM_IOCTL_CTRL_COMMAND fd %d error %s",
1277 camfd,
1278 strerror(errno));
1279 return false;
1280 }
1281
1282 return true;
1283}
1284
1285static bool native_get_picture (int camfd, common_crop_t *crop)
1286{
1287 struct msm_ctrl_cmd ctrlCmd;
1288
1289 ctrlCmd.timeout_ms = 5000;
1290 ctrlCmd.length = sizeof(common_crop_t);
1291 ctrlCmd.value = crop;
1292
1293 if(ioctl(camfd, MSM_CAM_IOCTL_GET_PICTURE, &ctrlCmd) < 0) {
1294 LOGE("native_get_picture: MSM_CAM_IOCTL_GET_PICTURE fd %d error %s",
1295 camfd,
1296 strerror(errno));
1297 return false;
1298 }
1299
1300 LOGV("crop: in1_w %d", crop->in1_w);
1301 LOGV("crop: in1_h %d", crop->in1_h);
1302 LOGV("crop: out1_w %d", crop->out1_w);
1303 LOGV("crop: out1_h %d", crop->out1_h);
1304
1305 LOGV("crop: in2_w %d", crop->in2_w);
1306 LOGV("crop: in2_h %d", crop->in2_h);
1307 LOGV("crop: out2_w %d", crop->out2_w);
1308 LOGV("crop: out2_h %d", crop->out2_h);
1309
1310 LOGV("crop: update %d", crop->update_flag);
1311
1312 return true;
1313}
1314
1315static bool native_stop_preview(int camfd)
1316{
1317 struct msm_ctrl_cmd ctrlCmd;
1318 ctrlCmd.timeout_ms = 5000;
1319 ctrlCmd.type = CAMERA_STOP_PREVIEW;
1320 ctrlCmd.length = 0;
1321 ctrlCmd.resp_fd = camfd; // FIXME: this will be put in by the kernel
1322
1323 if(ioctl(camfd, MSM_CAM_IOCTL_CTRL_COMMAND, &ctrlCmd) < 0) {
1324 LOGE("native_stop_preview: ioctl fd %d error %s",
1325 camfd,
1326 strerror(errno));
1327 return false;
1328 }
1329
1330 return true;
1331}
1332
1333static bool native_prepare_snapshot(int camfd)
1334{
1335 int ioctlRetVal = true;
1336 struct msm_ctrl_cmd ctrlCmd;
1337
1338 ctrlCmd.timeout_ms = 1000;
1339 ctrlCmd.type = CAMERA_PREPARE_SNAPSHOT;
1340 ctrlCmd.length = 0;
1341 ctrlCmd.value = NULL;
1342 ctrlCmd.resp_fd = camfd;
1343
1344 if (ioctl(camfd, MSM_CAM_IOCTL_CTRL_COMMAND, &ctrlCmd) < 0) {
1345 LOGE("native_prepare_snapshot: ioctl fd %d error %s",
1346 camfd,
1347 strerror(errno));
1348 return false;
1349 }
1350 return true;
1351}
1352
1353static bool native_start_snapshot(int camfd)
1354{
1355 struct msm_ctrl_cmd ctrlCmd;
1356
1357 ctrlCmd.timeout_ms = 5000;
1358 ctrlCmd.type = CAMERA_START_SNAPSHOT;
1359 ctrlCmd.length = 0;
1360 ctrlCmd.resp_fd = camfd; // FIXME: this will be put in by the kernel
1361
1362 if(ioctl(camfd, MSM_CAM_IOCTL_CTRL_COMMAND, &ctrlCmd) < 0) {
1363 LOGE("native_start_snapshot: ioctl fd %d error %s",
1364 camfd,
1365 strerror(errno));
1366 return false;
1367 }
1368
1369 return true;
1370}
1371
Srinivasan Kannan39dae8e2009-12-03 15:52:34 -08001372static bool native_start_raw_snapshot(int camfd)
1373{
1374 int ret;
1375 struct msm_ctrl_cmd ctrlCmd;
1376
1377 ctrlCmd.timeout_ms = 1000;
1378 ctrlCmd.type = CAMERA_START_RAW_SNAPSHOT;
1379 ctrlCmd.length = 0;
1380 ctrlCmd.value = NULL;
1381 ctrlCmd.resp_fd = camfd;
1382
1383 if ((ret = ioctl(camfd, MSM_CAM_IOCTL_CTRL_COMMAND, &ctrlCmd)) < 0) {
1384 LOGE("native_start_raw_snapshot: ioctl failed. ioctl return value "\
1385 "is %d \n", ret);
1386 return false;
1387 }
1388 return true;
1389}
1390
1391
Priya Komarlingamb85535d2009-11-30 13:06:01 -08001392static bool native_stop_snapshot (int camfd)
1393{
1394 struct msm_ctrl_cmd ctrlCmd;
1395
1396 ctrlCmd.timeout_ms = 0;
1397 ctrlCmd.type = CAMERA_STOP_SNAPSHOT;
1398 ctrlCmd.length = 0;
1399 ctrlCmd.resp_fd = -1;
1400
1401 if (ioctl(camfd, MSM_CAM_IOCTL_CTRL_COMMAND_2, &ctrlCmd) < 0) {
1402 LOGE("native_stop_snapshot: ioctl fd %d error %s",
1403 camfd,
1404 strerror(errno));
1405 return false;
1406 }
1407
1408 return true;
1409}
Sravankb4f5f1c2010-01-21 11:06:17 +05301410/*===========================================================================
1411 * FUNCTION - native_start_recording -
1412 *
1413 * DESCRIPTION:
1414 *==========================================================================*/
1415static bool native_start_recording(int camfd)
1416{
1417 int ret;
1418 struct msm_ctrl_cmd ctrlCmd;
1419
1420 ctrlCmd.timeout_ms = 1000;
1421 ctrlCmd.type = CAMERA_START_RECORDING;
1422 ctrlCmd.length = 0;
1423 ctrlCmd.value = NULL;
1424 ctrlCmd.resp_fd = camfd;
1425
1426 if ((ret = ioctl(camfd, MSM_CAM_IOCTL_CTRL_COMMAND, &ctrlCmd)) < 0) {
1427 LOGE("native_start_recording: ioctl failed. ioctl return value "\
1428 "is %d \n", ret);
1429 return false;
1430 }
1431 LOGV("native_start_video: ioctl good. ioctl return value is %d \n",ret);
1432
1433 /* TODO: Check status of postprocessing if there is any,
1434 * PP status should be in ctrlCmd */
1435
1436 return true;
1437}
1438
1439/*===========================================================================
1440 * FUNCTION - native_stop_recording -
1441 *
1442 * DESCRIPTION:
1443 *==========================================================================*/
1444static bool native_stop_recording(int camfd)
1445{
1446 int ret;
1447 struct msm_ctrl_cmd ctrlCmd;
1448LOGE("in native_stop_recording ");
1449 ctrlCmd.timeout_ms = 1000;
1450 ctrlCmd.type = CAMERA_STOP_RECORDING;
1451 ctrlCmd.length = 0;
1452 ctrlCmd.value = NULL;
1453 ctrlCmd.resp_fd = camfd;
1454
1455 if ((ret = ioctl(camfd, MSM_CAM_IOCTL_CTRL_COMMAND, &ctrlCmd)) < 0) {
1456 LOGE("native_stop_video: ioctl failed. ioctl return value is %d \n",
1457 ret);
1458 return false;
1459 }
1460 LOGV("in native_stop_recording returned %d", ret);
1461 return true;
1462}
1463/*===========================================================================
1464 * FUNCTION - native_start_video -
1465 *
1466 * DESCRIPTION:
1467 *==========================================================================*/
1468static bool native_start_video(int camfd)
1469{
1470 int ret;
1471 struct msm_ctrl_cmd ctrlCmd;
1472
1473 ctrlCmd.timeout_ms = 1000;
1474 ctrlCmd.type = CAMERA_START_VIDEO;
1475 ctrlCmd.length = 0;
1476 ctrlCmd.value = NULL;
1477 ctrlCmd.resp_fd = camfd;
1478
1479 if ((ret = ioctl(camfd, MSM_CAM_IOCTL_CTRL_COMMAND, &ctrlCmd)) < 0) {
1480 LOGE("native_start_video: ioctl failed. ioctl return value is %d \n",
1481 ret);
1482 return false;
1483 }
1484
1485 /* TODO: Check status of postprocessing if there is any,
1486 * PP status should be in ctrlCmd */
1487
1488 return true;
1489}
1490
1491/*===========================================================================
1492 * FUNCTION - native_stop_video -
1493 *
1494 * DESCRIPTION:
1495 *==========================================================================*/
1496static bool native_stop_video(int camfd)
1497{
1498 int ret;
1499 struct msm_ctrl_cmd ctrlCmd;
1500
1501 ctrlCmd.timeout_ms = 1000;
1502 ctrlCmd.type = CAMERA_STOP_VIDEO;
1503 ctrlCmd.length = 0;
1504 ctrlCmd.value = NULL;
1505 ctrlCmd.resp_fd = camfd;
1506
1507 if ((ret = ioctl(camfd, MSM_CAM_IOCTL_CTRL_COMMAND, &ctrlCmd)) < 0) {
1508 LOGE("native_stop_video: ioctl failed. ioctl return value is %d \n",
1509 ret);
1510 return false;
1511 }
1512
1513 return true;
1514}
1515/*==========================================================================*/
1516
1517static cam_frame_start_parms frame_parms;
1518static int recordingState = 0;
Priya Komarlingamb85535d2009-11-30 13:06:01 -08001519
Apurva Rajguru66bdd7f2009-12-10 19:28:02 -08001520static rat_t latitude[3];
1521static rat_t longitude[3];
1522static char lonref[2];
1523static char latref[2];
1524static char dateTime[20];
1525static rat_t altitude;
1526
1527static void addExifTag(exif_tag_id_t tagid, exif_tag_type_t type,
1528 uint32_t count, uint8_t copy, void *data) {
1529
1530 if(exif_table_numEntries == MAX_EXIF_TABLE_ENTRIES) {
1531 LOGE("Number of entries exceeded limit");
1532 return;
1533 }
1534
1535 int index = exif_table_numEntries;
1536 exif_data[index].tag_id = tagid;
1537 exif_data[index].tag_entry.type = type;
1538 exif_data[index].tag_entry.count = count;
1539 exif_data[index].tag_entry.copy = copy;
1540 if((type == EXIF_RATIONAL) && (count > 1))
1541 exif_data[index].tag_entry.data._rats = (rat_t *)data;
1542 if((type == EXIF_RATIONAL) && (count == 1))
1543 exif_data[index].tag_entry.data._rat = *(rat_t *)data;
1544 else if(type == EXIF_ASCII)
1545 exif_data[index].tag_entry.data._ascii = (char *)data;
1546 else if(type == EXIF_BYTE)
1547 exif_data[index].tag_entry.data._byte = *(uint8_t *)data;
1548
1549 // Increase number of entries
1550 exif_table_numEntries++;
1551}
1552
1553static void parseLatLong(const char *latlonString, int *pDegrees,
1554 int *pMinutes, int *pSeconds ) {
1555
1556 double value = atof(latlonString);
1557 value = fabs(value);
1558 int degrees = (int) value;
1559
1560 double remainder = value - degrees;
1561 int minutes = (int) (remainder * 60);
1562 int seconds = (int) (((remainder * 60) - minutes) * 60 * 1000);
1563
1564 *pDegrees = degrees;
1565 *pMinutes = minutes;
1566 *pSeconds = seconds;
1567}
1568
1569static void setLatLon(exif_tag_id_t tag, const char *latlonString) {
1570
1571 int degrees, minutes, seconds;
1572
1573 parseLatLong(latlonString, &degrees, &minutes, &seconds);
1574
1575 rat_t value[3] = { {degrees, 1},
1576 {minutes, 1},
1577 {seconds, 1000} };
1578
1579 if(tag == EXIFTAGID_GPS_LATITUDE) {
1580 memcpy(latitude, value, sizeof(latitude));
1581 addExifTag(EXIFTAGID_GPS_LATITUDE, EXIF_RATIONAL, 3,
1582 1, (void *)latitude);
1583 } else {
1584 memcpy(longitude, value, sizeof(longitude));
1585 addExifTag(EXIFTAGID_GPS_LONGITUDE, EXIF_RATIONAL, 3,
1586 1, (void *)longitude);
1587 }
1588}
1589
1590void QualcommCameraHardware::setGpsParameters() {
1591 const char *str = NULL;
1592
1593 //Set Latitude
1594 str = mParameters.get(CameraParameters::KEY_GPS_LATITUDE);
1595 if(str != NULL) {
1596 setLatLon(EXIFTAGID_GPS_LATITUDE, str);
1597 //set Latitude Ref
1598 str = NULL;
1599 str = mParameters.get(CameraParameters::KEY_GPS_LATITUDE_REF);
1600 if(str != NULL) {
1601 strncpy(latref, str, 1);
1602 latref[1] = '\0';
1603 addExifTag(EXIFTAGID_GPS_LATITUDE_REF, EXIF_ASCII, 2,
1604 1, (void *)latref);
1605 }
1606 }
1607
1608 //set Longitude
1609 str = NULL;
1610 str = mParameters.get(CameraParameters::KEY_GPS_LONGITUDE);
1611 if(str != NULL) {
1612 setLatLon(EXIFTAGID_GPS_LONGITUDE, str);
1613 //set Longitude Ref
1614 str = NULL;
1615 str = mParameters.get(CameraParameters::KEY_GPS_LONGITUDE_REF);
1616 if(str != NULL) {
1617 strncpy(lonref, str, 1);
1618 lonref[1] = '\0';
1619 addExifTag(EXIFTAGID_GPS_LONGITUDE_REF, EXIF_ASCII, 2,
1620 1, (void *)lonref);
1621 }
1622 }
1623
1624 //set Altitude
1625 str = NULL;
1626 str = mParameters.get(CameraParameters::KEY_GPS_ALTITUDE);
1627 if(str != NULL) {
1628 int value = atoi(str);
1629 rat_t alt_value = {value, 1000};
1630 memcpy(&altitude, &alt_value, sizeof(altitude));
1631 addExifTag(EXIFTAGID_GPS_ALTITUDE, EXIF_RATIONAL, 1,
1632 1, (void *)&altitude);
1633 //set AltitudeRef
1634 int ref = mParameters.getInt(CameraParameters::KEY_GPS_ALTITUDE_REF);
1635 if( !(ref < 0 || ref > 1) )
1636 addExifTag(EXIFTAGID_GPS_ALTITUDE_REF, EXIF_BYTE, 1,
1637 1, (void *)&ref);
1638 }
1639
1640
1641}
1642
Priya Komarlingamb85535d2009-11-30 13:06:01 -08001643bool QualcommCameraHardware::native_jpeg_encode(void)
1644{
1645 int jpeg_quality = mParameters.getInt("jpeg-quality");
1646 if (jpeg_quality >= 0) {
1647 LOGV("native_jpeg_encode, current jpeg main img quality =%d",
1648 jpeg_quality);
1649 if(!LINK_jpeg_encoder_setMainImageQuality(jpeg_quality)) {
1650 LOGE("native_jpeg_encode set jpeg-quality failed");
1651 return false;
1652 }
1653 }
1654
1655 int thumbnail_quality = mParameters.getInt("jpeg-thumbnail-quality");
1656 if (thumbnail_quality >= 0) {
1657 LOGV("native_jpeg_encode, current jpeg thumbnail quality =%d",
1658 thumbnail_quality);
1659 if(!LINK_jpeg_encoder_setThumbnailQuality(thumbnail_quality)) {
1660 LOGE("native_jpeg_encode set thumbnail-quality failed");
1661 return false;
1662 }
1663 }
1664
1665 int rotation = mParameters.getInt("rotation");
1666 if (rotation >= 0) {
1667 LOGV("native_jpeg_encode, rotation = %d", rotation);
1668 if(!LINK_jpeg_encoder_setRotation(rotation)) {
1669 LOGE("native_jpeg_encode set rotation failed");
1670 return false;
1671 }
1672 }
1673
Apurva Rajguru66bdd7f2009-12-10 19:28:02 -08001674// jpeg_set_location();
1675 if(mParameters.getInt(CameraParameters::KEY_GPS_STATUS) == 1) {
1676 setGpsParameters();
1677 }
1678 //set TimeStamp
1679 const char *str = mParameters.get(CameraParameters::KEY_EXIF_DATETIME);
1680 if(str != NULL) {
1681 strncpy(dateTime, str, 19);
1682 dateTime[19] = '\0';
1683 addExifTag(EXIFTAGID_EXIF_DATE_TIME_ORIGINAL, EXIF_ASCII,
1684 20, 1, (void *)dateTime);
1685 }
Priya Komarlingamb85535d2009-11-30 13:06:01 -08001686
1687 if (!LINK_jpeg_encoder_encode(&mDimension,
1688 (uint8_t *)mThumbnailHeap->mHeap->base(),
1689 mThumbnailHeap->mHeap->getHeapID(),
1690 (uint8_t *)mRawHeap->mHeap->base(),
1691 mRawHeap->mHeap->getHeapID(),
Apurva Rajguru66bdd7f2009-12-10 19:28:02 -08001692 &mCrop, exif_data, exif_table_numEntries)) {
Priya Komarlingamb85535d2009-11-30 13:06:01 -08001693 LOGE("native_jpeg_encode: jpeg_encoder_encode failed.");
1694 return false;
1695 }
1696 return true;
1697}
1698
1699bool QualcommCameraHardware::native_set_parm(
1700 cam_ctrl_type type, uint16_t length, void *value)
1701{
1702 struct msm_ctrl_cmd ctrlCmd;
1703
1704 ctrlCmd.timeout_ms = 5000;
1705 ctrlCmd.type = (uint16_t)type;
1706 ctrlCmd.length = length;
1707 // FIXME: this will be put in by the kernel
1708 ctrlCmd.resp_fd = mCameraControlFd;
1709 ctrlCmd.value = value;
1710
1711 LOGV("%s: fd %d, type %d, length %d", __FUNCTION__,
1712 mCameraControlFd, type, length);
1713 if (ioctl(mCameraControlFd, MSM_CAM_IOCTL_CTRL_COMMAND, &ctrlCmd) < 0 ||
1714 ctrlCmd.status != CAM_CTRL_SUCCESS) {
1715 LOGE("%s: error (%s): fd %d, type %d, length %d, status %d",
1716 __FUNCTION__, strerror(errno),
1717 mCameraControlFd, type, length, ctrlCmd.status);
1718 return false;
1719 }
1720 return true;
1721}
1722
1723void QualcommCameraHardware::jpeg_set_location()
1724{
1725 bool encode_location = true;
1726 camera_position_type pt;
1727
1728#define PARSE_LOCATION(what,type,fmt,desc) do { \
1729 pt.what = 0; \
1730 const char *what##_str = mParameters.get("gps-"#what); \
1731 LOGV("GPS PARM %s --> [%s]", "gps-"#what, what##_str); \
1732 if (what##_str) { \
1733 type what = 0; \
1734 if (sscanf(what##_str, fmt, &what) == 1) \
1735 pt.what = what; \
1736 else { \
1737 LOGE("GPS " #what " %s could not" \
1738 " be parsed as a " #desc, what##_str); \
1739 encode_location = false; \
1740 } \
1741 } \
1742 else { \
1743 LOGV("GPS " #what " not specified: " \
1744 "defaulting to zero in EXIF header."); \
1745 encode_location = false; \
1746 } \
1747 } while(0)
1748
1749 PARSE_LOCATION(timestamp, long, "%ld", "long");
1750 if (!pt.timestamp) pt.timestamp = time(NULL);
1751 PARSE_LOCATION(altitude, short, "%hd", "short");
1752 PARSE_LOCATION(latitude, double, "%lf", "double float");
1753 PARSE_LOCATION(longitude, double, "%lf", "double float");
1754
1755#undef PARSE_LOCATION
1756
1757 if (encode_location) {
1758 LOGD("setting image location ALT %d LAT %lf LON %lf",
1759 pt.altitude, pt.latitude, pt.longitude);
Apurva Rajguru1db0c392009-11-30 21:39:04 -08001760/* Disabling until support is available.
Priya Komarlingamb85535d2009-11-30 13:06:01 -08001761 if (!LINK_jpeg_encoder_setLocation(&pt)) {
1762 LOGE("jpeg_set_location: LINK_jpeg_encoder_setLocation failed.");
1763 }
Apurva Rajguru1db0c392009-11-30 21:39:04 -08001764*/
Priya Komarlingamb85535d2009-11-30 13:06:01 -08001765 }
1766 else LOGV("not setting image location");
1767}
1768
1769void QualcommCameraHardware::runFrameThread(void *data)
1770{
1771 LOGV("runFrameThread E");
1772
1773 int cnt;
1774
1775#if DLOPEN_LIBMMCAMERA
1776 // We need to maintain a reference to libqcamera.so for the duration of the
1777 // frame thread, because we do not know when it will exit relative to the
1778 // lifetime of this object. We do not want to dlclose() libqcamera while
1779 // LINK_cam_frame is still running.
1780 void *libhandle = ::dlopen("liboemcamera.so", RTLD_NOW);
1781 LOGV("FRAME: loading libqcamera at %p", libhandle);
1782 if (!libhandle) {
1783 LOGE("FATAL ERROR: could not dlopen liboemcamera.so: %s", dlerror());
1784 }
1785 if (libhandle)
1786#endif
1787 {
1788 LINK_cam_frame(data);
1789 }
1790
Mohan Kandrad9efed92010-01-15 19:08:39 -08001791 mPreviewHeap.clear();
Kiran Kumar H N8ff7b982010-01-25 13:54:39 -08001792 if( mCurrentTarget == TARGET_MSM7630 )
Sravankb4f5f1c2010-01-21 11:06:17 +05301793 mRecordHeap.clear();
1794
Priya Komarlingamb85535d2009-11-30 13:06:01 -08001795#if DLOPEN_LIBMMCAMERA
1796 if (libhandle) {
1797 ::dlclose(libhandle);
1798 LOGV("FRAME: dlclose(libqcamera)");
1799 }
1800#endif
1801
1802 mFrameThreadWaitLock.lock();
1803 mFrameThreadRunning = false;
1804 mFrameThreadWait.signal();
1805 mFrameThreadWaitLock.unlock();
1806
1807 LOGV("runFrameThread X");
1808}
1809
Sravankb4f5f1c2010-01-21 11:06:17 +05301810void QualcommCameraHardware::runVideoThread(void *data)
1811{
1812 LOGD("runVideoThread E");
1813 msm_frame* vframe = NULL;
1814
1815 while(true) {
1816 pthread_mutex_lock(&(g_busy_frame_queue.mut));
1817
1818 LOGE("in video_thread : wait for video frame ");
1819 // check if any frames are available in busyQ and give callback to
1820 // services/video encoder
1821 cam_frame_wait_video();
1822 LOGV("video_thread, wait over..");
1823
1824 // Exit the thread , in case of stop recording..
1825 mVideoThreadWaitLock.lock();
1826 if(mVideoThreadExit){
1827 LOGE("Exiting video thread..");
1828 mVideoThreadWaitLock.unlock();
1829 pthread_mutex_unlock(&(g_busy_frame_queue.mut));
1830 break;
1831 }
1832 mVideoThreadWaitLock.unlock();
1833
1834 // Get the video frame to be encoded
1835 vframe = cam_frame_get_video ();
1836 LOGV("in video_thread : got video frame ");
1837
1838 if(vframe != NULL) {
1839 // Find the offset within the heap of the current buffer.
1840 LOGV("Got video frame : buffer %d base %d ", vframe->buffer, mRecordHeap->mHeap->base());
1841 ssize_t offset =
1842 (ssize_t)vframe->buffer - (ssize_t)mRecordHeap->mHeap->base();
1843 LOGV("offset = %d , alignsize = %d , offset later = %d", offset, mRecordHeap->mAlignedBufferSize, (offset / mRecordHeap->mAlignedBufferSize));
1844
1845 offset /= mRecordHeap->mAlignedBufferSize;
1846
1847 // dump frames for test purpose
1848#ifdef DUMP_VIDEO_FRAMES
1849 static int frameCnt = 0;
1850 if (frameCnt >= 11 && frameCnt <= 13 ) {
1851 char buf[128];
1852 sprintf(buf, "/data/%d_v.yuv", frameCnt);
1853 int file_fd = open(buf, O_RDWR | O_CREAT, 0777);
1854 LOGV("dumping video frame %d", frameCnt);
1855 if (file_fd < 0) {
1856 LOGE("cannot open file\n");
1857 }
1858 else
1859 {
1860 write(file_fd, (const void *)vframe->buffer,
1861 vframe->cbcr_off * 3 / 2);
1862 }
1863 close(file_fd);
1864 }
1865 frameCnt++;
1866#endif
1867 // Enable IF block to give frames to encoder , ELSE block for just simulation
1868#if 1
1869 LOGV("in video_thread : got video frame, before if check giving frame to services/encoder");
1870 mCallbackLock.lock();
1871 int msgEnabled = mMsgEnabled;
1872 data_callback_timestamp rcb = mDataCallbackTimestamp;
1873 void *rdata = mCallbackCookie;
1874 mCallbackLock.unlock();
1875
1876 if(rcb != NULL && (msgEnabled & CAMERA_MSG_VIDEO_FRAME) ) {
1877 LOGV("in video_thread : got video frame, giving frame to services/encoder");
1878 rcb(systemTime(), CAMERA_MSG_VIDEO_FRAME, mRecordHeap->mBuffers[offset], rdata);
1879 Mutex::Autolock rLock(&mRecordFrameLock);
1880 if (mReleasedRecordingFrame != true) {
1881 LOGV("block waiting for frame release");
1882 mRecordWait.wait(mRecordFrameLock);
1883 LOGV("video frame released, continuing");
1884 }
1885 mReleasedRecordingFrame = false;
1886 }
1887#else
1888 // 720p output2 : simulate release frame here:
1889 LOGE("in video_thread simulation , releasing the video frame");
1890 LINK_camframe_free_video(vframe);
1891#endif
1892
1893 } else LOGE("in video_thread get frame returned null");
1894
1895 pthread_mutex_unlock(&(g_busy_frame_queue.mut));
1896
1897 } // end of while loop
1898 LOGV("runVideoThread X");
1899}
1900
1901void *video_thread(void *user)
1902{
1903 LOGV("video_thread E");
1904 sp<QualcommCameraHardware> obj = QualcommCameraHardware::getInstance();
1905 if (obj != 0) {
1906 obj->runVideoThread(user);
1907 }
1908 else LOGE("not starting video thread: the object went away!");
1909 LOGV("video_thread X");
1910 return NULL;
1911}
1912
Priya Komarlingamb85535d2009-11-30 13:06:01 -08001913void *frame_thread(void *user)
1914{
1915 LOGD("frame_thread E");
1916 sp<QualcommCameraHardware> obj = QualcommCameraHardware::getInstance();
1917 if (obj != 0) {
1918 obj->runFrameThread(user);
1919 }
1920 else LOGW("not starting frame thread: the object went away!");
1921 LOGD("frame_thread X");
1922 return NULL;
1923}
1924
1925bool QualcommCameraHardware::initPreview()
1926{
1927 // See comments in deinitPreview() for why we have to wait for the frame
1928 // thread here, and why we can't use pthread_join().
Sravankb4f5f1c2010-01-21 11:06:17 +05301929 int videoWidth, videoHeight;
Priya Komarlingamb85535d2009-11-30 13:06:01 -08001930 mParameters.getPreviewSize(&previewWidth, &previewHeight);
Sravankb4f5f1c2010-01-21 11:06:17 +05301931
1932 videoWidth = previewWidth; // temporary , should be configurable later
1933 videoHeight = previewHeight;
1934 LOGV("initPreview E: preview size=%dx%d videosize = %d x %d", previewWidth, previewHeight, videoWidth, videoHeight );
1935
Kiran Kumar H N8ff7b982010-01-25 13:54:39 -08001936 if( mCurrentTarget == TARGET_MSM7630 ) {
Sravankb4f5f1c2010-01-21 11:06:17 +05301937 mDimension.video_width = videoWidth;
1938 mDimension.video_width = CEILING32(mDimension.video_width);
1939 mDimension.video_height = videoHeight;
1940 LOGV("initPreview : preview size=%dx%d videosize = %d x %d", previewWidth, previewHeight, mDimension.video_width, mDimension.video_height );
1941 }
1942
1943
Priya Komarlingamb85535d2009-11-30 13:06:01 -08001944 mFrameThreadWaitLock.lock();
1945 while (mFrameThreadRunning) {
1946 LOGV("initPreview: waiting for old frame thread to complete.");
1947 mFrameThreadWait.wait(mFrameThreadWaitLock);
1948 LOGV("initPreview: old frame thread completed.");
1949 }
1950 mFrameThreadWaitLock.unlock();
1951
1952 mSnapshotThreadWaitLock.lock();
1953 while (mSnapshotThreadRunning) {
1954 LOGV("initPreview: waiting for old snapshot thread to complete.");
1955 mSnapshotThreadWait.wait(mSnapshotThreadWaitLock);
1956 LOGV("initPreview: old snapshot thread completed.");
1957 }
1958 mSnapshotThreadWaitLock.unlock();
1959
1960 int cnt = 0;
1961 mPreviewFrameSize = previewWidth * previewHeight * 3/2;
Mohan Kandrad9efed92010-01-15 19:08:39 -08001962 dstOffset = 0;
1963 mPreviewHeap = new PmemPool("/dev/pmem_adsp",
Mohan Kandra284966d2010-01-05 13:39:15 -08001964 MemoryHeapBase::READ_ONLY | MemoryHeapBase::NO_CACHING,
1965 mCameraControlFd,
Sravankb4f5f1c2010-01-21 11:06:17 +05301966 MSM_PMEM_PREVIEW, //MSM_PMEM_OUTPUT2,
Mohan Kandra284966d2010-01-05 13:39:15 -08001967 mPreviewFrameSize,
Mohan Kandrad9efed92010-01-15 19:08:39 -08001968 kPreviewBufferCountActual,
Mohan Kandra284966d2010-01-05 13:39:15 -08001969 mPreviewFrameSize,
Mohan Kandrad9efed92010-01-15 19:08:39 -08001970 "preview");
Mohan Kandra284966d2010-01-05 13:39:15 -08001971
Mohan Kandrad9efed92010-01-15 19:08:39 -08001972 if (!mPreviewHeap->initialized()) {
1973 mPreviewHeap.clear();
Mohan Kandra284966d2010-01-05 13:39:15 -08001974 LOGE("initPreview X: could not initialize Camera preview heap.");
1975 return false;
1976 }
Kiran Kumar H N8ff7b982010-01-25 13:54:39 -08001977 if( mCurrentTarget == TARGET_MSM7630 ) {
Kiran Kumar H N595970b2010-01-12 10:41:09 -08001978 if(mPostViewHeap == NULL) {
1979 LOGV(" Allocating Postview heap ");
1980 /* mPostViewHeap should be declared only for 7630 target */
1981 mPostViewHeap =
1982 new PmemPool("/dev/pmem_adsp",
1983 MemoryHeapBase::READ_ONLY | MemoryHeapBase::NO_CACHING,
1984 mCameraControlFd,
Sravankb4f5f1c2010-01-21 11:06:17 +05301985 MSM_PMEM_PREVIEW, //MSM_PMEM_OUTPUT2,
Kiran Kumar H N595970b2010-01-12 10:41:09 -08001986 mPreviewFrameSize,
1987 1,
1988 mPreviewFrameSize,
1989 "postview");
Mohan Kandra284966d2010-01-05 13:39:15 -08001990
Kiran Kumar H N595970b2010-01-12 10:41:09 -08001991 if (!mPostViewHeap->initialized()) {
1992 mPostViewHeap.clear();
1993 LOGE(" Failed to initialize Postview Heap");
1994 return false;
1995 }
Kiran Kumar H N326cc4c2010-01-08 12:29:26 -08001996 }
Kiran Kumar H N8ff7b982010-01-25 13:54:39 -08001997
1998 // Allocate video buffers after allocating preview buffers.
Sravankb4f5f1c2010-01-21 11:06:17 +05301999 initRecord();
Kiran Kumar H N8ff7b982010-01-25 13:54:39 -08002000 }
Sravankb4f5f1c2010-01-21 11:06:17 +05302001
Priya Komarlingamb85535d2009-11-30 13:06:01 -08002002 // mDimension will be filled with thumbnail_width, thumbnail_height,
2003 // orig_picture_dx, and orig_picture_dy after this function call. We need to
2004 // keep it for jpeg_encoder_encode.
2005 bool ret = native_set_parm(CAMERA_SET_PARM_DIMENSION,
2006 sizeof(cam_ctrl_dimension_t), &mDimension);
2007
2008 if (ret) {
2009 for (cnt = 0; cnt < kPreviewBufferCount; cnt++) {
Mohan Kandrad9efed92010-01-15 19:08:39 -08002010 frames[cnt].fd = mPreviewHeap->mHeap->getHeapID();
Priya Komarlingamb85535d2009-11-30 13:06:01 -08002011 frames[cnt].buffer =
Mohan Kandrad9efed92010-01-15 19:08:39 -08002012 (uint32_t)mPreviewHeap->mHeap->base() + mPreviewHeap->mAlignedBufferSize * cnt;
Priya Komarlingamb85535d2009-11-30 13:06:01 -08002013 frames[cnt].y_off = 0;
2014 frames[cnt].cbcr_off = previewWidth * previewHeight;
Sravankb4f5f1c2010-01-21 11:06:17 +05302015 frames[cnt].path = OUTPUT_TYPE_P; // MSM_FRAME_ENC;
Priya Komarlingamb85535d2009-11-30 13:06:01 -08002016 }
2017
2018 mFrameThreadWaitLock.lock();
2019 pthread_attr_t attr;
2020 pthread_attr_init(&attr);
2021 pthread_attr_setdetachstate(&attr, PTHREAD_CREATE_DETACHED);
Sravankb4f5f1c2010-01-21 11:06:17 +05302022
2023 frame_parms.frame = frames[kPreviewBufferCount - 1];
2024 frame_parms.video_frame = recordframes[kPreviewBufferCount - 1];
2025
2026 LOGV ("initpreview before cam_frame thread carete , video frame buffer=%lu fd=%d y_off=%d cbcr_off=%d \n",
2027 (unsigned long)frame_parms.video_frame.buffer, frame_parms.video_frame.fd, frame_parms.video_frame.y_off,
2028 frame_parms.video_frame.cbcr_off);
Priya Komarlingamb85535d2009-11-30 13:06:01 -08002029 mFrameThreadRunning = !pthread_create(&mFrameThread,
2030 &attr,
2031 frame_thread,
Sravankb4f5f1c2010-01-21 11:06:17 +05302032 (void*)&(frame_parms));
Priya Komarlingamb85535d2009-11-30 13:06:01 -08002033 ret = mFrameThreadRunning;
2034 mFrameThreadWaitLock.unlock();
2035 }
2036
2037 LOGV("initPreview X: %d", ret);
2038 return ret;
2039}
2040
2041void QualcommCameraHardware::deinitPreview(void)
2042{
2043 LOGI("deinitPreview E");
2044
2045 // When we call deinitPreview(), we signal to the frame thread that it
2046 // needs to exit, but we DO NOT WAIT for it to complete here. The problem
2047 // is that deinitPreview is sometimes called from the frame-thread's
2048 // callback, when the refcount on the Camera client reaches zero. If we
2049 // called pthread_join(), we would deadlock. So, we just call
2050 // LINK_camframe_terminate() in deinitPreview(), which makes sure that
2051 // after the preview callback returns, the camframe thread will exit. We
2052 // could call pthread_join() in initPreview() to join the last frame
2053 // thread. However, we would also have to call pthread_join() in release
2054 // as well, shortly before we destroy the object; this would cause the same
2055 // deadlock, since release(), like deinitPreview(), may also be called from
2056 // the frame-thread's callback. This we have to make the frame thread
2057 // detached, and use a separate mechanism to wait for it to complete.
2058
2059 if (LINK_camframe_terminate() < 0)
2060 LOGE("failed to stop the camframe thread: %s",
2061 strerror(errno));
2062 LOGI("deinitPreview X");
2063}
2064
Srinivasan Kannan39dae8e2009-12-03 15:52:34 -08002065bool QualcommCameraHardware::initRawSnapshot()
2066{
2067 LOGV("initRawSnapshot E");
2068
2069 //get width and height from Dimension Object
2070 bool ret = native_set_parm(CAMERA_SET_PARM_DIMENSION,
2071 sizeof(cam_ctrl_dimension_t), &mDimension);
2072
2073 if(!ret){
2074 LOGE("initRawSnapshot X: failed to set dimension");
2075 return false;
2076 }
2077 int rawSnapshotSize = mDimension.raw_picture_height *
2078 mDimension.raw_picture_width;
2079
2080 LOGV("raw_snapshot_buffer_size = %d, raw_picture_height = %d, "\
2081 "raw_picture_width = %d",
2082 rawSnapshotSize, mDimension.raw_picture_height,
2083 mDimension.raw_picture_width);
2084
2085 if (mRawSnapShotPmemHeap != NULL) {
2086 LOGV("initRawSnapshot: clearing old mRawSnapShotPmemHeap.");
2087 mRawSnapShotPmemHeap.clear();
2088 }
2089
2090 //Pmem based pool for Camera Driver
2091 mRawSnapShotPmemHeap = new PmemPool("/dev/pmem_adsp",
2092 MemoryHeapBase::READ_ONLY,
2093 mCameraControlFd,
2094 MSM_PMEM_RAW_MAINIMG,
2095 rawSnapshotSize,
2096 1,
2097 rawSnapshotSize,
2098 "raw pmem snapshot camera");
2099
2100 if (!mRawSnapShotPmemHeap->initialized()) {
2101 mRawSnapShotPmemHeap.clear();
2102 LOGE("initRawSnapshot X: error initializing mRawSnapshotHeap");
2103 return false;
2104 }
2105 LOGV("initRawSnapshot X");
2106 return true;
2107
2108}
2109
Priya Komarlingamb85535d2009-11-30 13:06:01 -08002110bool QualcommCameraHardware::initRaw(bool initJpegHeap)
2111{
2112 int rawWidth, rawHeight;
Apurva Rajguru8d1773b2009-12-02 14:21:23 -08002113
Priya Komarlingamb85535d2009-11-30 13:06:01 -08002114 mParameters.getPictureSize(&rawWidth, &rawHeight);
2115 LOGV("initRaw E: picture size=%dx%d", rawWidth, rawHeight);
2116
Srinivasan Kannan80d878f2009-12-18 15:06:02 -08002117 int thumbnailBufferSize;
2118 //Thumbnail height should be smaller than Picture height
Kiran Kumar H N8ff7b982010-01-25 13:54:39 -08002119 if (rawHeight > (int)thumbnail_sizes[DEFAULT_THUMBNAIL_SETTING].height){
Srinivasan Kannan80d878f2009-12-18 15:06:02 -08002120 mDimension.ui_thumbnail_width =
2121 thumbnail_sizes[DEFAULT_THUMBNAIL_SETTING].width;
2122 mDimension.ui_thumbnail_height =
2123 thumbnail_sizes[DEFAULT_THUMBNAIL_SETTING].height;
2124 uint32_t pictureAspectRatio = (uint32_t)((rawWidth * Q12) / rawHeight);
2125 uint32_t i;
2126 for(i = 0; i < THUMBNAIL_SIZE_COUNT; i++ )
2127 {
2128 if(thumbnail_sizes[i].aspect_ratio == pictureAspectRatio)
2129 {
2130 mDimension.ui_thumbnail_width = thumbnail_sizes[i].width;
2131 mDimension.ui_thumbnail_height = thumbnail_sizes[i].height;
2132 break;
2133 }
2134 }
2135 }
2136 else{
2137 mDimension.ui_thumbnail_height = THUMBNAIL_SMALL_HEIGHT;
2138 mDimension.ui_thumbnail_width =
2139 (THUMBNAIL_SMALL_HEIGHT * rawWidth)/ rawHeight;
2140 }
2141
2142 LOGV("Thumbnail Size Width %d Height %d",
2143 mDimension.ui_thumbnail_width,
2144 mDimension.ui_thumbnail_height);
2145
2146 thumbnailBufferSize = mDimension.ui_thumbnail_width *
2147 mDimension.ui_thumbnail_height * 3 / 2;
2148
Priya Komarlingamb85535d2009-11-30 13:06:01 -08002149 // mDimension will be filled with thumbnail_width, thumbnail_height,
2150 // orig_picture_dx, and orig_picture_dy after this function call. We need to
2151 // keep it for jpeg_encoder_encode.
2152 bool ret = native_set_parm(CAMERA_SET_PARM_DIMENSION,
2153 sizeof(cam_ctrl_dimension_t), &mDimension);
2154 if(!ret) {
2155 LOGE("initRaw X: failed to set dimension");
2156 return false;
2157 }
2158
2159 if (mJpegHeap != NULL) {
2160 LOGV("initRaw: clearing old mJpegHeap.");
2161 mJpegHeap.clear();
2162 }
2163
2164 // Snapshot
2165 mRawSize = rawWidth * rawHeight * 3 / 2;
Apurva Rajguru8d1773b2009-12-02 14:21:23 -08002166
Kiran Kumar H N8ff7b982010-01-25 13:54:39 -08002167 if( mCurrentTarget == TARGET_MSM7627 )
Apurva Rajguru8d1773b2009-12-02 14:21:23 -08002168 mJpegMaxSize = CEILING16(rawWidth) * CEILING16(rawHeight) * 3 / 2;
2169 else
2170 mJpegMaxSize = rawWidth * rawHeight * 3 / 2;
Priya Komarlingamb85535d2009-11-30 13:06:01 -08002171
2172 LOGV("initRaw: initializing mRawHeap.");
2173 mRawHeap =
Kiran Kumar H N8ff7b982010-01-25 13:54:39 -08002174 new PmemPool("/dev/pmem_adsp",
Priya Komarlingamb85535d2009-11-30 13:06:01 -08002175 MemoryHeapBase::READ_ONLY,
2176 mCameraControlFd,
2177 MSM_PMEM_MAINIMG,
2178 mJpegMaxSize,
2179 kRawBufferCount,
2180 mRawSize,
2181 "snapshot camera");
2182
2183 if (!mRawHeap->initialized()) {
Kiran Kumar H N8ff7b982010-01-25 13:54:39 -08002184 LOGE("initRaw X failed ");
2185 mRawHeap.clear();
2186 LOGE("initRaw X: error initializing mRawHeap");
2187 return false;
Priya Komarlingamb85535d2009-11-30 13:06:01 -08002188 }
2189
2190 LOGV("do_mmap snapshot pbuf = %p, pmem_fd = %d",
2191 (uint8_t *)mRawHeap->mHeap->base(), mRawHeap->mHeap->getHeapID());
2192
2193 // Jpeg
2194
2195 if (initJpegHeap) {
2196 LOGV("initRaw: initializing mJpegHeap.");
2197 mJpegHeap =
2198 new AshmemPool(mJpegMaxSize,
2199 kJpegBufferCount,
2200 0, // we do not know how big the picture will be
2201 "jpeg");
2202
2203 if (!mJpegHeap->initialized()) {
2204 mJpegHeap.clear();
2205 mRawHeap.clear();
2206 LOGE("initRaw X failed: error initializing mJpegHeap.");
2207 return false;
2208 }
2209
2210 // Thumbnails
2211
2212 mThumbnailHeap =
2213 new PmemPool("/dev/pmem_adsp",
2214 MemoryHeapBase::READ_ONLY,
2215 mCameraControlFd,
2216 MSM_PMEM_THUMBNAIL,
Srinivasan Kannan80d878f2009-12-18 15:06:02 -08002217 thumbnailBufferSize,
Priya Komarlingamb85535d2009-11-30 13:06:01 -08002218 1,
Srinivasan Kannan80d878f2009-12-18 15:06:02 -08002219 thumbnailBufferSize,
Priya Komarlingamb85535d2009-11-30 13:06:01 -08002220 "thumbnail");
2221
2222 if (!mThumbnailHeap->initialized()) {
2223 mThumbnailHeap.clear();
2224 mJpegHeap.clear();
2225 mRawHeap.clear();
2226 LOGE("initRaw X failed: error initializing mThumbnailHeap.");
2227 return false;
2228 }
2229 }
2230
2231 LOGV("initRaw X");
2232 return true;
2233}
2234
Srinivasan Kannan39dae8e2009-12-03 15:52:34 -08002235
2236void QualcommCameraHardware::deinitRawSnapshot()
2237{
2238 LOGV("deinitRawSnapshot E");
2239 mRawSnapShotPmemHeap.clear();
2240 mRawSnapshotAshmemHeap.clear();
2241 LOGV("deinitRawSnapshot X");
2242}
2243
Priya Komarlingamb85535d2009-11-30 13:06:01 -08002244void QualcommCameraHardware::deinitRaw()
2245{
2246 LOGV("deinitRaw E");
2247
2248 mThumbnailHeap.clear();
2249 mJpegHeap.clear();
2250 mRawHeap.clear();
2251 mDisplayHeap.clear();
2252
2253 LOGV("deinitRaw X");
2254}
2255
2256void QualcommCameraHardware::release()
2257{
2258 LOGD("release E");
2259 Mutex::Autolock l(&mLock);
2260
2261#if DLOPEN_LIBMMCAMERA
2262 if (libmmcamera == NULL) {
2263 LOGE("ERROR: multiple release!");
2264 return;
2265 }
2266#else
2267#warning "Cannot detect multiple release when not dlopen()ing libqcamera!"
2268#endif
2269
2270 int cnt, rc;
2271 struct msm_ctrl_cmd ctrlCmd;
2272
Sravankb4f5f1c2010-01-21 11:06:17 +05302273 // exit video thread
2274 mVideoThreadWaitLock.lock();
2275 LOGV("in release : making mVideoThreadExit 1");
2276 mVideoThreadExit = 1;
2277 mVideoThreadWaitLock.unlock();
2278 // 720p : signal the video thread , and check in video thread if stop is called, if so exit video thread.
2279 pthread_mutex_lock(&(g_busy_frame_queue.mut));
2280 pthread_cond_signal(&(g_busy_frame_queue.wait));
2281 pthread_mutex_unlock(&(g_busy_frame_queue.mut));
2282
Priya Komarlingamb85535d2009-11-30 13:06:01 -08002283 if (mCameraRunning) {
2284 if(mDataCallbackTimestamp && (mMsgEnabled & CAMERA_MSG_VIDEO_FRAME)) {
2285 mRecordFrameLock.lock();
2286 mReleasedRecordingFrame = true;
2287 mRecordWait.signal();
2288 mRecordFrameLock.unlock();
2289 }
2290 stopPreviewInternal();
2291 }
2292
Kiran Kumar H N8ff7b982010-01-25 13:54:39 -08002293 if( mCurrentTarget == TARGET_MSM7630 ) {
Kiran Kumar H N326cc4c2010-01-08 12:29:26 -08002294 mPostViewHeap.clear();
2295 mPostViewHeap = NULL;
2296 }
Priya Komarlingamb85535d2009-11-30 13:06:01 -08002297 LINK_jpeg_encoder_join();
2298 deinitRaw();
Srinivasan Kannan39dae8e2009-12-03 15:52:34 -08002299 deinitRawSnapshot();
Kiran Kumar H N215cac42009-12-08 01:53:46 -08002300 {
2301 Mutex::Autolock l(&mCamframeTimeoutLock);
2302 if(!camframe_timeout_flag) {
Priya Komarlingamb85535d2009-11-30 13:06:01 -08002303
Kiran Kumar H N215cac42009-12-08 01:53:46 -08002304 ctrlCmd.timeout_ms = 5000;
2305 ctrlCmd.length = 0;
2306 ctrlCmd.type = (uint16_t)CAMERA_EXIT;
2307 ctrlCmd.resp_fd = mCameraControlFd; // FIXME: this will be put in by the kernel
2308 if (ioctl(mCameraControlFd, MSM_CAM_IOCTL_CTRL_COMMAND, &ctrlCmd) < 0)
2309 LOGE("ioctl CAMERA_EXIT fd %d error %s",
2310 mCameraControlFd, strerror(errno));
Priya Komarlingamb85535d2009-11-30 13:06:01 -08002311
Kiran Kumar H N215cac42009-12-08 01:53:46 -08002312 }
Kiran Kumar H Nac2f4952009-12-17 01:16:53 -08002313 LINK_release_cam_conf_thread();
Kiran Kumar H N215cac42009-12-08 01:53:46 -08002314 }
Priya Komarlingamb85535d2009-11-30 13:06:01 -08002315 close(mCameraControlFd);
2316 mCameraControlFd = -1;
Mohan Kandra284966d2010-01-05 13:39:15 -08002317 if(fb_fd >= 0) {
2318 close(fb_fd);
2319 fb_fd = -1;
2320 }
Priya Komarlingamb85535d2009-11-30 13:06:01 -08002321#if DLOPEN_LIBMMCAMERA
2322 if (libmmcamera) {
2323 ::dlclose(libmmcamera);
2324 LOGV("dlclose(libqcamera)");
2325 libmmcamera = NULL;
2326 }
2327#endif
2328
2329 Mutex::Autolock lock(&singleton_lock);
2330 singleton_releasing = true;
2331
2332 LOGD("release X");
2333}
2334
2335QualcommCameraHardware::~QualcommCameraHardware()
2336{
2337 LOGD("~QualcommCameraHardware E");
2338 Mutex::Autolock lock(&singleton_lock);
2339 singleton.clear();
2340 singleton_releasing = false;
2341 singleton_wait.signal();
2342 LOGD("~QualcommCameraHardware X");
2343}
2344
2345sp<IMemoryHeap> QualcommCameraHardware::getRawHeap() const
2346{
2347 LOGV("getRawHeap");
2348 return mDisplayHeap != NULL ? mDisplayHeap->mHeap : NULL;
2349}
2350
2351sp<IMemoryHeap> QualcommCameraHardware::getPreviewHeap() const
2352{
2353 LOGV("getPreviewHeap");
Mohan Kandrad9efed92010-01-15 19:08:39 -08002354 return mPreviewHeap != NULL ? mPreviewHeap->mHeap : NULL;
Priya Komarlingamb85535d2009-11-30 13:06:01 -08002355}
2356
2357status_t QualcommCameraHardware::startPreviewInternal()
2358{
Sravankb4f5f1c2010-01-21 11:06:17 +05302359 LOGV("in startPreviewInternal : E");
Priya Komarlingamb85535d2009-11-30 13:06:01 -08002360 if(mCameraRunning) {
2361 LOGV("startPreview X: preview already running.");
2362 return NO_ERROR;
2363 }
2364
2365 if (!mPreviewInitialized) {
Kiran Kumar H N8ff7b982010-01-25 13:54:39 -08002366 mLastQueuedFrame = NULL;
Priya Komarlingamb85535d2009-11-30 13:06:01 -08002367 mPreviewInitialized = initPreview();
2368 if (!mPreviewInitialized) {
2369 LOGE("startPreview X initPreview failed. Not starting preview.");
2370 return UNKNOWN_ERROR;
2371 }
2372 }
2373
Kiran Kumar H N8ff7b982010-01-25 13:54:39 -08002374 if( mCurrentTarget != TARGET_MSM7630 )
2375 mCameraRunning = native_start_preview(mCameraControlFd);
Sravankb4f5f1c2010-01-21 11:06:17 +05302376 else
2377 mCameraRunning = native_start_video(mCameraControlFd);
2378
Priya Komarlingamb85535d2009-11-30 13:06:01 -08002379 if(!mCameraRunning) {
2380 deinitPreview();
2381 mPreviewInitialized = false;
Kiran Kumar H N5efb3ff2009-12-07 01:02:44 -08002382 mOverlay = NULL;
Priya Komarlingamb85535d2009-11-30 13:06:01 -08002383 LOGE("startPreview X: native_start_preview failed!");
2384 return UNKNOWN_ERROR;
2385 }
2386
Apurva Rajguru66bdd7f2009-12-10 19:28:02 -08002387 //Reset the Gps Information
2388 exif_table_numEntries = 0;
Mohan Kandra284966d2010-01-05 13:39:15 -08002389
2390 if(native_get_maxzoom(mCameraControlFd, (void *)&mMaxZoom) == true){
2391 LOGE("Maximum zoom value is %d", mMaxZoom);
2392 mParameters.set("zoom-supported", "true");
2393 } else {
2394 LOGE("Failed to get maximum zoom value...setting max zoom to zero");
2395 mParameters.set("zoom-supported", "false");
2396 mMaxZoom = 0;
2397 }
2398 mParameters.set("max-zoom",mMaxZoom);
2399
Sravankb4f5f1c2010-01-21 11:06:17 +05302400 LOGV("startPreviewInternal X");
Priya Komarlingamb85535d2009-11-30 13:06:01 -08002401 return NO_ERROR;
2402}
2403
2404status_t QualcommCameraHardware::startPreview()
2405{
2406 LOGV("startPreview E");
2407 Mutex::Autolock l(&mLock);
2408 return startPreviewInternal();
2409}
2410
2411void QualcommCameraHardware::stopPreviewInternal()
2412{
2413 LOGV("stopPreviewInternal E: %d", mCameraRunning);
2414 if (mCameraRunning) {
2415 // Cancel auto focus.
2416 {
2417 if (mNotifyCallback && (mMsgEnabled & CAMERA_MSG_FOCUS)) {
2418 cancelAutoFocusInternal();
2419 }
2420 }
Kiran Kumar H N326cc4c2010-01-08 12:29:26 -08002421
Kiran Kumar H N215cac42009-12-08 01:53:46 -08002422 Mutex::Autolock l(&mCamframeTimeoutLock);
2423 if(!camframe_timeout_flag) {
Kiran Kumar H N8ff7b982010-01-25 13:54:39 -08002424 if ( mCurrentTarget != TARGET_MSM7630 )
Sravankb4f5f1c2010-01-21 11:06:17 +05302425 mCameraRunning = !native_stop_preview(mCameraControlFd);
2426 else
2427 mCameraRunning = !native_stop_video(mCameraControlFd);
2428
Kiran Kumar H N215cac42009-12-08 01:53:46 -08002429 } else {
2430 /* This means that the camframetimeout was issued.
2431 * But we did not issue native_stop_preview(), so we
Kiran Kumar H Nac2f4952009-12-17 01:16:53 -08002432 * need to update mCameraRunning to indicate that
2433 * Camera is no longer running. */
Kiran Kumar H N215cac42009-12-08 01:53:46 -08002434 mCameraRunning = 0;
Kiran Kumar H Nac2f4952009-12-17 01:16:53 -08002435 }
2436 if (!mCameraRunning && mPreviewInitialized) {
2437 deinitPreview();
Kiran Kumar H N215cac42009-12-08 01:53:46 -08002438 mPreviewInitialized = false;
2439 }
Kiran Kumar H Nac2f4952009-12-17 01:16:53 -08002440 else LOGE("stopPreviewInternal: failed to stop preview");
Priya Komarlingamb85535d2009-11-30 13:06:01 -08002441 }
2442 LOGV("stopPreviewInternal X: %d", mCameraRunning);
2443}
2444
2445void QualcommCameraHardware::stopPreview()
2446{
2447 LOGV("stopPreview: E");
2448 Mutex::Autolock l(&mLock);
2449 {
2450 if (mDataCallbackTimestamp && (mMsgEnabled & CAMERA_MSG_VIDEO_FRAME))
2451 return;
2452 }
2453 stopPreviewInternal();
2454 LOGV("stopPreview: X");
2455}
2456
2457void QualcommCameraHardware::runAutoFocus()
2458{
2459 bool status = true;
2460 void *libhandle = NULL;
Srinivasan Kannan71229622009-12-04 12:05:58 -08002461 isp3a_af_mode_t afMode;
Priya Komarlingamb85535d2009-11-30 13:06:01 -08002462
2463 mAutoFocusThreadLock.lock();
2464 // Skip autofocus if focus mode is infinity.
2465 if (strcmp(mParameters.get(CameraParameters::KEY_FOCUS_MODE),
2466 CameraParameters::FOCUS_MODE_INFINITY) == 0) {
2467 goto done;
2468 }
2469
2470 mAutoFocusFd = open(MSM_CAMERA_CONTROL, O_RDWR);
2471 if (mAutoFocusFd < 0) {
2472 LOGE("autofocus: cannot open %s: %s",
2473 MSM_CAMERA_CONTROL,
2474 strerror(errno));
2475 mAutoFocusThreadRunning = false;
2476 mAutoFocusThreadLock.unlock();
2477 return;
2478 }
2479
2480#if DLOPEN_LIBMMCAMERA
2481 // We need to maintain a reference to libqcamera.so for the duration of the
2482 // AF thread, because we do not know when it will exit relative to the
2483 // lifetime of this object. We do not want to dlclose() libqcamera while
2484 // LINK_cam_frame is still running.
2485 libhandle = ::dlopen("liboemcamera.so", RTLD_NOW);
2486 LOGV("AF: loading libqcamera at %p", libhandle);
2487 if (!libhandle) {
2488 LOGE("FATAL ERROR: could not dlopen liboemcamera.so: %s", dlerror());
2489 close(mAutoFocusFd);
2490 mAutoFocusFd = -1;
2491 mAutoFocusThreadRunning = false;
2492 mAutoFocusThreadLock.unlock();
2493 return;
2494 }
2495#endif
2496
Srinivasan Kannan71229622009-12-04 12:05:58 -08002497 afMode = (isp3a_af_mode_t)attr_lookup(focus_modes,
2498 sizeof(focus_modes) / sizeof(str_map),
2499 mParameters.get(CameraParameters::KEY_FOCUS_MODE));
2500
Priya Komarlingamb85535d2009-11-30 13:06:01 -08002501 /* This will block until either AF completes or is cancelled. */
Srinivasan Kannan71229622009-12-04 12:05:58 -08002502 LOGV("af start (fd %d mode %d)", mAutoFocusFd, afMode);
2503 status = native_set_afmode(mAutoFocusFd, afMode);
Priya Komarlingamb85535d2009-11-30 13:06:01 -08002504 LOGV("af done: %d", (int)status);
2505 close(mAutoFocusFd);
2506 mAutoFocusFd = -1;
2507
2508done:
2509 mAutoFocusThreadRunning = false;
2510 mAutoFocusThreadLock.unlock();
2511
2512 mCallbackLock.lock();
2513 bool autoFocusEnabled = mNotifyCallback && (mMsgEnabled & CAMERA_MSG_FOCUS);
2514 notify_callback cb = mNotifyCallback;
2515 void *data = mCallbackCookie;
2516 mCallbackLock.unlock();
2517 if (autoFocusEnabled)
2518 cb(CAMERA_MSG_FOCUS, status, 0, data);
2519
2520#if DLOPEN_LIBMMCAMERA
2521 if (libhandle) {
2522 ::dlclose(libhandle);
2523 LOGV("AF: dlclose(libqcamera)");
2524 }
2525#endif
2526}
2527
2528status_t QualcommCameraHardware::cancelAutoFocusInternal()
2529{
2530 LOGV("cancelAutoFocusInternal E");
2531
Srinivasan Kannan71229622009-12-04 12:05:58 -08002532 if(!sensorType->hasAutoFocusSupport){
2533 LOGV("cancelAutoFocusInternal X");
2534 return NO_ERROR;
2535 }
2536
Priya Komarlingamb85535d2009-11-30 13:06:01 -08002537#if 0
2538 if (mAutoFocusFd < 0) {
2539 LOGV("cancelAutoFocusInternal X: not in progress");
2540 return NO_ERROR;
2541 }
2542#endif
2543
2544 status_t rc = native_cancel_afmode(mCameraControlFd, mAutoFocusFd) ?
2545 NO_ERROR :
2546 UNKNOWN_ERROR;
2547
2548 LOGV("cancelAutoFocusInternal X: %d", rc);
2549 return rc;
2550}
2551
2552void *auto_focus_thread(void *user)
2553{
2554 LOGV("auto_focus_thread E");
2555 sp<QualcommCameraHardware> obj = QualcommCameraHardware::getInstance();
2556 if (obj != 0) {
2557 obj->runAutoFocus();
2558 }
2559 else LOGW("not starting autofocus: the object went away!");
2560 LOGV("auto_focus_thread X");
2561 return NULL;
2562}
2563
2564status_t QualcommCameraHardware::autoFocus()
2565{
2566 LOGV("autoFocus E");
2567 Mutex::Autolock l(&mLock);
2568
Srinivasan Kannan71229622009-12-04 12:05:58 -08002569 if(!sensorType->hasAutoFocusSupport){
Srinivasan Kannandf085222009-12-09 18:31:00 -08002570 bool status = false;
2571 mCallbackLock.lock();
2572 bool autoFocusEnabled = mNotifyCallback && (mMsgEnabled & CAMERA_MSG_FOCUS);
2573 notify_callback cb = mNotifyCallback;
2574 void *data = mCallbackCookie;
2575 mCallbackLock.unlock();
2576 if (autoFocusEnabled)
2577 cb(CAMERA_MSG_FOCUS, status, 0, data);
Srinivasan Kannan71229622009-12-04 12:05:58 -08002578 LOGV("autoFocus X");
2579 return NO_ERROR;
2580 }
2581
Priya Komarlingamb85535d2009-11-30 13:06:01 -08002582 if (mCameraControlFd < 0) {
2583 LOGE("not starting autofocus: main control fd %d", mCameraControlFd);
2584 return UNKNOWN_ERROR;
2585 }
2586
2587 {
2588 mAutoFocusThreadLock.lock();
2589 if (!mAutoFocusThreadRunning) {
2590 // Create a detached thread here so that we don't have to wait
2591 // for it when we cancel AF.
2592 pthread_t thr;
2593 pthread_attr_t attr;
2594 pthread_attr_init(&attr);
2595 pthread_attr_setdetachstate(&attr, PTHREAD_CREATE_DETACHED);
2596 mAutoFocusThreadRunning =
2597 !pthread_create(&thr, &attr,
2598 auto_focus_thread, NULL);
2599 if (!mAutoFocusThreadRunning) {
2600 LOGE("failed to start autofocus thread");
2601 mAutoFocusThreadLock.unlock();
2602 return UNKNOWN_ERROR;
2603 }
2604 }
2605 mAutoFocusThreadLock.unlock();
2606 }
2607
2608 LOGV("autoFocus X");
2609 return NO_ERROR;
2610}
2611
2612status_t QualcommCameraHardware::cancelAutoFocus()
2613{
2614 LOGV("cancelAutoFocus E");
2615 Mutex::Autolock l(&mLock);
2616
2617 int rc = NO_ERROR;
2618 if (mCameraRunning && mNotifyCallback && (mMsgEnabled & CAMERA_MSG_FOCUS)) {
2619 rc = cancelAutoFocusInternal();
2620 }
2621
2622 LOGV("cancelAutoFocus X");
2623 return rc;
2624}
2625
2626void QualcommCameraHardware::runSnapshotThread(void *data)
2627{
2628 LOGV("runSnapshotThread E");
Srinivasan Kannan39dae8e2009-12-03 15:52:34 -08002629 if(mSnapshotFormat == PICTURE_FORMAT_JPEG){
2630 if (native_start_snapshot(mCameraControlFd))
2631 receiveRawPicture();
2632 else
2633 LOGE("main: native_start_snapshot failed!");
2634 } else if(mSnapshotFormat == PICTURE_FORMAT_RAW){
2635 if(native_start_raw_snapshot(mCameraControlFd)){
2636 receiveRawSnapshot();
2637 } else {
2638 LOGE("main: native_start_raw_snapshot failed!");
2639 }
2640 }
2641
2642 mSnapshotFormat = 0;
Priya Komarlingamb85535d2009-11-30 13:06:01 -08002643
2644 mSnapshotThreadWaitLock.lock();
2645 mSnapshotThreadRunning = false;
2646 mSnapshotThreadWait.signal();
2647 mSnapshotThreadWaitLock.unlock();
2648
2649 LOGV("runSnapshotThread X");
2650}
2651
2652void *snapshot_thread(void *user)
2653{
2654 LOGD("snapshot_thread E");
2655 sp<QualcommCameraHardware> obj = QualcommCameraHardware::getInstance();
2656 if (obj != 0) {
2657 obj->runSnapshotThread(user);
2658 }
2659 else LOGW("not starting snapshot thread: the object went away!");
2660 LOGD("snapshot_thread X");
2661 return NULL;
2662}
2663
2664status_t QualcommCameraHardware::takePicture()
2665{
2666 LOGV("takePicture(%d)", mMsgEnabled);
2667 Mutex::Autolock l(&mLock);
2668
2669 // Wait for old snapshot thread to complete.
2670 mSnapshotThreadWaitLock.lock();
2671 while (mSnapshotThreadRunning) {
2672 LOGV("takePicture: waiting for old snapshot thread to complete.");
2673 mSnapshotThreadWait.wait(mSnapshotThreadWaitLock);
2674 LOGV("takePicture: old snapshot thread completed.");
2675 }
2676
Kiran Kumar H N8ff7b982010-01-25 13:54:39 -08002677 if( mCurrentTarget == TARGET_MSM7630 ) {
Kiran Kumar H N326cc4c2010-01-08 12:29:26 -08002678 /* Store the last frame queued for preview. This
2679 * shall be used as postview */
2680 storePreviewFrameForPostview();
2681 }
2682
Srinivasan Kannan39dae8e2009-12-03 15:52:34 -08002683 //mSnapshotFormat is protected by mSnapshotThreadWaitLock
2684 if(mParameters.getPictureFormat() != 0 &&
2685 !strcmp(mParameters.getPictureFormat(),
2686 CameraParameters::PIXEL_FORMAT_RAW))
2687 mSnapshotFormat = PICTURE_FORMAT_RAW;
2688 else
2689 mSnapshotFormat = PICTURE_FORMAT_JPEG;
2690
2691 if(mSnapshotFormat == PICTURE_FORMAT_JPEG){
2692 if(!native_prepare_snapshot(mCameraControlFd)) {
2693 mSnapshotThreadWaitLock.unlock();
2694 return UNKNOWN_ERROR;
2695 }
Priya Komarlingamb85535d2009-11-30 13:06:01 -08002696 }
2697
2698 stopPreviewInternal();
2699
Srinivasan Kannan39dae8e2009-12-03 15:52:34 -08002700 if(mSnapshotFormat == PICTURE_FORMAT_JPEG){
2701 if (!initRaw(mDataCallback && (mMsgEnabled & CAMERA_MSG_COMPRESSED_IMAGE))) {
2702 LOGE("initRaw failed. Not taking picture.");
2703 mSnapshotThreadWaitLock.unlock();
2704 return UNKNOWN_ERROR;
2705 }
2706 } else if(mSnapshotFormat == PICTURE_FORMAT_RAW ){
2707 if(!initRawSnapshot()){
2708 LOGE("initRawSnapshot failed. Not taking picture.");
2709 mSnapshotThreadWaitLock.unlock();
2710 return UNKNOWN_ERROR;
2711 }
Priya Komarlingamb85535d2009-11-30 13:06:01 -08002712 }
2713
2714 mShutterLock.lock();
2715 mShutterPending = true;
2716 mShutterLock.unlock();
2717
2718 pthread_attr_t attr;
2719 pthread_attr_init(&attr);
2720 pthread_attr_setdetachstate(&attr, PTHREAD_CREATE_DETACHED);
2721 mSnapshotThreadRunning = !pthread_create(&mSnapshotThread,
2722 &attr,
2723 snapshot_thread,
2724 NULL);
2725 mSnapshotThreadWaitLock.unlock();
2726
2727 LOGV("takePicture: X");
2728 return mSnapshotThreadRunning ? NO_ERROR : UNKNOWN_ERROR;
2729}
2730
2731status_t QualcommCameraHardware::cancelPicture()
2732{
2733 status_t rc;
2734 LOGV("cancelPicture: E");
2735 rc = native_stop_snapshot(mCameraControlFd) ? NO_ERROR : UNKNOWN_ERROR;
2736 LOGV("cancelPicture: X: %d", rc);
2737 return rc;
2738}
2739
2740status_t QualcommCameraHardware::setParameters(const CameraParameters& params)
2741{
2742 LOGV("setParameters: E params = %p", &params);
2743
2744 Mutex::Autolock l(&mLock);
2745 status_t rc, final_rc = NO_ERROR;
2746
2747 if ((rc = setPreviewSize(params))) final_rc = rc;
2748 if ((rc = setPictureSize(params))) final_rc = rc;
2749 if ((rc = setJpegQuality(params))) final_rc = rc;
2750 if ((rc = setAntibanding(params))) final_rc = rc;
2751 if ((rc = setEffect(params))) final_rc = rc;
Apurva Rajguru55562b02009-12-03 12:25:35 -08002752 if ((rc = setAutoExposure(params))) final_rc = rc;
Priya Komarlingamb85535d2009-11-30 13:06:01 -08002753 if ((rc = setWhiteBalance(params))) final_rc = rc;
2754 if ((rc = setFlash(params))) final_rc = rc;
2755 if ((rc = setGpsLocation(params))) final_rc = rc;
2756 if ((rc = setRotation(params))) final_rc = rc;
2757 if ((rc = setZoom(params))) final_rc = rc;
2758 if ((rc = setFocusMode(params))) final_rc = rc;
2759 if ((rc = setOrientation(params))) final_rc = rc;
Nishant Panditc8c1ee72009-12-03 16:24:02 +05302760 if ((rc = setBrightness(params))) final_rc = rc;
2761 if ((rc = setLensshadeValue(params))) final_rc = rc;
2762 if ((rc = setISOValue(params))) final_rc = rc;
Srinivasan Kannan39dae8e2009-12-03 15:52:34 -08002763 if ((rc = setPictureFormat(params))) final_rc = rc;
Srinivasan Kannanbddfd502010-01-03 17:27:36 -08002764 if ((rc = setSharpness(params))) final_rc = rc;
2765 if ((rc = setContrast(params))) final_rc = rc;
2766 if ((rc = setSaturation(params))) final_rc = rc;
Priya Komarlingamb85535d2009-11-30 13:06:01 -08002767
2768 LOGV("setParameters: X");
2769 return final_rc;
2770}
2771
2772CameraParameters QualcommCameraHardware::getParameters() const
2773{
2774 LOGV("getParameters: EX");
2775 return mParameters;
2776}
2777
2778status_t QualcommCameraHardware::sendCommand(int32_t command, int32_t arg1,
2779 int32_t arg2)
2780{
2781 LOGV("sendCommand: EX");
2782 return BAD_VALUE;
2783}
2784
2785extern "C" sp<CameraHardwareInterface> openCameraHardware()
2786{
2787 LOGV("openCameraHardware: call createInstance");
2788 return QualcommCameraHardware::createInstance();
2789}
2790
2791wp<QualcommCameraHardware> QualcommCameraHardware::singleton;
2792
2793// If the hardware already exists, return a strong pointer to the current
2794// object. If not, create a new hardware object, put it in the singleton,
2795// and return it.
2796sp<CameraHardwareInterface> QualcommCameraHardware::createInstance()
2797{
2798 LOGD("createInstance: E");
2799
2800 Mutex::Autolock lock(&singleton_lock);
2801
2802 // Wait until the previous release is done.
2803 while (singleton_releasing) {
2804 LOGD("Wait for previous release.");
2805 singleton_wait.wait(singleton_lock);
2806 }
2807
2808 if (singleton != 0) {
2809 sp<CameraHardwareInterface> hardware = singleton.promote();
2810 if (hardware != 0) {
2811 LOGD("createInstance: X return existing hardware=%p", &(*hardware));
2812 return hardware;
2813 }
2814 }
2815
2816 {
2817 struct stat st;
2818 int rc = stat("/dev/oncrpc", &st);
2819 if (rc < 0) {
2820 LOGD("createInstance: X failed to create hardware: %s", strerror(errno));
2821 return NULL;
2822 }
2823 }
2824
2825 QualcommCameraHardware *cam = new QualcommCameraHardware();
2826 sp<QualcommCameraHardware> hardware(cam);
2827 singleton = hardware;
2828
2829 if (!cam->startCamera()) {
2830 LOGE("%s: startCamera failed!", __FUNCTION__);
2831 return NULL;
2832 }
2833
2834 cam->initDefaultParameters();
2835 LOGD("createInstance: X created hardware=%p", &(*hardware));
2836 return hardware;
2837}
2838
2839// For internal use only, hence the strong pointer to the derived type.
2840sp<QualcommCameraHardware> QualcommCameraHardware::getInstance()
2841{
2842 sp<CameraHardwareInterface> hardware = singleton.promote();
2843 if (hardware != 0) {
2844 // LOGV("getInstance: X old instance of hardware");
2845 return sp<QualcommCameraHardware>(static_cast<QualcommCameraHardware*>(hardware.get()));
2846 } else {
2847 LOGV("getInstance: X new instance of hardware");
2848 return sp<QualcommCameraHardware>();
2849 }
2850}
Sravankb4f5f1c2010-01-21 11:06:17 +05302851void QualcommCameraHardware::receiveRecordingFrame(struct msm_frame *frame)
2852{
2853 LOGV("receiveRecordingFrame E");
2854 // post busy frame
2855 if (frame)
2856 {
2857 cam_frame_post_video (frame);
2858 }
2859 else LOGE("in receiveRecordingFrame frame is NULL");
2860 LOGV("receiveRecordingFrame X");
2861}
2862
Priya Komarlingamb85535d2009-11-30 13:06:01 -08002863
Mohan Kandrad9efed92010-01-15 19:08:39 -08002864bool QualcommCameraHardware::native_zoom_image(int fd, int srcOffset, int dstOffSet, common_crop_t *crop)
Mohan Kandra284966d2010-01-05 13:39:15 -08002865{
2866 int result = 0;
2867 struct mdp_blit_req *e;
2868 struct timeval td1, td2;
2869
Mohan Kandra284966d2010-01-05 13:39:15 -08002870 /* Initialize yuv structure */
2871 zoomImage.list.count = 1;
2872
2873 e = &zoomImage.list.req[0];
2874
2875 e->src.width = previewWidth;
2876 e->src.height = previewHeight;
2877 e->src.format = MDP_Y_CBCR_H2V2;
Mohan Kandrad9efed92010-01-15 19:08:39 -08002878 e->src.offset = srcOffset;
2879 e->src.memory_id = fd;
Mohan Kandra284966d2010-01-05 13:39:15 -08002880
2881 e->dst.width = previewWidth;
2882 e->dst.height = previewHeight;
2883 e->dst.format = MDP_Y_CBCR_H2V2;
Mohan Kandrad9efed92010-01-15 19:08:39 -08002884 e->dst.offset = dstOffSet;
2885 e->dst.memory_id = fd;
Mohan Kandra284966d2010-01-05 13:39:15 -08002886
2887 e->transp_mask = 0xffffffff;
2888 e->flags = 0;
2889 e->alpha = 0xff;
2890 if (crop->in2_w != 0 || crop->in2_h != 0) {
2891 e->src_rect.x = (crop->out2_w - crop->in2_w + 1) / 2 - 1;
2892 e->src_rect.y = (crop->out2_h - crop->in2_h + 1) / 2 - 1;
2893 e->src_rect.w = crop->in2_w;
2894 e->src_rect.h = crop->in2_h;
2895 } else {
2896 e->src_rect.x = 0;
2897 e->src_rect.y = 0;
2898 e->src_rect.w = previewWidth;
2899 e->src_rect.h = previewHeight;
2900 }
Mohan Kandrad9efed92010-01-15 19:08:39 -08002901 //LOGV(" native_zoom : SRC_RECT : x,y = %d,%d \t w,h = %d, %d",
2902 // e->src_rect.x, e->src_rect.y, e->src_rect.w, e->src_rect.h);
Mohan Kandra284966d2010-01-05 13:39:15 -08002903
2904 e->dst_rect.x = 0;
2905 e->dst_rect.y = 0;
2906 e->dst_rect.w = previewWidth;
2907 e->dst_rect.h = previewHeight;
2908
2909 result = ioctl(fb_fd, MSMFB_BLIT, &zoomImage.list);
2910 if (result < 0) {
2911 LOGE("MSM_FBIOBLT failed! line=%d\n", __LINE__);
2912 return FALSE;
2913 }
2914 return TRUE;
2915}
2916
Mohan Kandra740cfce2010-01-07 12:58:24 -08002917void QualcommCameraHardware::debugShowFPS() const
2918{
2919 static int mFrameCount;
2920 static int mLastFrameCount = 0;
2921 static nsecs_t mLastFpsTime = 0;
2922 static float mFps = 0;
2923 mFrameCount++;
2924 nsecs_t now = systemTime();
2925 nsecs_t diff = now - mLastFpsTime;
2926 if (diff > ms2ns(250)) {
2927 mFps = ((mFrameCount - mLastFrameCount) * float(s2ns(1))) / diff;
2928 LOGI("Frames Per Second: %.4f", mFps);
2929 mLastFpsTime = now;
2930 mLastFrameCount = mFrameCount;
2931 }
2932}
2933
Priya Komarlingamb85535d2009-11-30 13:06:01 -08002934void QualcommCameraHardware::receivePreviewFrame(struct msm_frame *frame)
2935{
2936// LOGV("receivePreviewFrame E");
2937
2938 if (!mCameraRunning) {
2939 LOGE("ignoring preview callback--camera has been stopped");
2940 return;
2941 }
2942
Mohan Kandra740cfce2010-01-07 12:58:24 -08002943 if (UNLIKELY(mDebugFps)) {
2944 debugShowFPS();
2945 }
2946
Priya Komarlingamb85535d2009-11-30 13:06:01 -08002947 mCallbackLock.lock();
2948 int msgEnabled = mMsgEnabled;
2949 data_callback pcb = mDataCallback;
2950 void *pdata = mCallbackCookie;
2951 data_callback_timestamp rcb = mDataCallbackTimestamp;
2952 void *rdata = mCallbackCookie;
2953 mCallbackLock.unlock();
2954
2955 // Find the offset within the heap of the current buffer.
Mohan Kandra284966d2010-01-05 13:39:15 -08002956 ssize_t offset_addr =
Mohan Kandrad9efed92010-01-15 19:08:39 -08002957 (ssize_t)frame->buffer - (ssize_t)mPreviewHeap->mHeap->base();
2958 ssize_t offset = offset_addr / mPreviewHeap->mAlignedBufferSize;
Mohan Kandra284966d2010-01-05 13:39:15 -08002959
2960 common_crop_t *crop = (common_crop_t *) (frame->cropinfo);
Priya Komarlingamb85535d2009-11-30 13:06:01 -08002961
2962 mInPreviewCallback = true;
Kiran Kumar H N326cc4c2010-01-08 12:29:26 -08002963 if(mUseOverlay) {
2964 if(mOverlay != NULL) {
2965 mOverlayLock.lock();
Mohan Kandrad9efed92010-01-15 19:08:39 -08002966 mOverlay->setFd(mPreviewHeap->mHeap->getHeapID());
Kiran Kumar H N326cc4c2010-01-08 12:29:26 -08002967 if (crop->in2_w != 0 || crop->in2_h != 0) {
2968 zoomCropInfo.x = (crop->out2_w - crop->in2_w + 1) / 2 - 1;
2969 zoomCropInfo.y = (crop->out2_h - crop->in2_h + 1) / 2 - 1;
2970 zoomCropInfo.w = crop->in2_w;
2971 zoomCropInfo.h = crop->in2_h;
2972 mOverlay->setCrop(zoomCropInfo.x, zoomCropInfo.y,
2973 zoomCropInfo.w, zoomCropInfo.h);
Kiran Kumar H N8ff7b982010-01-25 13:54:39 -08002974 } else {
2975 // Reset zoomCropInfo variables. This will ensure that
2976 // stale values wont be used for postview
2977 zoomCropInfo.w = crop->in2_w;
2978 zoomCropInfo.h = crop->in2_h;
2979 }
Kiran Kumar H N326cc4c2010-01-08 12:29:26 -08002980 mOverlay->queueBuffer((void *)offset_addr);
2981 mLastQueuedFrame = (void *)frame->buffer;
2982 mOverlayLock.unlock();
2983 }
Mohan Kandra284966d2010-01-05 13:39:15 -08002984 } else {
Mohan Kandrad9efed92010-01-15 19:08:39 -08002985 if (crop->in2_w != 0 || crop->in2_h != 0) {
2986 dstOffset = (dstOffset + 1) % NUM_MORE_BUFS;
2987 offset = kPreviewBufferCount + dstOffset;
2988 ssize_t dstOffset_addr = offset * mPreviewHeap->mAlignedBufferSize;
2989 if( !native_zoom_image(mPreviewHeap->mHeap->getHeapID(),
2990 offset_addr, dstOffset_addr, crop)) {
2991 LOGE(" Error while doing MDP zoom ");
2992 }
2993 }
Kiran Kumar H N5efb3ff2009-12-07 01:02:44 -08002994 }
Mohan Kandrad9efed92010-01-15 19:08:39 -08002995 if (pcb != NULL && (msgEnabled & CAMERA_MSG_PREVIEW_FRAME))
2996 pcb(CAMERA_MSG_PREVIEW_FRAME, mPreviewHeap->mBuffers[offset],
2997 pdata);
2998
Sravankb4f5f1c2010-01-21 11:06:17 +05302999 // If output2 enabled, Start Recording if recording is enabled by Services
Kiran Kumar H N8ff7b982010-01-25 13:54:39 -08003000 if( (mCurrentTarget == TARGET_MSM7630) && recordingEnabled() ) {
Sravankb4f5f1c2010-01-21 11:06:17 +05303001 if(!recordingState){
3002 recordingState = 1; // recording started
3003 LOGV(" in receivePreviewframe : recording enabled calling startRecording ");
3004 startRecording();
Priya Komarlingamb85535d2009-11-30 13:06:01 -08003005 }
Sravankb4f5f1c2010-01-21 11:06:17 +05303006 }
3007
3008 // If output is NOT enabled (targets otherthan 7x30 currently..)
Kiran Kumar H N8ff7b982010-01-25 13:54:39 -08003009 if( mCurrentTarget != TARGET_MSM7630 ) {
Sravankb4f5f1c2010-01-21 11:06:17 +05303010 if(rcb != NULL && (msgEnabled & CAMERA_MSG_VIDEO_FRAME)) {
3011 rcb(systemTime(), CAMERA_MSG_VIDEO_FRAME, mPreviewHeap->mBuffers[offset], rdata);
3012 Mutex::Autolock rLock(&mRecordFrameLock);
3013 if (mReleasedRecordingFrame != true) {
3014 LOGV("block waiting for frame release");
3015 mRecordWait.wait(mRecordFrameLock);
3016 LOGV("frame released, continuing");
3017 }
3018 mReleasedRecordingFrame = false;
3019 }
Priya Komarlingamb85535d2009-11-30 13:06:01 -08003020 }
3021 mInPreviewCallback = false;
3022
3023// LOGV("receivePreviewFrame X");
3024}
3025
Sravankb4f5f1c2010-01-21 11:06:17 +05303026
3027bool QualcommCameraHardware::initRecord()
3028{
3029 LOGV("initREcord E");
3030
3031 mRecordFrameSize = (mDimension.video_width * mDimension.video_height *3)/2;
3032 mRecordHeap = new PmemPool("/dev/pmem_adsp",
3033 MemoryHeapBase::READ_ONLY | MemoryHeapBase::NO_CACHING,
3034 mCameraControlFd,
3035 MSM_PMEM_VIDEO,
3036 mRecordFrameSize,
3037 kRecordBufferCount,
3038 mRecordFrameSize,
3039 "record");
3040 if (!mRecordHeap->initialized()) {
3041 mRecordHeap.clear();
3042 LOGE("initRecord X: could not initialize record heap.");
3043 return false;
3044 }
3045 for (int cnt = 0; cnt < kRecordBufferCount; cnt++) {
3046 recordframes[cnt].fd = mRecordHeap->mHeap->getHeapID();
3047 recordframes[cnt].buffer =
3048 (uint32_t)mRecordHeap->mHeap->base() + mRecordHeap->mAlignedBufferSize * cnt;
3049 recordframes[cnt].y_off = 0;
3050 recordframes[cnt].cbcr_off = mDimension.video_width * mDimension.video_height;
3051 recordframes[cnt].path = OUTPUT_TYPE_V;
3052
3053 LOGV ("initRecord : record heap , video buffers buffer=%lu fd=%d y_off=%d cbcr_off=%d \n",
3054 (unsigned long)recordframes[cnt].buffer, recordframes[cnt].fd, recordframes[cnt].y_off,
3055 recordframes[cnt].cbcr_off);
3056 }
3057
3058 // initial setup : buffers 1,2,3 with kernel , 4 with camframe , 5,6,7,8 in free Q
3059 // flush the busy Q
3060 cam_frame_flush_video();
3061
3062 // Start video thread and wait for busy frames to be encoded.
3063 mVideoThreadWaitLock.lock();
3064 mVideoThreadExit = 0;
3065 pthread_attr_t attr;
3066 pthread_attr_init(&attr);
3067 pthread_attr_setdetachstate(&attr, PTHREAD_CREATE_DETACHED);
3068 pthread_create(&mVideoThread,
3069 &attr,
3070 video_thread,
3071 NULL);
3072 mVideoThreadWaitLock.unlock();
3073 LOGV("initREcord X");
3074
3075 return true;
3076}
3077
Priya Komarlingamb85535d2009-11-30 13:06:01 -08003078status_t QualcommCameraHardware::startRecording()
3079{
3080 LOGV("startRecording E");
Sravankb4f5f1c2010-01-21 11:06:17 +05303081 int ret;
Priya Komarlingamb85535d2009-11-30 13:06:01 -08003082 Mutex::Autolock l(&mLock);
3083 mReleasedRecordingFrame = false;
Sravankb4f5f1c2010-01-21 11:06:17 +05303084 if( (ret=startPreviewInternal())== NO_ERROR){
Kiran Kumar H N8ff7b982010-01-25 13:54:39 -08003085 if( mCurrentTarget == TARGET_MSM7630 ) {
Sravankb4f5f1c2010-01-21 11:06:17 +05303086 // flush free queue and add 5,6,7,8 buffers.
3087 LINK_cam_frame_flush_free_video();
3088 for(int i=ACTIVE_VIDEO_BUFFERS+1;i <kRecordBufferCount; i++)
3089 LINK_camframe_free_video(&recordframes[i]);
3090
3091 LOGV(" in startREcording : calling native_start_recording");
3092 native_start_recording(mCameraControlFd);
3093 recordingState = 1;
3094 }
3095 }
3096 return ret;
Priya Komarlingamb85535d2009-11-30 13:06:01 -08003097}
3098
3099void QualcommCameraHardware::stopRecording()
3100{
3101 LOGV("stopRecording: E");
3102 Mutex::Autolock l(&mLock);
3103 {
3104 mRecordFrameLock.lock();
3105 mReleasedRecordingFrame = true;
3106 mRecordWait.signal();
3107 mRecordFrameLock.unlock();
3108
3109 if(mDataCallback && (mMsgEnabled & CAMERA_MSG_PREVIEW_FRAME)) {
3110 LOGV("stopRecording: X, preview still in progress");
3111 return;
3112 }
3113 }
Sravankb4f5f1c2010-01-21 11:06:17 +05303114 // If output2 enabled, exit video thread, invoke stop recording ioctl
Kiran Kumar H N8ff7b982010-01-25 13:54:39 -08003115 if( mCurrentTarget == TARGET_MSM7630 ) {
Sravankb4f5f1c2010-01-21 11:06:17 +05303116 mVideoThreadWaitLock.lock();
3117 mVideoThreadExit = 1;
3118 mVideoThreadWaitLock.unlock();
3119 native_stop_recording(mCameraControlFd);
3120 }
3121 else // for other targets where output2 is not enabled
3122 stopPreviewInternal();
Priya Komarlingamb85535d2009-11-30 13:06:01 -08003123
Sravankb4f5f1c2010-01-21 11:06:17 +05303124 recordingState = 0; // recording not started
Priya Komarlingamb85535d2009-11-30 13:06:01 -08003125 LOGV("stopRecording: X");
3126}
3127
3128void QualcommCameraHardware::releaseRecordingFrame(
3129 const sp<IMemory>& mem __attribute__((unused)))
3130{
3131 LOGV("releaseRecordingFrame E");
3132 Mutex::Autolock rLock(&mRecordFrameLock);
3133 mReleasedRecordingFrame = true;
3134 mRecordWait.signal();
Sravankb4f5f1c2010-01-21 11:06:17 +05303135
3136 // Ff 7x30 : add the frame to the free camframe queue
Kiran Kumar H N8ff7b982010-01-25 13:54:39 -08003137 if( mCurrentTarget == TARGET_MSM7630 ) {
Sravankb4f5f1c2010-01-21 11:06:17 +05303138 ssize_t offset;
3139 size_t size;
3140 sp<IMemoryHeap> heap = mem->getMemory(&offset, &size);
3141 msm_frame* releaseframe = NULL;
3142 LOGV(" in release recording frame : heap base %d offset %d buffer %d ", heap->base(), offset, heap->base() + offset );
3143 int cnt;
3144 for (cnt = 0; cnt < kRecordBufferCount; cnt++) {
3145 if((unsigned int)recordframes[cnt].buffer == (unsigned int)(heap->base()+ offset)){
3146 LOGV("in release recording frame found match , releasing buffer %d", (unsigned int)recordframes[cnt].buffer);
3147 releaseframe = &recordframes[cnt];
3148 break;
3149 }
3150 }
3151 if(cnt < kRecordBufferCount) {
3152 // do this only if frame thread is running
3153 mFrameThreadWaitLock.lock();
3154 if(mFrameThreadRunning )
3155 LINK_camframe_free_video(releaseframe);
3156
3157 mFrameThreadWaitLock.unlock();
3158 } else {
3159 LOGE("in release recordingframe XXXXX error , buffer not found");
3160 for (int i=0; i< kRecordBufferCount; i++) {
3161 LOGE(" recordframes[%d].buffer = %d", i, (unsigned int)recordframes[i].buffer);
3162 }
3163 }
3164 }
3165
Priya Komarlingamb85535d2009-11-30 13:06:01 -08003166 LOGV("releaseRecordingFrame X");
3167}
3168
3169bool QualcommCameraHardware::recordingEnabled()
3170{
3171 return mCameraRunning && mDataCallbackTimestamp && (mMsgEnabled & CAMERA_MSG_VIDEO_FRAME);
3172}
3173
3174void QualcommCameraHardware::notifyShutter(common_crop_t *crop)
3175{
3176 mShutterLock.lock();
3177 image_rect_type size;
3178
3179 if (mShutterPending && mNotifyCallback && (mMsgEnabled & CAMERA_MSG_SHUTTER)) {
3180 LOGV("out2_w=%d, out2_h=%d, in2_w=%d, in2_h=%d",
3181 crop->out2_w, crop->out2_h, crop->in2_w, crop->in2_h);
3182 LOGV("out1_w=%d, out1_h=%d, in1_w=%d, in1_h=%d",
3183 crop->out1_w, crop->out1_h, crop->in1_w, crop->in1_h);
3184
3185 // To workaround a bug in MDP which happens if either
3186 // dimension > 2048, we display the thumbnail instead.
3187 mDisplayHeap = mRawHeap;
3188 if (crop->in1_w == 0 || crop->in1_h == 0) {
3189 // Full size
3190 size.width = mDimension.picture_width;
3191 size.height = mDimension.picture_height;
3192 if (size.width > 2048 || size.height > 2048) {
3193 size.width = mDimension.ui_thumbnail_width;
3194 size.height = mDimension.ui_thumbnail_height;
3195 mDisplayHeap = mThumbnailHeap;
3196 }
3197 } else {
3198 // Cropped
3199 size.width = crop->in2_w & ~1;
3200 size.height = crop->in2_h & ~1;
3201 if (size.width > 2048 || size.height > 2048) {
3202 size.width = crop->in1_w & ~1;
3203 size.height = crop->in1_h & ~1;
3204 mDisplayHeap = mThumbnailHeap;
3205 }
3206 }
3207
3208 mNotifyCallback(CAMERA_MSG_SHUTTER, (int32_t)&size, 0,
3209 mCallbackCookie);
3210 mShutterPending = false;
3211 }
3212 mShutterLock.unlock();
3213}
3214
3215static void receive_shutter_callback(common_crop_t *crop)
3216{
3217 LOGV("receive_shutter_callback: E");
3218 sp<QualcommCameraHardware> obj = QualcommCameraHardware::getInstance();
3219 if (obj != 0) {
3220 obj->notifyShutter(crop);
3221 }
3222 LOGV("receive_shutter_callback: X");
3223}
3224
3225// Crop the picture in place.
3226static void crop_yuv420(uint32_t width, uint32_t height,
3227 uint32_t cropped_width, uint32_t cropped_height,
3228 uint8_t *image)
3229{
3230 uint32_t i, x, y;
3231 uint8_t* chroma_src, *chroma_dst;
3232
3233 // Calculate the start position of the cropped area.
3234 x = (width - cropped_width) / 2;
3235 y = (height - cropped_height) / 2;
3236 x &= ~1;
3237 y &= ~1;
3238
3239 // Copy luma component.
3240 for(i = 0; i < cropped_height; i++)
3241 memcpy(image + i * cropped_width,
3242 image + width * (y + i) + x,
3243 cropped_width);
3244
3245 chroma_src = image + width * height;
3246 chroma_dst = image + cropped_width * cropped_height;
3247
3248 // Copy chroma components.
3249 cropped_height /= 2;
3250 y /= 2;
3251 for(i = 0; i < cropped_height; i++)
3252 memcpy(chroma_dst + i * cropped_width,
3253 chroma_src + width * (y + i) + x,
3254 cropped_width);
3255}
3256
Srinivasan Kannan39dae8e2009-12-03 15:52:34 -08003257
3258void QualcommCameraHardware::receiveRawSnapshot(){
3259 LOGV("receiveRawSnapshot E");
3260
3261 Mutex::Autolock cbLock(&mCallbackLock);
3262
3263 notifyShutter(&mCrop);
3264
3265 if (mDataCallback && (mMsgEnabled & CAMERA_MSG_COMPRESSED_IMAGE)) {
3266
3267 if(native_get_picture(mCameraControlFd, &mCrop) == false) {
3268 LOGE("receiveRawSnapshot X: native_get_picture failed!");
3269 return;
3270 }
3271
3272 //Create a Ashmem heap to copy data from PMem heap for application layer
3273 if(mRawSnapshotAshmemHeap != NULL){
3274 LOGV("receiveRawSnapshot: clearing old mRawSnapShotAshmemHeap.");
3275 mRawSnapshotAshmemHeap.clear();
3276 }
3277 mRawSnapshotAshmemHeap = new AshmemPool(
3278 mRawSnapShotPmemHeap->mBufferSize,
3279 mRawSnapShotPmemHeap->mNumBuffers,
3280 mRawSnapShotPmemHeap->mFrameSize,
3281 "raw ashmem snapshot camera"
3282 );
3283
3284 if(!mRawSnapshotAshmemHeap->initialized()){
3285 LOGE("receiveRawSnapshot X: error initializing mRawSnapshotHeap");
3286 deinitRawSnapshot();
3287 return;
3288 }
3289
3290 memcpy(mRawSnapshotAshmemHeap->mHeap->base(),
3291 mRawSnapShotPmemHeap->mHeap->base(),
3292 mRawSnapShotPmemHeap->mHeap->getSize());
3293
3294 mDataCallback(CAMERA_MSG_COMPRESSED_IMAGE, mRawSnapshotAshmemHeap->mBuffers[0],
3295 mCallbackCookie);
3296
3297 }
3298
3299 //cleanup
3300 deinitRawSnapshot();
3301
3302 LOGV("receiveRawSnapshot X");
3303}
3304
Priya Komarlingamb85535d2009-11-30 13:06:01 -08003305void QualcommCameraHardware::receiveRawPicture()
3306{
3307 LOGV("receiveRawPicture: E");
3308
3309 Mutex::Autolock cbLock(&mCallbackLock);
3310 if (mDataCallback && (mMsgEnabled & CAMERA_MSG_RAW_IMAGE)) {
3311 if(native_get_picture(mCameraControlFd, &mCrop) == false) {
3312 LOGE("getPicture failed!");
3313 return;
3314 }
3315 mCrop.in1_w &= ~1;
3316 mCrop.in1_h &= ~1;
3317 mCrop.in2_w &= ~1;
3318 mCrop.in2_h &= ~1;
3319
3320 // By the time native_get_picture returns, picture is taken. Call
3321 // shutter callback if cam config thread has not done that.
3322 notifyShutter(&mCrop);
3323
3324 // Crop the image if zoomed.
3325 if (mCrop.in2_w != 0 && mCrop.in2_h != 0) {
3326 crop_yuv420(mCrop.out2_w, mCrop.out2_h, mCrop.in2_w, mCrop.in2_h,
3327 (uint8_t *)mRawHeap->mHeap->base());
3328 crop_yuv420(mCrop.out1_w, mCrop.out1_h, mCrop.in1_w, mCrop.in1_h,
3329 (uint8_t *)mThumbnailHeap->mHeap->base());
3330 // We do not need jpeg encoder to upscale the image. Set the new
3331 // dimension for encoder.
3332 mDimension.orig_picture_dx = mCrop.in2_w;
3333 mDimension.orig_picture_dy = mCrop.in2_h;
3334 mDimension.thumbnail_width = mCrop.in1_w;
3335 mDimension.thumbnail_height = mCrop.in1_h;
3336 memset(&mCrop, 0, sizeof(mCrop));
3337 }
3338
Kiran Kumar H N326cc4c2010-01-08 12:29:26 -08003339 if( mUseOverlay && (mOverlay != NULL) ) {
3340 mOverlay->setFd(mPostViewHeap->mHeap->getHeapID());
3341 if( zoomCropInfo.w !=0 && zoomCropInfo.h !=0) {
3342 LOGD(" zoomCropInfo non-zero, setting crop ");
3343 mOverlay->setCrop(zoomCropInfo.x, zoomCropInfo.y,
3344 zoomCropInfo.w, zoomCropInfo.h);
3345 }
3346 LOGD(" Queueing Postview for display ");
3347 mOverlay->queueBuffer((void *)0);
3348 }
3349
Priya Komarlingamb85535d2009-11-30 13:06:01 -08003350 mDataCallback(CAMERA_MSG_RAW_IMAGE, mDisplayHeap->mBuffers[0],
3351 mCallbackCookie);
3352 }
3353 else LOGV("Raw-picture callback was canceled--skipping.");
3354
3355 if (mDataCallback && (mMsgEnabled & CAMERA_MSG_COMPRESSED_IMAGE)) {
3356 mJpegSize = 0;
3357 if (LINK_jpeg_encoder_init()) {
3358 if(native_jpeg_encode()) {
3359 LOGV("receiveRawPicture: X (success)");
3360 return;
3361 }
3362 LOGE("jpeg encoding failed");
3363 }
3364 else LOGE("receiveRawPicture X: jpeg_encoder_init failed.");
3365 }
3366 else LOGV("JPEG callback is NULL, not encoding image.");
3367 deinitRaw();
3368 LOGV("receiveRawPicture: X");
3369}
3370
3371void QualcommCameraHardware::receiveJpegPictureFragment(
3372 uint8_t *buff_ptr, uint32_t buff_size)
3373{
3374 uint32_t remaining = mJpegHeap->mHeap->virtualSize();
3375 remaining -= mJpegSize;
3376 uint8_t *base = (uint8_t *)mJpegHeap->mHeap->base();
3377
3378 LOGV("receiveJpegPictureFragment size %d", buff_size);
3379 if (buff_size > remaining) {
3380 LOGE("receiveJpegPictureFragment: size %d exceeds what "
3381 "remains in JPEG heap (%d), truncating",
3382 buff_size,
3383 remaining);
3384 buff_size = remaining;
3385 }
3386 memcpy(base + mJpegSize, buff_ptr, buff_size);
3387 mJpegSize += buff_size;
3388}
3389
3390void QualcommCameraHardware::receiveJpegPicture(void)
3391{
3392 LOGV("receiveJpegPicture: E image (%d uint8_ts out of %d)",
3393 mJpegSize, mJpegHeap->mBufferSize);
3394 Mutex::Autolock cbLock(&mCallbackLock);
3395
3396 int index = 0, rc;
3397
3398 if (mDataCallback && (mMsgEnabled & CAMERA_MSG_COMPRESSED_IMAGE)) {
3399 // The reason we do not allocate into mJpegHeap->mBuffers[offset] is
3400 // that the JPEG image's size will probably change from one snapshot
3401 // to the next, so we cannot reuse the MemoryBase object.
3402 sp<MemoryBase> buffer = new
3403 MemoryBase(mJpegHeap->mHeap,
3404 index * mJpegHeap->mBufferSize +
3405 0,
3406 mJpegSize);
3407 mDataCallback(CAMERA_MSG_COMPRESSED_IMAGE, buffer, mCallbackCookie);
3408 buffer = NULL;
3409 }
3410 else LOGV("JPEG callback was cancelled--not delivering image.");
3411
3412 LINK_jpeg_encoder_join();
3413 deinitRaw();
3414
3415 LOGV("receiveJpegPicture: X callback done.");
3416}
3417
3418bool QualcommCameraHardware::previewEnabled()
3419{
3420 return mCameraRunning && mDataCallback && (mMsgEnabled & CAMERA_MSG_PREVIEW_FRAME);
3421}
3422
3423status_t QualcommCameraHardware::setPreviewSize(const CameraParameters& params)
3424{
3425 int width, height;
3426 params.getPreviewSize(&width, &height);
3427 LOGV("requested preview size %d x %d", width, height);
3428
3429 // Validate the preview size
3430 for (size_t i = 0; i < PREVIEW_SIZE_COUNT; ++i) {
3431 if (width == preview_sizes[i].width
3432 && height == preview_sizes[i].height) {
3433 mParameters.setPreviewSize(width, height);
3434 mDimension.display_width = width;
3435 mDimension.display_height = height;
3436 return NO_ERROR;
3437 }
3438 }
3439 LOGE("Invalid preview size requested: %dx%d", width, height);
3440 return BAD_VALUE;
3441}
3442
3443status_t QualcommCameraHardware::setPictureSize(const CameraParameters& params)
3444{
3445 int width, height;
3446 params.getPictureSize(&width, &height);
3447 LOGV("requested picture size %d x %d", width, height);
3448
3449 // Validate the picture size
Srinivasan Kannan3b9e8df2009-12-05 12:21:46 -08003450 for (int i = 0; i < supportedPictureSizesCount; ++i) {
3451 if (width == picture_sizes_ptr[i].width
3452 && height == picture_sizes_ptr[i].height) {
Priya Komarlingamb85535d2009-11-30 13:06:01 -08003453 mParameters.setPictureSize(width, height);
3454 mDimension.picture_width = width;
3455 mDimension.picture_height = height;
3456 return NO_ERROR;
3457 }
3458 }
3459 LOGE("Invalid picture size requested: %dx%d", width, height);
3460 return BAD_VALUE;
3461}
3462
3463status_t QualcommCameraHardware::setJpegQuality(const CameraParameters& params) {
3464 status_t rc = NO_ERROR;
3465 int quality = params.getInt(CameraParameters::KEY_JPEG_QUALITY);
3466 if (quality > 0 && quality <= 100) {
3467 mParameters.set(CameraParameters::KEY_JPEG_QUALITY, quality);
3468 } else {
3469 LOGE("Invalid jpeg quality=%d", quality);
3470 rc = BAD_VALUE;
3471 }
3472
3473 quality = params.getInt(CameraParameters::KEY_JPEG_THUMBNAIL_QUALITY);
3474 if (quality > 0 && quality <= 100) {
3475 mParameters.set(CameraParameters::KEY_JPEG_THUMBNAIL_QUALITY, quality);
3476 } else {
3477 LOGE("Invalid jpeg thumbnail quality=%d", quality);
3478 rc = BAD_VALUE;
3479 }
3480 return rc;
3481}
3482
3483status_t QualcommCameraHardware::setEffect(const CameraParameters& params)
3484{
3485 const char *str = params.get(CameraParameters::KEY_EFFECT);
3486 if (str != NULL) {
3487 int32_t value = attr_lookup(effects, sizeof(effects) / sizeof(str_map), str);
3488 if (value != NOT_FOUND) {
Mohan Kandra93f1bfb2009-12-15 16:55:33 -08003489 if(!strcmp(sensorType->name, "2mp") && (value != CAMERA_EFFECT_OFF)
3490 &&(value != CAMERA_EFFECT_MONO) && (value != CAMERA_EFFECT_NEGATIVE)
3491 &&(value != CAMERA_EFFECT_SOLARIZE) && (value != CAMERA_EFFECT_SEPIA)) {
3492 LOGE("Special effect parameter is not supported for this sensor");
3493 return NO_ERROR;
3494 }
Priya Komarlingamb85535d2009-11-30 13:06:01 -08003495 mParameters.set(CameraParameters::KEY_EFFECT, str);
3496 bool ret = native_set_parm(CAMERA_SET_PARM_EFFECT, sizeof(value),
3497 (void *)&value);
3498 return ret ? NO_ERROR : UNKNOWN_ERROR;
3499 }
3500 }
3501 LOGE("Invalid effect value: %s", (str == NULL) ? "NULL" : str);
3502 return BAD_VALUE;
3503}
3504
Apurva Rajguru55562b02009-12-03 12:25:35 -08003505status_t QualcommCameraHardware::setAutoExposure(const CameraParameters& params)
3506{
Mohan Kandra93f1bfb2009-12-15 16:55:33 -08003507 if(!strcmp(sensorType->name, "2mp")) {
3508 LOGE("Auto Exposure not supported for this sensor");
3509 return NO_ERROR;
3510 }
Apurva Rajguru55562b02009-12-03 12:25:35 -08003511 const char *str = params.get(CameraParameters::KEY_AUTO_EXPOSURE);
3512 if (str != NULL) {
3513 int32_t value = attr_lookup(autoexposure, sizeof(autoexposure) / sizeof(str_map), str);
3514 if (value != NOT_FOUND) {
3515 mParameters.set(CameraParameters::KEY_AUTO_EXPOSURE, str);
3516 bool ret = native_set_parm(CAMERA_SET_PARM_EXPOSURE, sizeof(value),
3517 (void *)&value);
3518 return ret ? NO_ERROR : UNKNOWN_ERROR;
3519 }
3520 }
3521 LOGE("Invalid auto exposure value: %s", (str == NULL) ? "NULL" : str);
3522 return BAD_VALUE;
3523}
3524
Srinivasan Kannanbddfd502010-01-03 17:27:36 -08003525status_t QualcommCameraHardware::setSharpness(const CameraParameters& params)
3526{
3527 if(!strcmp(sensorType->name, "2mp")) {
3528 LOGE("Sharpness not supported for this sensor");
3529 return NO_ERROR;
3530 }
3531 int sharpness = params.getInt(CameraParameters::KEY_SHARPNESS);
3532 if((sharpness < CAMERA_MIN_SHARPNESS
3533 || sharpness > CAMERA_MAX_SHARPNESS))
3534 return UNKNOWN_ERROR;
Srinivasan Kannan551fd262010-01-14 17:48:30 -08003535
3536 LOGV("setting sharpness %d", sharpness);
3537 mParameters.set(CameraParameters::KEY_SHARPNESS, sharpness);
3538 bool ret = native_set_parm(CAMERA_SET_PARM_SHARPNESS, sizeof(sharpness),
3539 (void *)&sharpness);
3540 return ret ? NO_ERROR : UNKNOWN_ERROR;
Srinivasan Kannanbddfd502010-01-03 17:27:36 -08003541}
3542
3543status_t QualcommCameraHardware::setContrast(const CameraParameters& params)
3544{
3545 if(!strcmp(sensorType->name, "2mp")) {
3546 LOGE("Contrast not supported for this sensor");
3547 return NO_ERROR;
3548 }
3549 int contrast = params.getInt(CameraParameters::KEY_CONTRAST);
3550 if((contrast < CAMERA_MIN_CONTRAST)
3551 || (contrast > CAMERA_MAX_CONTRAST))
3552 return UNKNOWN_ERROR;
Srinivasan Kannan551fd262010-01-14 17:48:30 -08003553
3554 LOGV("setting contrast %d", contrast);
3555 mParameters.set(CameraParameters::KEY_CONTRAST, contrast);
3556 bool ret = native_set_parm(CAMERA_SET_PARM_CONTRAST, sizeof(contrast),
3557 (void *)&contrast);
3558 return ret ? NO_ERROR : UNKNOWN_ERROR;
Srinivasan Kannanbddfd502010-01-03 17:27:36 -08003559}
3560
3561status_t QualcommCameraHardware::setSaturation(const CameraParameters& params)
3562{
3563 if(!strcmp(sensorType->name, "2mp")) {
3564 LOGE("Saturation not supported for this sensor");
3565 return NO_ERROR;
3566 }
3567 int saturation = params.getInt(CameraParameters::KEY_SATURATION);
3568 if((saturation < CAMERA_MIN_SATURATION)
3569 || (saturation > CAMERA_MAX_SATURATION))
3570 return UNKNOWN_ERROR;
Srinivasan Kannan551fd262010-01-14 17:48:30 -08003571
3572 LOGV("setting saturation %d", saturation);
3573 mParameters.set(CameraParameters::KEY_SATURATION, saturation);
3574 bool ret = native_set_parm(CAMERA_SET_PARM_SATURATION, sizeof(saturation),
3575 (void *)&saturation);
3576 return ret ? NO_ERROR : UNKNOWN_ERROR;
Srinivasan Kannanbddfd502010-01-03 17:27:36 -08003577}
3578
Nishant Panditc8c1ee72009-12-03 16:24:02 +05303579status_t QualcommCameraHardware::setBrightness(const CameraParameters& params) {
3580 int brightness = params.getInt("luma-adaptation");
3581 if (mBrightness != brightness) {
3582 LOGV(" new brightness value : %d ", brightness);
3583 mBrightness = brightness;
3584
3585 bool ret = native_set_parm(CAMERA_SET_PARM_BRIGHTNESS, sizeof(mBrightness),
3586 (void *)&mBrightness);
3587 return ret ? NO_ERROR : UNKNOWN_ERROR;
3588 } else {
3589 return NO_ERROR;
3590 }
3591}
3592
Priya Komarlingamb85535d2009-11-30 13:06:01 -08003593status_t QualcommCameraHardware::setWhiteBalance(const CameraParameters& params)
3594{
3595 const char *str = params.get(CameraParameters::KEY_WHITE_BALANCE);
3596 if (str != NULL) {
3597 int32_t value = attr_lookup(whitebalance, sizeof(whitebalance) / sizeof(str_map), str);
3598 if (value != NOT_FOUND) {
3599 mParameters.set(CameraParameters::KEY_WHITE_BALANCE, str);
3600 bool ret = native_set_parm(CAMERA_SET_PARM_WB, sizeof(value),
3601 (void *)&value);
3602 return ret ? NO_ERROR : UNKNOWN_ERROR;
3603 }
3604 }
3605 LOGE("Invalid whitebalance value: %s", (str == NULL) ? "NULL" : str);
3606 return BAD_VALUE;
3607}
3608
3609status_t QualcommCameraHardware::setFlash(const CameraParameters& params)
3610{
3611 if (!mSensorInfo.flash_enabled) {
3612 LOGV("%s: flash not supported", __FUNCTION__);
3613 return NO_ERROR;
3614 }
3615
3616 const char *str = params.get(CameraParameters::KEY_FLASH_MODE);
3617 if (str != NULL) {
3618 int32_t value = attr_lookup(flash, sizeof(flash) / sizeof(str_map), str);
3619 if (value != NOT_FOUND) {
3620 mParameters.set(CameraParameters::KEY_FLASH_MODE, str);
3621 bool ret = native_set_parm(CAMERA_SET_PARM_LED_MODE,
3622 sizeof(value), (void *)&value);
3623 return ret ? NO_ERROR : UNKNOWN_ERROR;
3624 }
3625 }
3626 LOGE("Invalid flash mode value: %s", (str == NULL) ? "NULL" : str);
3627 return BAD_VALUE;
3628}
3629
3630status_t QualcommCameraHardware::setAntibanding(const CameraParameters& params)
3631{
Srinivasan Kannan2229d272010-01-05 14:58:28 -08003632 if(!strcmp(sensorType->name, "2mp")) {
3633 LOGE("Parameter AntiBanding is not supported for this sensor");
3634 return NO_ERROR;
3635 }
Priya Komarlingamb85535d2009-11-30 13:06:01 -08003636 const char *str = params.get(CameraParameters::KEY_ANTIBANDING);
3637 if (str != NULL) {
3638 int value = (camera_antibanding_type)attr_lookup(
3639 antibanding, sizeof(antibanding) / sizeof(str_map), str);
3640 if (value != NOT_FOUND) {
3641 camera_antibanding_type temp = (camera_antibanding_type) value;
Priya Komarlingamb85535d2009-11-30 13:06:01 -08003642 mParameters.set(CameraParameters::KEY_ANTIBANDING, str);
Srinivasan Kannan2229d272010-01-05 14:58:28 -08003643 bool ret;
3644 if (temp == CAMERA_ANTIBANDING_AUTO) {
3645 ret = native_set_parm(CAMERA_ENABLE_AFD,
3646 0, NULL);
3647 } else {
3648 ret = native_set_parm(CAMERA_SET_PARM_ANTIBANDING,
3649 sizeof(camera_antibanding_type), (void *)&temp);
3650 }
3651 return ret ? NO_ERROR : UNKNOWN_ERROR;
Priya Komarlingamb85535d2009-11-30 13:06:01 -08003652 }
3653 }
3654 LOGE("Invalid antibanding value: %s", (str == NULL) ? "NULL" : str);
3655 return BAD_VALUE;
3656}
3657
Nishant Panditc8c1ee72009-12-03 16:24:02 +05303658status_t QualcommCameraHardware::setLensshadeValue(const CameraParameters& params)
3659{
Mohan Kandra93f1bfb2009-12-15 16:55:33 -08003660 if(!strcmp(sensorType->name, "2mp")) {
3661 LOGE("Parameter Rolloff is not supported for this sensor");
3662 return NO_ERROR;
3663 }
Nishant Panditc8c1ee72009-12-03 16:24:02 +05303664 const char *str = params.get(CameraParameters::KEY_LENSSHADE);
3665 if (str != NULL) {
3666 int value = attr_lookup(lensshade,
3667 sizeof(lensshade) / sizeof(str_map), str);
3668 if (value != NOT_FOUND) {
3669 int8_t temp = (int8_t)value;
3670 mParameters.set(CameraParameters::KEY_LENSSHADE, str);
3671 native_set_parm(CAMERA_SET_PARM_ROLLOFF, sizeof(int8_t), (void *)&temp);
3672 return NO_ERROR;
3673 }
3674 }
3675 LOGE("Invalid lensShade value: %s", (str == NULL) ? "NULL" : str);
3676 return BAD_VALUE;
3677}
3678
3679status_t QualcommCameraHardware::setISOValue(const CameraParameters& params) {
3680 const char *str = params.get(CameraParameters::KEY_ISO_MODE);
3681 if (str != NULL) {
3682 int value = (camera_iso_mode_type)attr_lookup(
3683 iso, sizeof(iso) / sizeof(str_map), str);
3684 if (value != NOT_FOUND) {
3685 camera_iso_mode_type temp = (camera_iso_mode_type) value;
3686 mParameters.set(CameraParameters::KEY_ISO_MODE, str);
3687 native_set_parm(CAMERA_SET_PARM_ISO, sizeof(camera_iso_mode_type), (void *)&temp);
3688 return NO_ERROR;
3689 }
3690 }
3691 LOGE("Invalid Iso value: %s", (str == NULL) ? "NULL" : str);
3692 return BAD_VALUE;
3693}
3694
3695
Priya Komarlingamb85535d2009-11-30 13:06:01 -08003696status_t QualcommCameraHardware::setGpsLocation(const CameraParameters& params)
3697{
3698 const char *latitude = params.get(CameraParameters::KEY_GPS_LATITUDE);
3699 if (latitude) {
3700 mParameters.set(CameraParameters::KEY_GPS_LATITUDE, latitude);
3701 }
3702
Apurva Rajguru66bdd7f2009-12-10 19:28:02 -08003703 const char *latitudeRef = params.get(CameraParameters::KEY_GPS_LATITUDE_REF);
3704 if (latitudeRef) {
3705 mParameters.set(CameraParameters::KEY_GPS_LATITUDE_REF, latitudeRef);
3706 }
3707
Priya Komarlingamb85535d2009-11-30 13:06:01 -08003708 const char *longitude = params.get(CameraParameters::KEY_GPS_LONGITUDE);
3709 if (longitude) {
3710 mParameters.set(CameraParameters::KEY_GPS_LONGITUDE, longitude);
3711 }
3712
Apurva Rajguru66bdd7f2009-12-10 19:28:02 -08003713 const char *longitudeRef = params.get(CameraParameters::KEY_GPS_LONGITUDE_REF);
3714 if (longitudeRef) {
3715 mParameters.set(CameraParameters::KEY_GPS_LONGITUDE_REF, longitudeRef);
3716 }
3717
3718 const char *altitudeRef = params.get(CameraParameters::KEY_GPS_ALTITUDE_REF);
3719 if (altitudeRef) {
3720 mParameters.set(CameraParameters::KEY_GPS_ALTITUDE_REF, altitudeRef);
3721 }
3722
Priya Komarlingamb85535d2009-11-30 13:06:01 -08003723 const char *altitude = params.get(CameraParameters::KEY_GPS_ALTITUDE);
3724 if (altitude) {
3725 mParameters.set(CameraParameters::KEY_GPS_ALTITUDE, altitude);
3726 }
3727
Apurva Rajguru66bdd7f2009-12-10 19:28:02 -08003728 const char *status = params.get(CameraParameters::KEY_GPS_STATUS);
3729 if (status) {
3730 mParameters.set(CameraParameters::KEY_GPS_STATUS, status);
3731 }
3732
3733 const char *dateTime = params.get(CameraParameters::KEY_EXIF_DATETIME);
3734 if (dateTime) {
3735 mParameters.set(CameraParameters::KEY_EXIF_DATETIME, dateTime);
3736 }
3737
Priya Komarlingamb85535d2009-11-30 13:06:01 -08003738 const char *timestamp = params.get(CameraParameters::KEY_GPS_TIMESTAMP);
3739 if (timestamp) {
3740 mParameters.set(CameraParameters::KEY_GPS_TIMESTAMP, timestamp);
3741 }
3742 return NO_ERROR;
3743}
3744
3745status_t QualcommCameraHardware::setRotation(const CameraParameters& params)
3746{
3747 status_t rc = NO_ERROR;
3748 int rotation = params.getInt(CameraParameters::KEY_ROTATION);
3749 if (rotation != NOT_FOUND) {
3750 if (rotation == 0 || rotation == 90 || rotation == 180
3751 || rotation == 270) {
3752 mParameters.set(CameraParameters::KEY_ROTATION, rotation);
3753 } else {
3754 LOGE("Invalid rotation value: %d", rotation);
3755 rc = BAD_VALUE;
3756 }
3757 }
3758 return rc;
3759}
3760
3761status_t QualcommCameraHardware::setZoom(const CameraParameters& params)
3762{
3763 status_t rc = NO_ERROR;
3764 // No matter how many different zoom values the driver can provide, HAL
3765 // provides applictations the same number of zoom levels. The maximum driver
3766 // zoom value depends on sensor output (VFE input) and preview size (VFE
3767 // output) because VFE can only crop and cannot upscale. If the preview size
3768 // is bigger, the maximum zoom ratio is smaller. However, we want the
3769 // zoom ratio of each zoom level is always the same whatever the preview
3770 // size is. Ex: zoom level 1 is always 1.2x, zoom level 2 is 1.44x, etc. So,
3771 // we need to have a fixed maximum zoom value and do read it from the
3772 // driver.
Mohan Kandra284966d2010-01-05 13:39:15 -08003773 static const int ZOOM_STEP = 1;
Priya Komarlingamb85535d2009-11-30 13:06:01 -08003774 int32_t zoom_level = params.getInt("zoom");
3775
Mohan Kandra284966d2010-01-05 13:39:15 -08003776 LOGV("Set zoom=%d", zoom_level);
3777 if(zoom_level >= 0 && zoom_level <= mMaxZoom) {
Priya Komarlingamb85535d2009-11-30 13:06:01 -08003778 mParameters.set("zoom", zoom_level);
3779 int32_t zoom_value = ZOOM_STEP * zoom_level;
3780 bool ret = native_set_parm(CAMERA_SET_PARM_ZOOM,
3781 sizeof(zoom_value), (void *)&zoom_value);
3782 rc = ret ? NO_ERROR : UNKNOWN_ERROR;
3783 } else {
3784 rc = BAD_VALUE;
3785 }
3786
3787 return rc;
3788}
3789
3790status_t QualcommCameraHardware::setFocusMode(const CameraParameters& params)
3791{
3792 const char *str = params.get(CameraParameters::KEY_FOCUS_MODE);
3793 if (str != NULL) {
3794 int32_t value = attr_lookup(focus_modes,
3795 sizeof(focus_modes) / sizeof(str_map), str);
3796 if (value != NOT_FOUND) {
3797 mParameters.set(CameraParameters::KEY_FOCUS_MODE, str);
3798 // Focus step is reset to infinity when preview is started. We do
3799 // not need to do anything now.
3800 return NO_ERROR;
3801 }
3802 }
3803 LOGE("Invalid focus mode value: %s", (str == NULL) ? "NULL" : str);
3804 return BAD_VALUE;
3805}
3806
3807status_t QualcommCameraHardware::setOrientation(const CameraParameters& params)
3808{
3809 const char *str = params.get("orientation");
3810
3811 if (str != NULL) {
3812 if (strcmp(str, "portrait") == 0 || strcmp(str, "landscape") == 0) {
3813 // Camera service needs this to decide if the preview frames and raw
3814 // pictures should be rotated.
3815 mParameters.set("orientation", str);
3816 } else {
3817 LOGE("Invalid orientation value: %s", str);
3818 return BAD_VALUE;
3819 }
3820 }
3821 return NO_ERROR;
3822}
3823
Srinivasan Kannan39dae8e2009-12-03 15:52:34 -08003824status_t QualcommCameraHardware::setPictureFormat(const CameraParameters& params)
3825{
3826 const char * str = params.get(CameraParameters::KEY_PICTURE_FORMAT);
3827
3828 if(str != NULL){
3829 int32_t value = attr_lookup(picture_formats,
3830 sizeof(picture_formats) / sizeof(str_map), str);
3831 if(value != NOT_FOUND){
3832 mParameters.set(CameraParameters::KEY_PICTURE_FORMAT, str);
3833 } else {
3834 LOGE("Invalid Picture Format value: %s", str);
3835 return BAD_VALUE;
3836 }
3837 }
3838 return NO_ERROR;
3839}
3840
Priya Komarlingamb85535d2009-11-30 13:06:01 -08003841QualcommCameraHardware::MemPool::MemPool(int buffer_size, int num_buffers,
3842 int frame_size,
3843 const char *name) :
3844 mBufferSize(buffer_size),
3845 mNumBuffers(num_buffers),
3846 mFrameSize(frame_size),
3847 mBuffers(NULL), mName(name)
3848{
3849 int page_size_minus_1 = getpagesize() - 1;
3850 mAlignedBufferSize = (buffer_size + page_size_minus_1) & (~page_size_minus_1);
3851}
3852
3853void QualcommCameraHardware::MemPool::completeInitialization()
3854{
3855 // If we do not know how big the frame will be, we wait to allocate
3856 // the buffers describing the individual frames until we do know their
3857 // size.
3858
3859 if (mFrameSize > 0) {
3860 mBuffers = new sp<MemoryBase>[mNumBuffers];
3861 for (int i = 0; i < mNumBuffers; i++) {
3862 mBuffers[i] = new
3863 MemoryBase(mHeap,
3864 i * mAlignedBufferSize,
3865 mFrameSize);
3866 }
3867 }
3868}
3869
3870QualcommCameraHardware::AshmemPool::AshmemPool(int buffer_size, int num_buffers,
3871 int frame_size,
3872 const char *name) :
3873 QualcommCameraHardware::MemPool(buffer_size,
3874 num_buffers,
3875 frame_size,
3876 name)
3877{
3878 LOGV("constructing MemPool %s backed by ashmem: "
3879 "%d frames @ %d uint8_ts, "
3880 "buffer size %d",
3881 mName,
3882 num_buffers, frame_size, buffer_size);
3883
3884 int page_mask = getpagesize() - 1;
3885 int ashmem_size = buffer_size * num_buffers;
3886 ashmem_size += page_mask;
3887 ashmem_size &= ~page_mask;
3888
3889 mHeap = new MemoryHeapBase(ashmem_size);
3890
3891 completeInitialization();
3892}
3893
3894static bool register_buf(int camfd,
3895 int size,
Srinivasan Kannan63bfcea2009-12-18 17:32:12 -08003896 int frame_size,
Priya Komarlingamb85535d2009-11-30 13:06:01 -08003897 int pmempreviewfd,
3898 uint32_t offset,
3899 uint8_t *buf,
3900 int pmem_type,
3901 bool vfe_can_write,
3902 bool register_buffer = true);
3903
3904QualcommCameraHardware::PmemPool::PmemPool(const char *pmem_pool,
3905 int flags,
3906 int camera_control_fd,
3907 int pmem_type,
3908 int buffer_size, int num_buffers,
3909 int frame_size,
3910 const char *name) :
3911 QualcommCameraHardware::MemPool(buffer_size,
3912 num_buffers,
3913 frame_size,
3914 name),
3915 mPmemType(pmem_type),
3916 mCameraControlFd(dup(camera_control_fd))
3917{
3918 LOGV("constructing MemPool %s backed by pmem pool %s: "
3919 "%d frames @ %d bytes, buffer size %d",
3920 mName,
3921 pmem_pool, num_buffers, frame_size,
3922 buffer_size);
3923
3924 LOGV("%s: duplicating control fd %d --> %d",
3925 __FUNCTION__,
3926 camera_control_fd, mCameraControlFd);
3927
3928 // Make a new mmap'ed heap that can be shared across processes.
3929 // mAlignedBufferSize is already in 4k aligned. (do we need total size necessary to be in power of 2??)
3930 mAlignedSize = mAlignedBufferSize * num_buffers;
3931
3932 sp<MemoryHeapBase> masterHeap =
3933 new MemoryHeapBase(pmem_pool, mAlignedSize, flags);
3934
3935 if (masterHeap->getHeapID() < 0) {
3936 LOGE("failed to construct master heap for pmem pool %s", pmem_pool);
3937 masterHeap.clear();
3938 return;
3939 }
3940
3941 sp<MemoryHeapPmem> pmemHeap = new MemoryHeapPmem(masterHeap, flags);
3942 if (pmemHeap->getHeapID() >= 0) {
3943 pmemHeap->slap();
3944 masterHeap.clear();
3945 mHeap = pmemHeap;
3946 pmemHeap.clear();
3947
3948 mFd = mHeap->getHeapID();
3949 if (::ioctl(mFd, PMEM_GET_SIZE, &mSize)) {
3950 LOGE("pmem pool %s ioctl(PMEM_GET_SIZE) error %s (%d)",
3951 pmem_pool,
3952 ::strerror(errno), errno);
3953 mHeap.clear();
3954 return;
3955 }
3956
3957 LOGV("pmem pool %s ioctl(fd = %d, PMEM_GET_SIZE) is %ld",
3958 pmem_pool,
3959 mFd,
3960 mSize.len);
Mohan Kandra284966d2010-01-05 13:39:15 -08003961 LOGD("mBufferSize=%d, mAlignedBufferSize=%d\n", mBufferSize, mAlignedBufferSize);
Priya Komarlingamb85535d2009-11-30 13:06:01 -08003962 // Unregister preview buffers with the camera drivers. Allow the VFE to write
3963 // to all preview buffers except for the last one.
Kiran Kumar H N326cc4c2010-01-08 12:29:26 -08003964 // Only Register the preview, snapshot and thumbnail buffers with the kernel.
Mohan Kandrad9efed92010-01-15 19:08:39 -08003965 if( (strcmp("postview", mName) != 0) ){
3966 int num_buf = num_buffers;
3967 if(!strcmp("preview", mName)) num_buf = kPreviewBufferCount;
3968 LOGE("num_buffers = %d", num_buf);
3969 for (int cnt = 0; cnt < num_buf; ++cnt) {
Sravankb4f5f1c2010-01-21 11:06:17 +05303970 int active = 1;
3971 if(pmem_type == MSM_PMEM_VIDEO){
3972 active = (cnt<ACTIVE_VIDEO_BUFFERS);
3973 LOGV(" pmempool creating video buffers : active %d ", active);
3974 }
3975 else if (pmem_type == MSM_PMEM_PREVIEW){
3976 active = (cnt < (num_buf-1));
3977 }
Mohan Kandra284966d2010-01-05 13:39:15 -08003978 register_buf(mCameraControlFd,
Priya Komarlingamb85535d2009-11-30 13:06:01 -08003979 mBufferSize,
Srinivasan Kannan63bfcea2009-12-18 17:32:12 -08003980 mFrameSize,
Priya Komarlingamb85535d2009-11-30 13:06:01 -08003981 mHeap->getHeapID(),
3982 mAlignedBufferSize * cnt,
3983 (uint8_t *)mHeap->base() + mAlignedBufferSize * cnt,
3984 pmem_type,
Sravankb4f5f1c2010-01-21 11:06:17 +05303985 active);
Mohan Kandra284966d2010-01-05 13:39:15 -08003986 }
Priya Komarlingamb85535d2009-11-30 13:06:01 -08003987 }
3988
3989 completeInitialization();
3990 }
3991 else LOGE("pmem pool %s error: could not create master heap!",
3992 pmem_pool);
3993}
3994
3995QualcommCameraHardware::PmemPool::~PmemPool()
3996{
3997 LOGV("%s: %s E", __FUNCTION__, mName);
3998 if (mHeap != NULL) {
3999 // Unregister preview buffers with the camera drivers.
Kiran Kumar H N326cc4c2010-01-08 12:29:26 -08004000 // Only Unregister the preview, snapshot and thumbnail
4001 // buffers with the kernel.
Mohan Kandrad9efed92010-01-15 19:08:39 -08004002 if( (strcmp("postview", mName) != 0) ){
4003 int num_buffers = mNumBuffers;
4004 if(!strcmp("preview", mName)) num_buffers = kPreviewBufferCount;
4005 for (int cnt = 0; cnt < num_buffers; ++cnt) {
Mohan Kandra284966d2010-01-05 13:39:15 -08004006 register_buf(mCameraControlFd,
Priya Komarlingamb85535d2009-11-30 13:06:01 -08004007 mBufferSize,
Srinivasan Kannan63bfcea2009-12-18 17:32:12 -08004008 mFrameSize,
Priya Komarlingamb85535d2009-11-30 13:06:01 -08004009 mHeap->getHeapID(),
4010 mAlignedBufferSize * cnt,
4011 (uint8_t *)mHeap->base() + mAlignedBufferSize * cnt,
4012 mPmemType,
4013 false,
4014 false /* unregister */);
Mohan Kandra284966d2010-01-05 13:39:15 -08004015 }
Priya Komarlingamb85535d2009-11-30 13:06:01 -08004016 }
4017 }
4018 LOGV("destroying PmemPool %s: closing control fd %d",
4019 mName,
4020 mCameraControlFd);
4021 close(mCameraControlFd);
4022 LOGV("%s: %s X", __FUNCTION__, mName);
4023}
4024
4025QualcommCameraHardware::MemPool::~MemPool()
4026{
4027 LOGV("destroying MemPool %s", mName);
4028 if (mFrameSize > 0)
4029 delete [] mBuffers;
4030 mHeap.clear();
4031 LOGV("destroying MemPool %s completed", mName);
4032}
4033
4034static bool register_buf(int camfd,
4035 int size,
Srinivasan Kannan63bfcea2009-12-18 17:32:12 -08004036 int frame_size,
Priya Komarlingamb85535d2009-11-30 13:06:01 -08004037 int pmempreviewfd,
4038 uint32_t offset,
4039 uint8_t *buf,
4040 int pmem_type,
4041 bool vfe_can_write,
4042 bool register_buffer)
4043{
4044 struct msm_pmem_info pmemBuf;
4045
4046 pmemBuf.type = pmem_type;
4047 pmemBuf.fd = pmempreviewfd;
4048 pmemBuf.offset = offset;
4049 pmemBuf.len = size;
4050 pmemBuf.vaddr = buf;
4051 pmemBuf.y_off = 0;
Srinivasan Kannan63bfcea2009-12-18 17:32:12 -08004052 pmemBuf.cbcr_off = PAD_TO_WORD(frame_size * 2 / 3);
Priya Komarlingamb85535d2009-11-30 13:06:01 -08004053 pmemBuf.active = vfe_can_write;
4054
4055 LOGV("register_buf: camfd = %d, reg = %d buffer = %p",
4056 camfd, !register_buffer, buf);
4057 if (ioctl(camfd,
4058 register_buffer ?
4059 MSM_CAM_IOCTL_REGISTER_PMEM :
4060 MSM_CAM_IOCTL_UNREGISTER_PMEM,
4061 &pmemBuf) < 0) {
4062 LOGE("register_buf: MSM_CAM_IOCTL_(UN)REGISTER_PMEM fd %d error %s",
4063 camfd,
4064 strerror(errno));
4065 return false;
4066 }
4067 return true;
4068}
4069
4070status_t QualcommCameraHardware::MemPool::dump(int fd, const Vector<String16>& args) const
4071{
4072 const size_t SIZE = 256;
4073 char buffer[SIZE];
4074 String8 result;
4075 snprintf(buffer, 255, "QualcommCameraHardware::AshmemPool::dump\n");
4076 result.append(buffer);
4077 if (mName) {
4078 snprintf(buffer, 255, "mem pool name (%s)\n", mName);
4079 result.append(buffer);
4080 }
4081 if (mHeap != 0) {
4082 snprintf(buffer, 255, "heap base(%p), size(%d), flags(%d), device(%s)\n",
4083 mHeap->getBase(), mHeap->getSize(),
4084 mHeap->getFlags(), mHeap->getDevice());
4085 result.append(buffer);
4086 }
4087 snprintf(buffer, 255,
4088 "buffer size (%d), number of buffers (%d), frame size(%d)",
4089 mBufferSize, mNumBuffers, mFrameSize);
4090 result.append(buffer);
4091 write(fd, result.string(), result.size());
4092 return NO_ERROR;
4093}
4094
4095static void receive_camframe_callback(struct msm_frame *frame)
4096{
4097 sp<QualcommCameraHardware> obj = QualcommCameraHardware::getInstance();
4098 if (obj != 0) {
4099 obj->receivePreviewFrame(frame);
4100 }
4101}
4102
4103static void receive_jpeg_fragment_callback(uint8_t *buff_ptr, uint32_t buff_size)
4104{
4105 LOGV("receive_jpeg_fragment_callback E");
4106 sp<QualcommCameraHardware> obj = QualcommCameraHardware::getInstance();
4107 if (obj != 0) {
4108 obj->receiveJpegPictureFragment(buff_ptr, buff_size);
4109 }
4110 LOGV("receive_jpeg_fragment_callback X");
4111}
4112
4113static void receive_jpeg_callback(jpeg_event_t status)
4114{
4115 LOGV("receive_jpeg_callback E (completion status %d)", status);
4116 if (status == JPEG_EVENT_DONE) {
4117 sp<QualcommCameraHardware> obj = QualcommCameraHardware::getInstance();
4118 if (obj != 0) {
4119 obj->receiveJpegPicture();
4120 }
4121 }
4122 LOGV("receive_jpeg_callback X");
4123}
Sravankb4f5f1c2010-01-21 11:06:17 +05304124// 720p : video frame calbback from camframe
4125static void receive_camframe_video_callback(struct msm_frame *frame)
4126{
4127 LOGV("receive_camframe_video_callback E");
4128 sp<QualcommCameraHardware> obj = QualcommCameraHardware::getInstance();
4129 if (obj != 0) {
4130 obj->receiveRecordingFrame(frame);
4131 }
4132 LOGV("receive_camframe_video_callback X");
4133}
Priya Komarlingamb85535d2009-11-30 13:06:01 -08004134
4135void QualcommCameraHardware::setCallbacks(notify_callback notify_cb,
4136 data_callback data_cb,
4137 data_callback_timestamp data_cb_timestamp,
4138 void* user)
4139{
4140 Mutex::Autolock lock(mLock);
4141 mNotifyCallback = notify_cb;
4142 mDataCallback = data_cb;
4143 mDataCallbackTimestamp = data_cb_timestamp;
4144 mCallbackCookie = user;
4145}
4146
4147void QualcommCameraHardware::enableMsgType(int32_t msgType)
4148{
4149 Mutex::Autolock lock(mLock);
4150 mMsgEnabled |= msgType;
4151}
4152
4153void QualcommCameraHardware::disableMsgType(int32_t msgType)
4154{
4155 Mutex::Autolock lock(mLock);
4156 mMsgEnabled &= ~msgType;
4157}
4158
4159bool QualcommCameraHardware::msgTypeEnabled(int32_t msgType)
4160{
4161 return (mMsgEnabled & msgType);
4162}
4163
Kiran Kumar H N5efb3ff2009-12-07 01:02:44 -08004164bool QualcommCameraHardware::useOverlay(void)
4165{
Kiran Kumar H N8ff7b982010-01-25 13:54:39 -08004166 if( mCurrentTarget == TARGET_MSM7630 ) {
Kiran Kumar H N5efb3ff2009-12-07 01:02:44 -08004167 /* Only 7x30 supports Overlay */
4168 mUseOverlay = TRUE;
4169 } else
4170 mUseOverlay = FALSE;
4171
4172 LOGV(" Using Overlay : %s ", mUseOverlay ? "YES" : "NO" );
4173 return mUseOverlay;
4174}
4175
4176status_t QualcommCameraHardware::setOverlay(const sp<Overlay> &Overlay)
4177{
4178 if( Overlay != NULL) {
4179 LOGV(" Valid overlay object ");
4180 mOverlayLock.lock();
4181 mOverlay = Overlay;
4182 mOverlayLock.unlock();
4183 } else {
4184 LOGE(" Overlay object NULL. returning ");
Mohan Kandrad9efed92010-01-15 19:08:39 -08004185 mOverlay = NULL;
Kiran Kumar H N5efb3ff2009-12-07 01:02:44 -08004186 return UNKNOWN_ERROR;
4187 }
4188 return NO_ERROR;
4189}
Kiran Kumar H N215cac42009-12-08 01:53:46 -08004190
4191void QualcommCameraHardware::receive_camframetimeout(void) {
4192 LOGV("receive_camframetimeout: E");
4193 Mutex::Autolock l(&mCamframeTimeoutLock);
4194 camframe_timeout_flag = TRUE;
4195 LOGV("receive_camframetimeout: X");
4196}
4197
4198static void receive_camframetimeout_callback(void) {
4199 sp<QualcommCameraHardware> obj = QualcommCameraHardware::getInstance();
4200 if (obj != 0) {
4201 obj->receive_camframetimeout();
4202 }
4203}
Kiran Kumar H N326cc4c2010-01-08 12:29:26 -08004204
4205void QualcommCameraHardware::storePreviewFrameForPostview(void) {
4206 LOGV(" storePreviewFrameForPostview : E ");
4207
4208 /* Since there is restriction on the maximum overlay dimensions
4209 * that can be created, we use the last preview frame as postview
4210 * for 7x30. */
4211 LOGV(" Copying the preview buffer to postview buffer %d ",
4212 mPreviewFrameSize);
4213 if( mPostViewHeap != NULL && mLastQueuedFrame != NULL) {
4214 memcpy(mPostViewHeap->mHeap->base(),
4215 (uint8_t *)mLastQueuedFrame, mPreviewFrameSize );
4216 } else
4217 LOGE(" Failed to store Preview frame. No Postview ");
4218
4219 LOGV(" storePreviewFrameForPostview : X ");
4220}
Priya Komarlingamb85535d2009-11-30 13:06:01 -08004221}; // namespace android