PageRenderTime 62ms CodeModel.GetById 18ms RepoModel.GetById 0ms app.codeStats 0ms

/aries-common/libcamera/SecCamera.cpp

https://github.com/scrizz/vibrant_ics
C++ | 3175 lines | 2382 code | 602 blank | 191 comment | 456 complexity | c1a0eab0b0c0093a89912e23e84f9d33 MD5 | raw file
Possible License(s): LGPL-2.0
  1. /*
  2. * Copyright 2008, The Android Open Source Project
  3. * Copyright 2010, Samsung Electronics Co. LTD
  4. * Copyright 2011, The CyanogenMod Project
  5. *
  6. * Licensed under the Apache License, Version 2.0 (the "License");
  7. * you may not use this file except in compliance with the License.
  8. * You may obtain a copy of the License at
  9. *
  10. * http://www.apache.org/licenses/LICENSE-2.0
  11. *
  12. * Unless required by applicable law or agreed to in writing, software
  13. * distributed under the License is distributed on an "AS IS" BASIS,
  14. * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
  15. * See the License for the specific language governing permissions and
  16. * limitations under the License.
  17. */
  18. /*
  19. ************************************
  20. * Filename: SecCamera.cpp
  21. * Author: Sachin P. Kamat
  22. * Purpose: This file interacts with the Camera and JPEG drivers.
  23. *************************************
  24. */
  25. //#define LOG_NDEBUG 0
  26. #define LOG_TAG "SecCamera"
  27. #include <utils/Log.h>
  28. #include <math.h>
  29. #include <string.h>
  30. #include <stdlib.h>
  31. #include <sys/poll.h>
  32. #include "SecCamera.h"
  33. #include "cutils/properties.h"
  34. using namespace android;
  35. #define CHECK(return_value) \
  36. if (return_value < 0) { \
  37. LOGE("%s::%d fail. errno: %s, m_camera_id = %d\n", \
  38. __func__, __LINE__, strerror(errno), m_camera_id); \
  39. return -1; \
  40. }
  41. #define CHECK_PTR(return_value) \
  42. if (return_value < 0) { \
  43. LOGE("%s::%d fail, errno: %s, m_camera_id = %d\n", \
  44. __func__,__LINE__, strerror(errno), m_camera_id); \
  45. return NULL; \
  46. }
  47. #define ALIGN_TO_32B(x) ((((x) + (1 << 5) - 1) >> 5) << 5)
  48. #define ALIGN_TO_128B(x) ((((x) + (1 << 7) - 1) >> 7) << 7)
  49. #define ALIGN_TO_8KB(x) ((((x) + (1 << 13) - 1) >> 13) << 13)
  50. namespace android {
  51. // ======================================================================
  52. // Camera controls
  53. static struct timeval time_start;
  54. static struct timeval time_stop;
  55. unsigned long measure_time(struct timeval *start, struct timeval *stop)
  56. {
  57. unsigned long sec, usec, time;
  58. sec = stop->tv_sec - start->tv_sec;
  59. if (stop->tv_usec >= start->tv_usec) {
  60. usec = stop->tv_usec - start->tv_usec;
  61. } else {
  62. usec = stop->tv_usec + 1000000 - start->tv_usec;
  63. sec--;
  64. }
  65. time = (sec * 1000000) + usec;
  66. return time;
  67. }
  68. static int get_pixel_depth(unsigned int fmt)
  69. {
  70. int depth = 0;
  71. switch (fmt) {
  72. case V4L2_PIX_FMT_NV12:
  73. depth = 12;
  74. break;
  75. case V4L2_PIX_FMT_NV12T:
  76. depth = 12;
  77. break;
  78. case V4L2_PIX_FMT_NV21:
  79. depth = 12;
  80. break;
  81. case V4L2_PIX_FMT_YUV420:
  82. depth = 12;
  83. break;
  84. case V4L2_PIX_FMT_RGB565:
  85. case V4L2_PIX_FMT_YUYV:
  86. case V4L2_PIX_FMT_YVYU:
  87. case V4L2_PIX_FMT_UYVY:
  88. case V4L2_PIX_FMT_VYUY:
  89. case V4L2_PIX_FMT_NV16:
  90. case V4L2_PIX_FMT_NV61:
  91. case V4L2_PIX_FMT_YUV422P:
  92. depth = 16;
  93. break;
  94. case V4L2_PIX_FMT_RGB32:
  95. depth = 32;
  96. break;
  97. }
  98. return depth;
  99. }
  100. #define ALIGN_W(x) (((x) + 0x7F) & (~0x7F)) // Set as multiple of 128
  101. #define ALIGN_H(x) (((x) + 0x1F) & (~0x1F)) // Set as multiple of 32
  102. #define ALIGN_BUF(x) (((x) + 0x1FFF)& (~0x1FFF)) // Set as multiple of 8K
  103. static int fimc_poll(struct pollfd *events)
  104. {
  105. int ret;
  106. /* 10 second delay is because sensor can take a long time
  107. * to do auto focus and capture in dark settings
  108. */
  109. ret = poll(events, 1, 10000);
  110. if (ret < 0) {
  111. LOGE("ERR(%s):poll error\n", __func__);
  112. return ret;
  113. }
  114. if (ret == 0) {
  115. LOGE("ERR(%s):No data in 10 secs..\n", __func__);
  116. return ret;
  117. }
  118. return ret;
  119. }
  120. int SecCamera::previewPoll(bool preview)
  121. {
  122. int ret;
  123. if (preview) {
  124. #ifdef ENABLE_ESD_PREVIEW_CHECK
  125. int status = 0;
  126. if (!(++m_esd_check_count % 60)) {
  127. status = getCameraSensorESDStatus();
  128. m_esd_check_count = 0;
  129. if (status) {
  130. LOGE("ERR(%s) ESD status(%d)", __func__, status);
  131. return status;
  132. }
  133. }
  134. #endif
  135. ret = poll(&m_events_c, 1, 1000);
  136. } else {
  137. ret = poll(&m_events_c2, 1, 1000);
  138. }
  139. if (ret < 0) {
  140. LOGE("ERR(%s):poll error\n", __func__);
  141. return ret;
  142. }
  143. if (ret == 0) {
  144. LOGE("ERR(%s):No data in 1 secs.. Camera Device Reset \n", __func__);
  145. return ret;
  146. }
  147. return ret;
  148. }
  149. static int fimc_v4l2_querycap(int fp)
  150. {
  151. struct v4l2_capability cap;
  152. int ret = 0;
  153. ret = ioctl(fp, VIDIOC_QUERYCAP, &cap);
  154. if (ret < 0) {
  155. LOGE("ERR(%s):VIDIOC_QUERYCAP failed\n", __func__);
  156. return -1;
  157. }
  158. if (!(cap.capabilities & V4L2_CAP_VIDEO_CAPTURE)) {
  159. LOGE("ERR(%s):no capture devices\n", __func__);
  160. return -1;
  161. }
  162. return ret;
  163. }
  164. static const __u8* fimc_v4l2_enuminput(int fp, int index)
  165. {
  166. static struct v4l2_input input;
  167. input.index = index;
  168. if (ioctl(fp, VIDIOC_ENUMINPUT, &input) != 0) {
  169. LOGE("ERR(%s):No matching index found\n", __func__);
  170. return NULL;
  171. }
  172. LOGI("Name of input channel[%d] is %s\n", input.index, input.name);
  173. return input.name;
  174. }
  175. static int fimc_v4l2_s_input(int fp, int index)
  176. {
  177. struct v4l2_input input;
  178. int ret;
  179. input.index = index;
  180. ret = ioctl(fp, VIDIOC_S_INPUT, &input);
  181. if (ret < 0) {
  182. LOGE("ERR(%s):VIDIOC_S_INPUT failed\n", __func__);
  183. return ret;
  184. }
  185. return ret;
  186. }
  187. static int fimc_v4l2_s_fmt(int fp, int width, int height, unsigned int fmt, int flag_capture)
  188. {
  189. struct v4l2_format v4l2_fmt;
  190. struct v4l2_pix_format pixfmt;
  191. int ret;
  192. v4l2_fmt.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
  193. memset(&pixfmt, 0, sizeof(pixfmt));
  194. pixfmt.width = width;
  195. pixfmt.height = height;
  196. pixfmt.pixelformat = fmt;
  197. pixfmt.sizeimage = (width * height * get_pixel_depth(fmt)) / 8;
  198. pixfmt.field = V4L2_FIELD_NONE;
  199. v4l2_fmt.fmt.pix = pixfmt;
  200. /* Set up for capture */
  201. ret = ioctl(fp, VIDIOC_S_FMT, &v4l2_fmt);
  202. if (ret < 0) {
  203. LOGE("ERR(%s):VIDIOC_S_FMT failed\n", __func__);
  204. return -1;
  205. }
  206. return 0;
  207. }
  208. static int fimc_v4l2_s_fmt_cap(int fp, int width, int height, unsigned int fmt)
  209. {
  210. struct v4l2_format v4l2_fmt;
  211. struct v4l2_pix_format pixfmt;
  212. int ret;
  213. memset(&pixfmt, 0, sizeof(pixfmt));
  214. v4l2_fmt.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
  215. pixfmt.width = width;
  216. pixfmt.height = height;
  217. pixfmt.pixelformat = fmt;
  218. if (fmt == V4L2_PIX_FMT_JPEG) {
  219. pixfmt.colorspace = V4L2_COLORSPACE_JPEG;
  220. }
  221. pixfmt.sizeimage = (width * height * get_pixel_depth(fmt)) / 8;
  222. v4l2_fmt.fmt.pix = pixfmt;
  223. //LOGE("ori_w %d, ori_h %d, w %d, h %d\n", width, height, v4l2_fmt.fmt.pix.width, v4l2_fmt.fmt.pix.height);
  224. /* Set up for capture */
  225. ret = ioctl(fp, VIDIOC_S_FMT, &v4l2_fmt);
  226. if (ret < 0) {
  227. LOGE("ERR(%s):VIDIOC_S_FMT failed\n", __func__);
  228. return ret;
  229. }
  230. return ret;
  231. }
  232. static int fimc_v4l2_enum_fmt(int fp, unsigned int fmt)
  233. {
  234. struct v4l2_fmtdesc fmtdesc;
  235. int found = 0;
  236. fmtdesc.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
  237. fmtdesc.index = 0;
  238. while (ioctl(fp, VIDIOC_ENUM_FMT, &fmtdesc) == 0) {
  239. if (fmtdesc.pixelformat == fmt) {
  240. LOGV("passed fmt = %#x found pixel format[%d]: %s\n", fmt, fmtdesc.index, fmtdesc.description);
  241. found = 1;
  242. break;
  243. }
  244. fmtdesc.index++;
  245. }
  246. if (!found) {
  247. LOGE("unsupported pixel format\n");
  248. return -1;
  249. }
  250. return 0;
  251. }
  252. static int fimc_v4l2_reqbufs(int fp, enum v4l2_buf_type type, int nr_bufs)
  253. {
  254. struct v4l2_requestbuffers req;
  255. int ret;
  256. req.count = nr_bufs;
  257. req.type = type;
  258. req.memory = V4L2_MEMORY_MMAP;
  259. ret = ioctl(fp, VIDIOC_REQBUFS, &req);
  260. if (ret < 0) {
  261. LOGE("ERR(%s):VIDIOC_REQBUFS failed\n", __func__);
  262. return -1;
  263. }
  264. return req.count;
  265. }
  266. static int fimc_v4l2_querybuf(int fp, struct fimc_buffer *buffer, enum v4l2_buf_type type)
  267. {
  268. struct v4l2_buffer v4l2_buf;
  269. int ret;
  270. LOGI("%s :", __func__);
  271. v4l2_buf.type = type;
  272. v4l2_buf.memory = V4L2_MEMORY_MMAP;
  273. v4l2_buf.index = 0;
  274. ret = ioctl(fp , VIDIOC_QUERYBUF, &v4l2_buf);
  275. if (ret < 0) {
  276. LOGE("ERR(%s):VIDIOC_QUERYBUF failed\n", __func__);
  277. return -1;
  278. }
  279. buffer->length = v4l2_buf.length;
  280. if ((buffer->start = (char *)mmap(0, v4l2_buf.length,
  281. PROT_READ | PROT_WRITE, MAP_SHARED,
  282. fp, v4l2_buf.m.offset)) < 0) {
  283. LOGE("%s %d] mmap() failed\n",__func__, __LINE__);
  284. return -1;
  285. }
  286. LOGI("%s: buffer->start = %p v4l2_buf.length = %d",
  287. __func__, buffer->start, v4l2_buf.length);
  288. return 0;
  289. }
  290. static int fimc_v4l2_streamon(int fp)
  291. {
  292. enum v4l2_buf_type type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
  293. int ret;
  294. ret = ioctl(fp, VIDIOC_STREAMON, &type);
  295. if (ret < 0) {
  296. LOGE("ERR(%s):VIDIOC_STREAMON failed\n", __func__);
  297. return ret;
  298. }
  299. return ret;
  300. }
  301. static int fimc_v4l2_streamoff(int fp)
  302. {
  303. enum v4l2_buf_type type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
  304. int ret;
  305. LOGV("%s :", __func__);
  306. ret = ioctl(fp, VIDIOC_STREAMOFF, &type);
  307. if (ret < 0) {
  308. LOGE("ERR(%s):VIDIOC_STREAMOFF failed\n", __func__);
  309. return ret;
  310. }
  311. return ret;
  312. }
  313. static int fimc_v4l2_qbuf(int fp, int index)
  314. {
  315. struct v4l2_buffer v4l2_buf;
  316. int ret;
  317. v4l2_buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
  318. v4l2_buf.memory = V4L2_MEMORY_MMAP;
  319. v4l2_buf.index = index;
  320. ret = ioctl(fp, VIDIOC_QBUF, &v4l2_buf);
  321. if (ret < 0) {
  322. LOGE("ERR(%s):VIDIOC_QBUF failed\n", __func__);
  323. return ret;
  324. }
  325. return 0;
  326. }
  327. static int fimc_v4l2_dqbuf(int fp)
  328. {
  329. struct v4l2_buffer v4l2_buf;
  330. int ret;
  331. v4l2_buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
  332. v4l2_buf.memory = V4L2_MEMORY_MMAP;
  333. ret = ioctl(fp, VIDIOC_DQBUF, &v4l2_buf);
  334. if (ret < 0) {
  335. LOGE("ERR(%s):VIDIOC_DQBUF failed, dropped frame\n", __func__);
  336. return ret;
  337. }
  338. return v4l2_buf.index;
  339. }
  340. static int fimc_v4l2_g_ctrl(int fp, unsigned int id)
  341. {
  342. struct v4l2_control ctrl;
  343. int ret;
  344. ctrl.id = id;
  345. ret = ioctl(fp, VIDIOC_G_CTRL, &ctrl);
  346. if (ret < 0) {
  347. LOGE("ERR(%s): VIDIOC_G_CTRL(id = 0x%x (%d)) failed, ret = %d\n",
  348. __func__, id, id-V4L2_CID_PRIVATE_BASE, ret);
  349. return ret;
  350. }
  351. return ctrl.value;
  352. }
  353. static int fimc_v4l2_s_ctrl(int fp, unsigned int id, unsigned int value)
  354. {
  355. struct v4l2_control ctrl;
  356. int ret;
  357. ctrl.id = id;
  358. ctrl.value = value;
  359. ret = ioctl(fp, VIDIOC_S_CTRL, &ctrl);
  360. if (ret < 0) {
  361. LOGE("ERR(%s):VIDIOC_S_CTRL(id = %#x (%d), value = %d) failed ret = %d\n",
  362. __func__, id, id-V4L2_CID_PRIVATE_BASE, value, ret);
  363. return ret;
  364. }
  365. return ctrl.value;
  366. }
  367. static int fimc_v4l2_s_ext_ctrl(int fp, unsigned int id, void *value)
  368. {
  369. struct v4l2_ext_controls ctrls;
  370. struct v4l2_ext_control ctrl;
  371. int ret;
  372. ctrl.id = id;
  373. ctrl.reserved = value;
  374. ctrls.ctrl_class = V4L2_CTRL_CLASS_CAMERA;
  375. ctrls.count = 1;
  376. ctrls.controls = &ctrl;
  377. ret = ioctl(fp, VIDIOC_S_EXT_CTRLS, &ctrls);
  378. if (ret < 0)
  379. LOGE("ERR(%s):VIDIOC_S_EXT_CTRLS failed\n", __func__);
  380. return ret;
  381. }
  382. static int fimc_v4l2_g_parm(int fp, struct v4l2_streamparm *streamparm)
  383. {
  384. int ret;
  385. streamparm->type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
  386. ret = ioctl(fp, VIDIOC_G_PARM, streamparm);
  387. if (ret < 0) {
  388. LOGE("ERR(%s):VIDIOC_G_PARM failed\n", __func__);
  389. return -1;
  390. }
  391. LOGV("%s : timeperframe: numerator %d, denominator %d\n", __func__,
  392. streamparm->parm.capture.timeperframe.numerator,
  393. streamparm->parm.capture.timeperframe.denominator);
  394. return 0;
  395. }
  396. static int fimc_v4l2_s_parm(int fp, struct v4l2_streamparm *streamparm)
  397. {
  398. int ret;
  399. streamparm->type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
  400. ret = ioctl(fp, VIDIOC_S_PARM, streamparm);
  401. if (ret < 0) {
  402. LOGE("ERR(%s):VIDIOC_S_PARM failed\n", __func__);
  403. return ret;
  404. }
  405. return 0;
  406. }
  407. // ======================================================================
  408. // Constructor & Destructor
  409. SecCamera::SecCamera() :
  410. m_flag_init(0),
  411. m_camera_id(CAMERA_ID_BACK),
  412. m_cam_fd(-1),
  413. m_cam_fd2(-1),
  414. m_preview_v4lformat(V4L2_PIX_FMT_NV21),
  415. m_preview_width (0),
  416. m_preview_height (0),
  417. m_preview_max_width (MAX_BACK_CAMERA_PREVIEW_WIDTH),
  418. m_preview_max_height (MAX_BACK_CAMERA_PREVIEW_HEIGHT),
  419. m_snapshot_v4lformat(-1),
  420. m_snapshot_width (0),
  421. m_snapshot_height (0),
  422. m_snapshot_max_width (MAX_BACK_CAMERA_SNAPSHOT_WIDTH),
  423. m_snapshot_max_height (MAX_BACK_CAMERA_SNAPSHOT_HEIGHT),
  424. m_angle(-1),
  425. m_anti_banding(-1),
  426. m_wdr(-1),
  427. m_anti_shake(-1),
  428. m_zoom_level(-1),
  429. m_object_tracking(-1),
  430. m_smart_auto(-1),
  431. m_beauty_shot(-1),
  432. m_vintage_mode(-1),
  433. m_face_detect(-1),
  434. m_gps_enabled(false),
  435. m_gps_latitude(-1),
  436. m_gps_longitude(-1),
  437. m_gps_altitude(-1),
  438. m_gps_timestamp(-1),
  439. m_vtmode(0),
  440. m_sensor_mode(-1),
  441. m_shot_mode(-1),
  442. m_exif_orientation(-1),
  443. m_blur_level(-1),
  444. m_chk_dataline(-1),
  445. m_video_gamma(-1),
  446. m_slow_ae(-1),
  447. m_camera_af_flag(-1),
  448. m_flag_camera_start(0),
  449. m_jpeg_thumbnail_width (0),
  450. m_jpeg_thumbnail_height(0),
  451. m_jpeg_quality(100)
  452. #ifdef ENABLE_ESD_PREVIEW_CHECK
  453. ,
  454. m_esd_check_count(0)
  455. #endif // ENABLE_ESD_PREVIEW_CHECK
  456. {
  457. m_params = (struct sec_cam_parm*)&m_streamparm.parm.raw_data;
  458. struct v4l2_captureparm capture;
  459. m_params->capture.timeperframe.numerator = 1;
  460. m_params->capture.timeperframe.denominator = 0;
  461. m_params->contrast = -1;
  462. m_params->effects = -1;
  463. m_params->brightness = -1;
  464. m_params->flash_mode = -1;
  465. m_params->focus_mode = -1;
  466. m_params->iso = -1;
  467. m_params->metering = -1;
  468. m_params->saturation = -1;
  469. m_params->scene_mode = -1;
  470. m_params->sharpness = -1;
  471. m_params->white_balance = -1;
  472. memset(&m_capture_buf, 0, sizeof(m_capture_buf));
  473. LOGV("%s :", __func__);
  474. }
  475. SecCamera::~SecCamera()
  476. {
  477. LOGV("%s :", __func__);
  478. }
  479. int SecCamera::initCamera(int index)
  480. {
  481. LOGV("%s :", __func__);
  482. int ret = 0;
  483. if (!m_flag_init) {
  484. /* Arun C
  485. * Reset the lense position only during camera starts; don't do
  486. * reset between shot to shot
  487. */
  488. m_camera_af_flag = -1;
  489. m_cam_fd = open(CAMERA_DEV_NAME, O_RDWR);
  490. if (m_cam_fd < 0) {
  491. LOGE("ERR(%s):Cannot open %s (error : %s)\n", __func__, CAMERA_DEV_NAME, strerror(errno));
  492. return -1;
  493. }
  494. LOGV("%s: open(%s) --> m_cam_fd %d", __FUNCTION__, CAMERA_DEV_NAME, m_cam_fd);
  495. LOGE("initCamera: m_cam_fd(%d), m_jpeg_fd(%d)", m_cam_fd, m_jpeg_fd);
  496. ret = fimc_v4l2_querycap(m_cam_fd);
  497. CHECK(ret);
  498. if (!fimc_v4l2_enuminput(m_cam_fd, index))
  499. return -1;
  500. ret = fimc_v4l2_s_input(m_cam_fd, index);
  501. CHECK(ret);
  502. m_cam_fd2 = open(CAMERA_DEV_NAME2, O_RDWR);
  503. LOGV("%s: open(%s) --> m_cam_fd2 = %d", __FUNCTION__, CAMERA_DEV_NAME2, m_cam_fd2);
  504. if (m_cam_fd2 < 0) {
  505. LOGE("ERR(%s):Cannot open %s (error : %s)\n", __func__, CAMERA_DEV_NAME2, strerror(errno));
  506. return -1;
  507. }
  508. LOGE("initCamera: m_cam_fd2(%d)", m_cam_fd2);
  509. ret = fimc_v4l2_querycap(m_cam_fd2);
  510. CHECK(ret);
  511. if (!fimc_v4l2_enuminput(m_cam_fd2, index))
  512. return -1;
  513. ret = fimc_v4l2_s_input(m_cam_fd2, index);
  514. CHECK(ret);
  515. m_camera_id = index;
  516. switch (m_camera_id) {
  517. case CAMERA_ID_FRONT:
  518. m_preview_max_width = MAX_FRONT_CAMERA_PREVIEW_WIDTH;
  519. m_preview_max_height = MAX_FRONT_CAMERA_PREVIEW_HEIGHT;
  520. m_snapshot_max_width = MAX_FRONT_CAMERA_SNAPSHOT_WIDTH;
  521. m_snapshot_max_height = MAX_FRONT_CAMERA_SNAPSHOT_HEIGHT;
  522. break;
  523. case CAMERA_ID_BACK:
  524. m_preview_max_width = MAX_BACK_CAMERA_PREVIEW_WIDTH;
  525. m_preview_max_height = MAX_BACK_CAMERA_PREVIEW_HEIGHT;
  526. m_snapshot_max_width = MAX_BACK_CAMERA_SNAPSHOT_WIDTH;
  527. m_snapshot_max_height = MAX_BACK_CAMERA_SNAPSHOT_HEIGHT;
  528. break;
  529. }
  530. setExifFixedAttribute();
  531. m_flag_init = 1;
  532. LOGI("%s : initialized", __FUNCTION__);
  533. }
  534. return 0;
  535. }
  536. void SecCamera::resetCamera()
  537. {
  538. LOGV("%s :", __func__);
  539. DeinitCamera();
  540. initCamera(m_camera_id);
  541. }
  542. void SecCamera::DeinitCamera()
  543. {
  544. LOGV("%s :", __func__);
  545. if (m_flag_init) {
  546. stopRecord();
  547. /* close m_cam_fd after stopRecord() because stopRecord()
  548. * uses m_cam_fd to change frame rate
  549. */
  550. LOGI("DeinitCamera: m_cam_fd(%d)", m_cam_fd);
  551. if (m_cam_fd > -1) {
  552. close(m_cam_fd);
  553. m_cam_fd = -1;
  554. }
  555. LOGI("DeinitCamera: m_cam_fd2(%d)", m_cam_fd2);
  556. if (m_cam_fd2 > -1) {
  557. close(m_cam_fd2);
  558. m_cam_fd2 = -1;
  559. }
  560. m_flag_init = 0;
  561. }
  562. else LOGI("%s : already deinitialized", __FUNCTION__);
  563. }
  564. int SecCamera::getCameraFd(void)
  565. {
  566. return m_cam_fd;
  567. }
  568. // ======================================================================
  569. // Preview
  570. int SecCamera::startPreview(void)
  571. {
  572. v4l2_streamparm streamparm;
  573. struct sec_cam_parm *parms;
  574. parms = (struct sec_cam_parm*)&streamparm.parm.raw_data;
  575. LOGV("%s :", __func__);
  576. // aleady started
  577. if (m_flag_camera_start > 0) {
  578. LOGE("ERR(%s):Preview was already started\n", __func__);
  579. return 0;
  580. }
  581. if (m_cam_fd <= 0) {
  582. LOGE("ERR(%s):Camera was closed\n", __func__);
  583. return -1;
  584. }
  585. memset(&m_events_c, 0, sizeof(m_events_c));
  586. m_events_c.fd = m_cam_fd;
  587. m_events_c.events = POLLIN | POLLERR;
  588. /* enum_fmt, s_fmt sample */
  589. int ret = fimc_v4l2_enum_fmt(m_cam_fd,m_preview_v4lformat);
  590. CHECK(ret);
  591. if (m_camera_id == CAMERA_ID_BACK)
  592. ret = fimc_v4l2_s_fmt(m_cam_fd, m_preview_width,m_preview_height,m_preview_v4lformat, 0);
  593. else
  594. ret = fimc_v4l2_s_fmt(m_cam_fd, m_preview_height,m_preview_width,m_preview_v4lformat, 0);
  595. CHECK(ret);
  596. ret = fimc_v4l2_reqbufs(m_cam_fd, V4L2_BUF_TYPE_VIDEO_CAPTURE, MAX_BUFFERS);
  597. CHECK(ret);
  598. LOGV("%s : m_preview_width: %d m_preview_height: %d m_angle: %d\n",
  599. __func__, m_preview_width, m_preview_height, m_angle);
  600. ret = fimc_v4l2_s_ctrl(m_cam_fd,
  601. V4L2_CID_CAMERA_CHECK_DATALINE, m_chk_dataline);
  602. CHECK(ret);
  603. if (m_camera_id == CAMERA_ID_FRONT) {
  604. /* VT mode setting */
  605. ret = fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_VT_MODE, m_vtmode);
  606. CHECK(ret);
  607. }
  608. /* start with all buffers in queue */
  609. for (int i = 0; i < MAX_BUFFERS; i++) {
  610. ret = fimc_v4l2_qbuf(m_cam_fd, i);
  611. CHECK(ret);
  612. }
  613. if (m_camera_id == CAMERA_ID_BACK) {
  614. // Init some parameters required for CE147
  615. // Force antibanding for back camera - only value supported
  616. m_anti_banding = ANTI_BANDING_50HZ;
  617. // It doesn't hurt to keep these on as the kernel camera driver only
  618. // enables it when recording HD video. Turning it on before recording
  619. // doesn't work because it needs to be set before the preview is started.
  620. m_video_gamma = GAMMA_ON;
  621. m_slow_ae = SLOW_AE_ON;
  622. ret = fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_ANTI_BANDING, m_anti_banding);
  623. CHECK(ret);
  624. ret = fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_ISO, m_params->iso);
  625. CHECK(ret);
  626. ret = fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_BRIGHTNESS, m_params->brightness);
  627. CHECK(ret);
  628. ret = fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_FRAME_RATE, m_params->capture.timeperframe.denominator);
  629. CHECK(ret);
  630. ret = fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_METERING, m_params->metering);
  631. CHECK(ret);
  632. ret = fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_SET_GAMMA, m_video_gamma);
  633. CHECK(ret);
  634. ret = fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_SET_SLOW_AE, m_slow_ae);
  635. CHECK(ret);
  636. ret = fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_EFFECT, m_params->effects);
  637. CHECK(ret);
  638. ret = fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_WHITE_BALANCE, m_params->white_balance);
  639. CHECK(ret);
  640. }
  641. ret = fimc_v4l2_streamon(m_cam_fd);
  642. CHECK(ret);
  643. if (m_camera_id == CAMERA_ID_BACK) {
  644. // More parameters for CE147
  645. ret = fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_FOCUS_MODE, m_params->focus_mode);
  646. CHECK(ret);
  647. // TODO
  648. m_face_detect = 0;
  649. ret = fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_FACE_DETECTION, m_face_detect);
  650. CHECK(ret);
  651. ret = fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_SHARPNESS, m_params->sharpness);
  652. CHECK(ret);
  653. ret = fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_SATURATION, m_params->saturation);
  654. CHECK(ret);
  655. ret = fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_CONTRAST, m_params->contrast);
  656. CHECK(ret);
  657. // TODO
  658. m_beauty_shot = 0;
  659. ret = fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_BEAUTY_SHOT, m_beauty_shot);
  660. CHECK(ret);
  661. // TODO
  662. m_zoom_level = 0;
  663. ret = fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_ZOOM, m_zoom_level);
  664. CHECK(ret);
  665. ret = fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_BATCH_REFLECTION, 1);
  666. CHECK(ret);
  667. }
  668. m_flag_camera_start = 1;
  669. ret = fimc_v4l2_s_parm(m_cam_fd, &m_streamparm);
  670. CHECK(ret);
  671. if (m_camera_id == CAMERA_ID_FRONT) {
  672. /* Blur setting */
  673. LOGV("m_blur_level = %d", m_blur_level);
  674. ret = fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_VGA_BLUR,
  675. m_blur_level);
  676. CHECK(ret);
  677. }
  678. // It is a delay for a new frame, not to show the previous bigger ugly picture frame.
  679. ret = fimc_poll(&m_events_c);
  680. CHECK(ret);
  681. ret = fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_RETURN_FOCUS, 0);
  682. CHECK(ret);
  683. LOGV("%s: got the first frame of the preview\n", __func__);
  684. return 0;
  685. }
  686. int SecCamera::stopPreview(void)
  687. {
  688. int ret;
  689. LOGV("%s :", __func__);
  690. if (m_flag_camera_start == 0) {
  691. LOGW("%s: doing nothing because m_flag_camera_start is zero", __func__);
  692. return 0;
  693. }
  694. if (m_params->flash_mode == FLASH_MODE_TORCH)
  695. setFlashMode(FLASH_MODE_OFF);
  696. if (m_cam_fd <= 0) {
  697. LOGE("ERR(%s):Camera was closed\n", __func__);
  698. return -1;
  699. }
  700. ret = fimc_v4l2_streamoff(m_cam_fd);
  701. CHECK(ret);
  702. m_flag_camera_start = 0;
  703. return ret;
  704. }
  705. //Recording
  706. int SecCamera::startRecord(void)
  707. {
  708. int ret, i;
  709. LOGV("%s :", __func__);
  710. // aleady started
  711. if (m_flag_record_start > 0) {
  712. LOGE("ERR(%s):Preview was already started\n", __func__);
  713. return 0;
  714. }
  715. if (m_cam_fd2 <= 0) {
  716. LOGE("ERR(%s):Camera was closed\n", __func__);
  717. return -1;
  718. }
  719. /* enum_fmt, s_fmt sample */
  720. ret = fimc_v4l2_enum_fmt(m_cam_fd2, V4L2_PIX_FMT_NV12T);
  721. CHECK(ret);
  722. LOGI("%s: m_recording_width = %d, m_recording_height = %d\n",
  723. __func__, m_recording_width, m_recording_height);
  724. if (m_camera_id == CAMERA_ID_BACK) {
  725. // Some properties for back camera video recording
  726. setISO(ISO_MOVIE);
  727. setMetering(METERING_MATRIX);
  728. setBatchReflection();
  729. ret = fimc_v4l2_s_fmt(m_cam_fd2, m_recording_width,
  730. m_recording_height, V4L2_PIX_FMT_NV12T, 0);
  731. }
  732. else {
  733. ret = fimc_v4l2_s_fmt(m_cam_fd2, m_recording_height,
  734. m_recording_width, V4L2_PIX_FMT_NV12T, 0);
  735. }
  736. CHECK(ret);
  737. ret = fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_FRAME_RATE,
  738. m_params->capture.timeperframe.denominator);
  739. CHECK(ret);
  740. ret = fimc_v4l2_reqbufs(m_cam_fd2, V4L2_BUF_TYPE_VIDEO_CAPTURE, MAX_BUFFERS);
  741. CHECK(ret);
  742. /* start with all buffers in queue */
  743. for (i = 0; i < MAX_BUFFERS; i++) {
  744. ret = fimc_v4l2_qbuf(m_cam_fd2, i);
  745. CHECK(ret);
  746. }
  747. ret = fimc_v4l2_streamon(m_cam_fd2);
  748. CHECK(ret);
  749. // Get and throw away the first frame since it is often garbled.
  750. memset(&m_events_c2, 0, sizeof(m_events_c2));
  751. m_events_c2.fd = m_cam_fd2;
  752. m_events_c2.events = POLLIN | POLLERR;
  753. ret = fimc_poll(&m_events_c2);
  754. CHECK(ret);
  755. // Continuous autofocus for main camera
  756. if (m_camera_id == CAMERA_ID_BACK) {
  757. ret = fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_CAF_START_STOP, 1);
  758. CHECK(ret);
  759. }
  760. m_flag_record_start = 1;
  761. return 0;
  762. }
  763. int SecCamera::stopRecord(void)
  764. {
  765. int ret;
  766. LOGV("%s :", __func__);
  767. if (m_flag_record_start == 0) {
  768. LOGW("%s: doing nothing because m_flag_record_start is zero", __func__);
  769. return 0;
  770. }
  771. if (m_cam_fd2 <= 0) {
  772. LOGE("ERR(%s):Camera was closed\n", __func__);
  773. return -1;
  774. }
  775. // Continuous autofocus for main camera
  776. if (m_camera_id == CAMERA_ID_BACK) {
  777. ret = fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_CAF_START_STOP, 0);
  778. CHECK(ret);
  779. }
  780. m_flag_record_start = 0;
  781. ret = fimc_v4l2_streamoff(m_cam_fd2);
  782. CHECK(ret);
  783. ret = fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_FRAME_RATE,
  784. FRAME_RATE_AUTO);
  785. CHECK(ret);
  786. // Properties for back camera non-video recording
  787. if (m_camera_id == CAMERA_ID_BACK) {
  788. setISO(ISO_AUTO);
  789. setMetering(METERING_CENTER);
  790. setBatchReflection();
  791. }
  792. return 0;
  793. }
  794. unsigned int SecCamera::getRecPhyAddrY(int index)
  795. {
  796. unsigned int addr_y;
  797. addr_y = fimc_v4l2_s_ctrl(m_cam_fd2, V4L2_CID_PADDR_Y, index);
  798. CHECK((int)addr_y);
  799. return addr_y;
  800. }
  801. unsigned int SecCamera::getRecPhyAddrC(int index)
  802. {
  803. unsigned int addr_c;
  804. addr_c = fimc_v4l2_s_ctrl(m_cam_fd2, V4L2_CID_PADDR_CBCR, index);
  805. CHECK((int)addr_c);
  806. return addr_c;
  807. }
  808. unsigned int SecCamera::getPhyAddrY(int index)
  809. {
  810. unsigned int addr_y;
  811. addr_y = fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_PADDR_Y, index);
  812. CHECK((int)addr_y);
  813. return addr_y;
  814. }
  815. unsigned int SecCamera::getPhyAddrC(int index)
  816. {
  817. unsigned int addr_c;
  818. addr_c = fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_PADDR_CBCR, index);
  819. CHECK((int)addr_c);
  820. return addr_c;
  821. }
  822. void SecCamera::pausePreview()
  823. {
  824. fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_STREAM_PAUSE, 0);
  825. }
  826. int SecCamera::getPreview()
  827. {
  828. int index;
  829. int ret;
  830. if (m_flag_camera_start == 0 || previewPoll(true) == 0) {
  831. LOGE("ERR(%s):Start Camera Device Reset \n", __func__);
  832. /* GAUDI Project([arun.c@samsung.com]) 2010.05.20. [Implemented ESD code] */
  833. /*
  834. * When there is no data for more than 1 second from the camera we inform
  835. * the FIMC driver by calling fimc_v4l2_s_input() with a special value = 1000
  836. * FIMC driver identify that there is something wrong with the camera
  837. * and it restarts the sensor.
  838. */
  839. stopPreview();
  840. /* Reset Only Camera Device */
  841. ret = fimc_v4l2_querycap(m_cam_fd);
  842. CHECK(ret);
  843. if (fimc_v4l2_enuminput(m_cam_fd, m_camera_id))
  844. return -1;
  845. ret = fimc_v4l2_s_input(m_cam_fd, 1000);
  846. CHECK(ret);
  847. ret = startPreview();
  848. if (ret < 0) {
  849. LOGE("ERR(%s): startPreview() return %d\n", __func__, ret);
  850. return 0;
  851. }
  852. }
  853. index = fimc_v4l2_dqbuf(m_cam_fd);
  854. if (!(0 <= index && index < MAX_BUFFERS)) {
  855. LOGE("ERR(%s):wrong index = %d\n", __func__, index);
  856. return -1;
  857. }
  858. ret = fimc_v4l2_qbuf(m_cam_fd, index);
  859. CHECK(ret);
  860. return index;
  861. }
  862. int SecCamera::getRecordFrame()
  863. {
  864. if (m_flag_record_start == 0) {
  865. LOGE("%s: m_flag_record_start is 0", __func__);
  866. return -1;
  867. }
  868. previewPoll(false);
  869. return fimc_v4l2_dqbuf(m_cam_fd2);
  870. }
  871. int SecCamera::releaseRecordFrame(int index)
  872. {
  873. if (!m_flag_record_start) {
  874. /* this can happen when recording frames are returned after
  875. * the recording is stopped at the driver level. we don't
  876. * need to return the buffers in this case and we've seen
  877. * cases where fimc could crash if we called qbuf and it
  878. * wasn't expecting it.
  879. */
  880. LOGI("%s: recording not in progress, ignoring", __func__);
  881. return 0;
  882. }
  883. return fimc_v4l2_qbuf(m_cam_fd2, index);
  884. }
  885. int SecCamera::setPreviewSize(int width, int height, int pixel_format)
  886. {
  887. LOGV("%s(width(%d), height(%d), format(%d))", __func__, width, height, pixel_format);
  888. int v4lpixelformat = pixel_format;
  889. #if defined(LOG_NDEBUG) && LOG_NDEBUG == 0
  890. if (v4lpixelformat == V4L2_PIX_FMT_YUV420)
  891. LOGV("PreviewFormat:V4L2_PIX_FMT_YUV420");
  892. else if (v4lpixelformat == V4L2_PIX_FMT_NV12)
  893. LOGV("PreviewFormat:V4L2_PIX_FMT_NV12");
  894. else if (v4lpixelformat == V4L2_PIX_FMT_NV12T)
  895. LOGV("PreviewFormat:V4L2_PIX_FMT_NV12T");
  896. else if (v4lpixelformat == V4L2_PIX_FMT_NV21)
  897. LOGV("PreviewFormat:V4L2_PIX_FMT_NV21");
  898. else if (v4lpixelformat == V4L2_PIX_FMT_YUV422P)
  899. LOGV("PreviewFormat:V4L2_PIX_FMT_YUV422P");
  900. else if (v4lpixelformat == V4L2_PIX_FMT_YUYV)
  901. LOGV("PreviewFormat:V4L2_PIX_FMT_YUYV");
  902. else if (v4lpixelformat == V4L2_PIX_FMT_RGB565)
  903. LOGV("PreviewFormat:V4L2_PIX_FMT_RGB565");
  904. else
  905. LOGV("PreviewFormat:UnknownFormat");
  906. #endif
  907. m_preview_width = width;
  908. m_preview_height = height;
  909. m_preview_v4lformat = v4lpixelformat;
  910. return 0;
  911. }
  912. int SecCamera::getPreviewSize(int *width, int *height, int *frame_size)
  913. {
  914. *width = m_preview_width;
  915. *height = m_preview_height;
  916. *frame_size = m_frameSize(m_preview_v4lformat, m_preview_width, m_preview_height);
  917. return 0;
  918. }
  919. int SecCamera::getPreviewMaxSize(int *width, int *height)
  920. {
  921. *width = m_preview_max_width;
  922. *height = m_preview_max_height;
  923. return 0;
  924. }
  925. int SecCamera::getPreviewPixelFormat(void)
  926. {
  927. return m_preview_v4lformat;
  928. }
  929. // ======================================================================
  930. // Snapshot
  931. /*
  932. * Devide getJpeg() as two funcs, setSnapshotCmd() & getJpeg() because of the shutter sound timing.
  933. * Here, just send the capture cmd to camera ISP to start JPEG capture.
  934. */
  935. int SecCamera::setSnapshotCmd(void)
  936. {
  937. LOGV("%s :", __func__);
  938. int ret = 0;
  939. LOG_TIME_DEFINE(0)
  940. LOG_TIME_DEFINE(1)
  941. if (m_cam_fd <= 0) {
  942. LOGE("ERR(%s):Camera was closed\n", __func__);
  943. return 0;
  944. }
  945. if (m_flag_camera_start > 0) {
  946. LOG_TIME_START(0)
  947. LOGW("WARN(%s):Camera was in preview, should have been stopped\n", __func__);
  948. stopPreview();
  949. LOG_TIME_END(0)
  950. }
  951. memset(&m_events_c, 0, sizeof(m_events_c));
  952. m_events_c.fd = m_cam_fd;
  953. m_events_c.events = POLLIN | POLLERR;
  954. LOG_TIME_START(1) // prepare
  955. int nframe = 1;
  956. ret = fimc_v4l2_enum_fmt(m_cam_fd,m_snapshot_v4lformat);
  957. CHECK(ret);
  958. ret = fimc_v4l2_s_fmt_cap(m_cam_fd, m_snapshot_width, m_snapshot_height, V4L2_PIX_FMT_JPEG);
  959. CHECK(ret);
  960. ret = fimc_v4l2_reqbufs(m_cam_fd, V4L2_BUF_TYPE_VIDEO_CAPTURE, nframe);
  961. CHECK(ret);
  962. ret = fimc_v4l2_querybuf(m_cam_fd, &m_capture_buf, V4L2_BUF_TYPE_VIDEO_CAPTURE);
  963. CHECK(ret);
  964. ret = fimc_v4l2_qbuf(m_cam_fd, 0);
  965. CHECK(ret);
  966. ret = fimc_v4l2_streamon(m_cam_fd);
  967. CHECK(ret);
  968. // Additional calls needed for CE147
  969. // TODO: GPS
  970. // Time
  971. time_t rawtime;
  972. time(&rawtime);
  973. struct tm *timeinfo = localtime(&rawtime);
  974. ret = fimc_v4l2_s_ext_ctrl(m_cam_fd, V4L2_CID_CAMERA_EXIF_TIME_INFO, timeinfo);
  975. CHECK(ret);
  976. // Orientation
  977. int orientation;
  978. switch (m_exif_orientation) {
  979. case 0:
  980. orientation = EXIF_ORIENTATION_UP;
  981. break;
  982. case 90:
  983. orientation = EXIF_ORIENTATION_90;
  984. break;
  985. case 180:
  986. orientation = EXIF_ORIENTATION_180;
  987. break;
  988. case 270:
  989. orientation = EXIF_ORIENTATION_270;
  990. break;
  991. default:
  992. orientation = EXIF_ORIENTATION_UP;
  993. break;
  994. }
  995. ret = fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_EXIF_ORIENTATION, orientation);
  996. CHECK(ret);
  997. ret = fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_CAPTURE, 0);
  998. CHECK(ret);
  999. LOG_TIME_END(1)
  1000. return 0;
  1001. }
  1002. int SecCamera::endSnapshot(void)
  1003. {
  1004. int ret;
  1005. LOGI("%s :", __func__);
  1006. if (m_capture_buf.start) {
  1007. munmap(m_capture_buf.start, m_capture_buf.length);
  1008. LOGI("munmap():virt. addr %p size = %d\n",
  1009. m_capture_buf.start, m_capture_buf.length);
  1010. m_capture_buf.start = NULL;
  1011. m_capture_buf.length = 0;
  1012. }
  1013. return 0;
  1014. }
  1015. /*
  1016. * Set Jpeg quality & exif info and get JPEG data from camera ISP
  1017. */
  1018. unsigned char* SecCamera::getJpeg(int *jpeg_size, unsigned int *phyaddr)
  1019. {
  1020. LOGV("%s :", __func__);
  1021. int index, ret = 0;
  1022. unsigned char *addr;
  1023. LOG_TIME_DEFINE(2)
  1024. // capture
  1025. ret = fimc_poll(&m_events_c);
  1026. CHECK_PTR(ret);
  1027. index = fimc_v4l2_dqbuf(m_cam_fd);
  1028. if (index != 0) {
  1029. LOGE("ERR(%s):wrong index = %d\n", __func__, index);
  1030. return NULL;
  1031. }
  1032. *jpeg_size = fimc_v4l2_g_ctrl(m_cam_fd, V4L2_CID_CAM_JPEG_MAIN_SIZE);
  1033. CHECK_PTR(*jpeg_size);
  1034. int main_offset = fimc_v4l2_g_ctrl(m_cam_fd, V4L2_CID_CAM_JPEG_MAIN_OFFSET);
  1035. CHECK_PTR(main_offset);
  1036. m_postview_offset = fimc_v4l2_g_ctrl(m_cam_fd, V4L2_CID_CAM_JPEG_POSTVIEW_OFFSET);
  1037. CHECK_PTR(m_postview_offset);
  1038. ret = fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_STREAM_PAUSE, 0);
  1039. CHECK_PTR(ret);
  1040. LOGV("\nsnapshot dqueued buffer = %d snapshot_width = %d snapshot_height = %d, size = %d\n\n",
  1041. index, m_snapshot_width, m_snapshot_height, *jpeg_size);
  1042. addr = (unsigned char*)(m_capture_buf.start) + main_offset;
  1043. *phyaddr = getPhyAddrY(index) + m_postview_offset;
  1044. LOG_TIME_START(2) // post
  1045. ret = fimc_v4l2_streamoff(m_cam_fd);
  1046. CHECK_PTR(ret);
  1047. LOG_TIME_END(2)
  1048. return addr;
  1049. }
  1050. int SecCamera::getExif(unsigned char *pExifDst, unsigned char *pThumbSrc)
  1051. {
  1052. JpegEncoder jpgEnc;
  1053. LOGV("%s : m_jpeg_thumbnail_width = %d, height = %d",
  1054. __func__, m_jpeg_thumbnail_width, m_jpeg_thumbnail_height);
  1055. if ((m_jpeg_thumbnail_width > 0) && (m_jpeg_thumbnail_height > 0)) {
  1056. int inFormat = JPG_MODESEL_YCBCR;
  1057. int outFormat = JPG_422;
  1058. switch (m_snapshot_v4lformat) {
  1059. case V4L2_PIX_FMT_NV12:
  1060. case V4L2_PIX_FMT_NV21:
  1061. case V4L2_PIX_FMT_NV12T:
  1062. case V4L2_PIX_FMT_YUV420:
  1063. outFormat = JPG_420;
  1064. break;
  1065. case V4L2_PIX_FMT_YUYV:
  1066. case V4L2_PIX_FMT_UYVY:
  1067. case V4L2_PIX_FMT_YUV422P:
  1068. outFormat = JPG_422;
  1069. break;
  1070. }
  1071. if (jpgEnc.setConfig(JPEG_SET_ENCODE_IN_FORMAT, inFormat) != JPG_SUCCESS)
  1072. return -1;
  1073. if (jpgEnc.setConfig(JPEG_SET_SAMPING_MODE, outFormat) != JPG_SUCCESS)
  1074. return -1;
  1075. if (jpgEnc.setConfig(JPEG_SET_ENCODE_QUALITY, JPG_QUALITY_LEVEL_2) != JPG_SUCCESS)
  1076. return -1;
  1077. int thumbWidth, thumbHeight, thumbSrcSize;
  1078. getThumbnailConfig(&thumbWidth, &thumbHeight, &thumbSrcSize);
  1079. if (jpgEnc.setConfig(JPEG_SET_ENCODE_WIDTH, thumbWidth) != JPG_SUCCESS)
  1080. return -1;
  1081. if (jpgEnc.setConfig(JPEG_SET_ENCODE_HEIGHT, thumbHeight) != JPG_SUCCESS)
  1082. return -1;
  1083. char *pInBuf = (char *)jpgEnc.getInBuf(thumbSrcSize);
  1084. if (pInBuf == NULL)
  1085. return -1;
  1086. memcpy(pInBuf, pThumbSrc, thumbSrcSize);
  1087. unsigned int thumbSize;
  1088. jpgEnc.encode(&thumbSize, NULL);
  1089. LOGV("%s : enableThumb set to true", __func__);
  1090. mExifInfo.enableThumb = true;
  1091. } else {
  1092. LOGV("%s : enableThumb set to false", __func__);
  1093. mExifInfo.enableThumb = false;
  1094. }
  1095. unsigned int exifSize;
  1096. setExifChangedAttribute();
  1097. LOGV("%s: calling jpgEnc.makeExif, mExifInfo.width set to %d, height to %d\n",
  1098. __func__, mExifInfo.width, mExifInfo.height);
  1099. jpgEnc.makeExif(pExifDst, &mExifInfo, &exifSize, true);
  1100. return exifSize;
  1101. }
  1102. void SecCamera::getPostViewConfig(int *width, int *height, int *size)
  1103. {
  1104. if (m_preview_width == 1024) {
  1105. *width = BACK_CAMERA_POSTVIEW_WIDE_WIDTH;
  1106. *height = BACK_CAMERA_POSTVIEW_HEIGHT;
  1107. *size = BACK_CAMERA_POSTVIEW_WIDE_WIDTH * BACK_CAMERA_POSTVIEW_HEIGHT * BACK_CAMERA_POSTVIEW_BPP / 8;
  1108. } else {
  1109. *width = BACK_CAMERA_POSTVIEW_WIDTH;
  1110. *height = BACK_CAMERA_POSTVIEW_HEIGHT;
  1111. *size = BACK_CAMERA_POSTVIEW_WIDTH * BACK_CAMERA_POSTVIEW_HEIGHT * BACK_CAMERA_POSTVIEW_BPP / 8;
  1112. }
  1113. LOGV("[5B] m_preview_width : %d, mPostViewWidth = %d mPostViewHeight = %d mPostViewSize = %d",
  1114. m_preview_width, *width, *height, *size);
  1115. }
  1116. void SecCamera::getThumbnailConfig(int *width, int *height, int *size)
  1117. {
  1118. if (m_camera_id == CAMERA_ID_BACK) {
  1119. *width = BACK_CAMERA_THUMBNAIL_WIDTH;
  1120. *height = BACK_CAMERA_THUMBNAIL_HEIGHT;
  1121. *size = BACK_CAMERA_THUMBNAIL_WIDTH * BACK_CAMERA_THUMBNAIL_HEIGHT
  1122. * BACK_CAMERA_THUMBNAIL_BPP / 8;
  1123. } else {
  1124. *width = FRONT_CAMERA_THUMBNAIL_WIDTH;
  1125. *height = FRONT_CAMERA_THUMBNAIL_HEIGHT;
  1126. *size = FRONT_CAMERA_THUMBNAIL_WIDTH * FRONT_CAMERA_THUMBNAIL_HEIGHT
  1127. * FRONT_CAMERA_THUMBNAIL_BPP / 8;
  1128. }
  1129. }
  1130. int SecCamera::getPostViewOffset(void)
  1131. {
  1132. return m_postview_offset;
  1133. }
  1134. int SecCamera::getSnapshotAndJpeg(unsigned char *yuv_buf, unsigned char *jpeg_buf,
  1135. unsigned int *output_size)
  1136. {
  1137. LOGV("%s :", __func__);
  1138. int index;
  1139. //unsigned int addr;
  1140. unsigned char *addr;
  1141. int ret = 0;
  1142. LOG_TIME_DEFINE(0)
  1143. LOG_TIME_DEFINE(1)
  1144. LOG_TIME_DEFINE(2)
  1145. LOG_TIME_DEFINE(3)
  1146. LOG_TIME_DEFINE(4)
  1147. LOG_TIME_DEFINE(5)
  1148. //fimc_v4l2_streamoff(m_cam_fd); [zzangdol] remove - it is separate in HWInterface with camera_id
  1149. if (m_cam_fd <= 0) {
  1150. LOGE("ERR(%s):Camera was closed\n", __func__);
  1151. return -1;
  1152. }
  1153. if (m_flag_camera_start > 0) {
  1154. LOG_TIME_START(0)
  1155. LOGW("WARN(%s):Camera was in preview, should have been stopped\n", __func__);
  1156. stopPreview();
  1157. LOG_TIME_END(0)
  1158. }
  1159. memset(&m_events_c, 0, sizeof(m_events_c));
  1160. m_events_c.fd = m_cam_fd;
  1161. m_events_c.events = POLLIN | POLLERR;
  1162. #if defined(LOG_NDEBUG) && LOG_NDEBUG == 0
  1163. if (m_snapshot_v4lformat == V4L2_PIX_FMT_YUV420)
  1164. LOGV("SnapshotFormat:V4L2_PIX_FMT_YUV420");
  1165. else if (m_snapshot_v4lformat == V4L2_PIX_FMT_NV12)
  1166. LOGV("SnapshotFormat:V4L2_PIX_FMT_NV12");
  1167. else if (m_snapshot_v4lformat == V4L2_PIX_FMT_NV12T)
  1168. LOGV("SnapshotFormat:V4L2_PIX_FMT_NV12T");
  1169. else if (m_snapshot_v4lformat == V4L2_PIX_FMT_NV21)
  1170. LOGV("SnapshotFormat:V4L2_PIX_FMT_NV21");
  1171. else if (m_snapshot_v4lformat == V4L2_PIX_FMT_YUV422P)
  1172. LOGV("SnapshotFormat:V4L2_PIX_FMT_YUV422P");
  1173. else if (m_snapshot_v4lformat == V4L2_PIX_FMT_YUYV)
  1174. LOGV("SnapshotFormat:V4L2_PIX_FMT_YUYV");
  1175. else if (m_snapshot_v4lformat == V4L2_PIX_FMT_UYVY)
  1176. LOGV("SnapshotFormat:V4L2_PIX_FMT_UYVY");
  1177. else if (m_snapshot_v4lformat == V4L2_PIX_FMT_RGB565)
  1178. LOGV("SnapshotFormat:V4L2_PIX_FMT_RGB565");
  1179. else
  1180. LOGV("SnapshotFormat:UnknownFormat");
  1181. #endif
  1182. LOG_TIME_START(1) // prepare
  1183. int nframe = 1;
  1184. ret = fimc_v4l2_enum_fmt(m_cam_fd,m_snapshot_v4lformat);
  1185. CHECK(ret);
  1186. // FFC: Swap width and height
  1187. ret = fimc_v4l2_s_fmt_cap(m_cam_fd, m_snapshot_height, m_snapshot_width, m_snapshot_v4lformat);
  1188. CHECK(ret);
  1189. ret = fimc_v4l2_reqbufs(m_cam_fd, V4L2_BUF_TYPE_VIDEO_CAPTURE, nframe);
  1190. CHECK(ret);
  1191. ret = fimc_v4l2_querybuf(m_cam_fd, &m_capture_buf, V4L2_BUF_TYPE_VIDEO_CAPTURE);
  1192. CHECK(ret);
  1193. ret = fimc_v4l2_qbuf(m_cam_fd, 0);
  1194. CHECK(ret);
  1195. ret = fimc_v4l2_streamon(m_cam_fd);
  1196. CHECK(ret);
  1197. LOG_TIME_END(1)
  1198. LOG_TIME_START(2) // capture
  1199. fimc_poll(&m_events_c);
  1200. index = fimc_v4l2_dqbuf(m_cam_fd);
  1201. fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_STREAM_PAUSE, 0);
  1202. LOGV("\nsnapshot dequeued buffer = %d snapshot_width = %d snapshot_height = %d\n\n",
  1203. index, m_snapshot_width, m_snapshot_height);
  1204. LOG_TIME_END(2)
  1205. LOGI("%s : calling memcpy from m_capture_buf", __func__);
  1206. memcpy(yuv_buf, (unsigned char*)m_capture_buf.start, m_snapshot_width * m_snapshot_height * 2);
  1207. LOG_TIME_START(5) // post
  1208. fimc_v4l2_streamoff(m_cam_fd);
  1209. LOG_TIME_END(5)
  1210. LOG_CAMERA("getSnapshotAndJpeg intervals : stopPreview(%lu), prepare(%lu),"
  1211. " capture(%lu), memcpy(%lu), yuv2Jpeg(%lu), post(%lu) us",
  1212. LOG_TIME(0), LOG_TIME(1), LOG_TIME(2), LOG_TIME(3), LOG_TIME(4), LOG_TIME(5));
  1213. /* JPEG encoding */
  1214. JpegEncoder jpgEnc;
  1215. int inFormat = JPG_MODESEL_YCBCR;
  1216. int outFormat = JPG_422;
  1217. switch (m_snapshot_v4lformat) {
  1218. case V4L2_PIX_FMT_NV12:
  1219. case V4L2_PIX_FMT_NV21:
  1220. case V4L2_PIX_FMT_NV12T:
  1221. case V4L2_PIX_FMT_YUV420:
  1222. outFormat = JPG_420;
  1223. break;
  1224. case V4L2_PIX_FMT_YUYV:
  1225. case V4L2_PIX_FMT_UYVY:
  1226. case V4L2_PIX_FMT_YUV422P:
  1227. default:
  1228. outFormat = JPG_422;
  1229. break;
  1230. }
  1231. if (jpgEnc.setConfig(JPEG_SET_ENCODE_IN_FORMAT, inFormat) != JPG_SUCCESS)
  1232. LOGE("[JPEG_SET_ENCODE_IN_FORMAT] Error\n");
  1233. if (jpgEnc.setConfig(JPEG_SET_SAMPING_MODE, outFormat) != JPG_SUCCESS)
  1234. LOGE("[JPEG_SET_SAMPING_MODE] Error\n");
  1235. image_quality_type_t jpegQuality;
  1236. if (m_jpeg_quality >= 90)
  1237. jpegQuality = JPG_QUALITY_LEVEL_1;
  1238. else if (m_jpeg_quality >= 80)
  1239. jpegQuality = JPG_QUALITY_LEVEL_2;
  1240. else if (m_jpeg_quality >= 70)
  1241. jpegQuality = JPG_QUALITY_LEVEL_3;
  1242. else
  1243. jpegQuality = JPG_QUALITY_LEVEL_4;
  1244. if (jpgEnc.setConfig(JPEG_SET_ENCODE_QUALITY, jpegQuality) != JPG_SUCCESS)
  1245. LOGE("[JPEG_SET_ENCODE_QUALITY] Error\n");
  1246. if (jpgEnc.setConfig(JPEG_SET_ENCODE_WIDTH, m_snapshot_width) != JPG_SUCCESS)
  1247. LOGE("[JPEG_SET_ENCODE_WIDTH] Error\n");
  1248. if (jpgEnc.setConfig(JPEG_SET_ENCODE_HEIGHT, m_snapshot_height) != JPG_SUCCESS)
  1249. LOGE("[JPEG_SET_ENCODE_HEIGHT] Error\n");
  1250. unsigned int snapshot_size = m_snapshot_width * m_snapshot_height * 2;
  1251. unsigned char *pInBuf = (unsigned char *)jpgEnc.getInBuf(snapshot_size);
  1252. if (pInBuf == NULL) {
  1253. LOGE("JPEG input buffer is NULL!!\n");
  1254. return -1;
  1255. }
  1256. memcpy(pInBuf, yuv_buf, snapshot_size);
  1257. setExifChangedAttribute();
  1258. jpgEnc.encode(output_size, NULL);
  1259. uint64_t outbuf_size;
  1260. unsigned char *pOutBuf = (unsigned char *)jpgEnc.getOutBuf(&outbuf_size);
  1261. if (pOutBuf == NULL) {
  1262. LOGE("JPEG output buffer is NULL!!\n");
  1263. return -1;
  1264. }
  1265. memcpy(jpeg_buf, pOutBuf, outbuf_size);
  1266. return 0;
  1267. }
  1268. int SecCamera::setSnapshotSize(int width, int height)
  1269. {
  1270. LOGV("%s(width(%d), height(%d))", __func__, width, height);
  1271. m_snapshot_width = width;
  1272. m_snapshot_height = height;
  1273. return 0;
  1274. }
  1275. int SecCamera::getSnapshotSize(int *width, int *height, int *frame_size)
  1276. {
  1277. *width = m_snapshot_width;
  1278. *height = m_snapshot_height;
  1279. int frame = 0;
  1280. frame = m_frameSize(m_snapshot_v4lformat, m_snapshot_width, m_snapshot_height);
  1281. // set it big.
  1282. if (frame == 0)
  1283. frame = m_snapshot_width * m_snapshot_height * BPP;
  1284. *frame_size = frame;
  1285. return 0;
  1286. }
  1287. int SecCamera::getSnapshotMaxSize(int *width, int *height)
  1288. {
  1289. switch (m_camera_id) {
  1290. case CAMERA_ID_FRONT:
  1291. m_snapshot_max_width = MAX_FRONT_CAMERA_SNAPSHOT_WIDTH;
  1292. m_snapshot_max_height = MAX_FRONT_CAMERA_SNAPSHOT_HEIGHT;
  1293. break;
  1294. default:
  1295. case CAMERA_ID_BACK:
  1296. m_snapshot_max_width = MAX_BACK_CAMERA_SNAPSHOT_WIDTH;
  1297. m_snapshot_max_height = MAX_BACK_CAMERA_SNAPSHOT_HEIGHT;
  1298. break;
  1299. }
  1300. *width = m_snapshot_max_width;
  1301. *height = m_snapshot_max_height;
  1302. return 0;
  1303. }
  1304. int SecCamera::setSnapshotPixelFormat(int pixel_format)
  1305. {
  1306. int v4lpixelformat= pixel_format;
  1307. if (m_snapshot_v4lformat != v4lpixelformat) {
  1308. m_snapshot_v4lformat = v4lpixelformat;
  1309. }
  1310. #if defined(LOG_NDEBUG) && LOG_NDEBUG == 0
  1311. if (m_snapshot_v4lformat == V4L2_PIX_FMT_YUV420)
  1312. LOGE("%s : SnapshotFormat:V4L2_PIX_FMT_YUV420", __func__);
  1313. else if (m_snapshot_v4lformat == V4L2_PIX_FMT_NV12)
  1314. LOGD("%s : SnapshotFormat:V4L2_PIX_FMT_NV12", __func__);
  1315. else if (m_snapshot_v4lformat == V4L2_PIX_FMT_NV12T)
  1316. LOGD("%s : SnapshotFormat:V4L2_PIX_FMT_NV12T", __func__);
  1317. else if (m_snapshot_v4lformat == V4L2_PIX_FMT_NV21)
  1318. LOGD("%s : SnapshotFormat:V4L2_PIX_FMT_NV21", __func__);
  1319. else if (m_snapshot_v4lformat == V4L2_PIX_FMT_YUV422P)
  1320. LOGD("%s : SnapshotFormat:V4L2_PIX_FMT_YUV422P", __func__);
  1321. else if (m_snapshot_v4lformat == V4L2_PIX_FMT_YUYV)
  1322. LOGD("%s : SnapshotFormat:V4L2_PIX_FMT_YUYV", __func__);
  1323. else if (m_snapshot_v4lformat == V4L2_PIX_FMT_UYVY)
  1324. LOGD("%s : SnapshotFormat:V4L2_PIX_FMT_UYVY", __func__);
  1325. else if (m_snapshot_v4lformat == V4L2_PIX_FMT_RGB565)
  1326. LOGD("%s : SnapshotFormat:V4L2_PIX_FMT_RGB565", __func__);
  1327. else
  1328. LOGD("SnapshotFormat:UnknownFormat");
  1329. #endif
  1330. return 0;
  1331. }
  1332. int SecCamera::getSnapshotPixelFormat(void)
  1333. {
  1334. return m_snapshot_v4lformat;
  1335. }
  1336. // ======================================================================
  1337. // Settings
  1338. int SecCamera::getCameraId(void)
  1339. {
  1340. return m_camera_id;
  1341. }
  1342. // -----------------------------------
  1343. int SecCamera::setAutofocus(void)
  1344. {
  1345. LOGV("%s :", __func__);
  1346. if (m_cam_fd <= 0) {
  1347. LOGE("ERR(%s):Camera was closed\n", __func__);
  1348. return -1;
  1349. }
  1350. if (fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_SET_AUTO_FOCUS, AUTO_FOCUS_ON) < 0) {
  1351. LOGE("ERR(%s):Fail on V4L2_CID_CAMERA_SET_AUTO_FOCUS", __func__);
  1352. return -1;
  1353. }
  1354. return 0;
  1355. }
  1356. int SecCamera::getAutoFocusResult(void)
  1357. {
  1358. int af_result, count, ret;
  1359. for (count = 0; count < FIRST_AF_SEARCH_COUNT; count++) {
  1360. ret = fimc_v4l2_g_ctrl(m_cam_fd, V4L2_CID_CAMERA_AUTO_FOCUS_RESULT_FIRST);
  1361. if (ret != AF_PROGRESS)
  1362. break;
  1363. usleep(AF_DELAY);
  1364. }
  1365. if ((count >= FIRST_AF_SEARCH_COUNT) || (ret != AF_SUCCESS)) {
  1366. LOGV("%s : 1st AF timed out, failed, or was canceled", __func__);
  1367. af_result = 0;
  1368. goto finish_auto_focus;
  1369. }
  1370. af_result = 1;
  1371. LOGV("%s : AF was successful, returning %d", __func__, af_result);
  1372. finish_auto_focus:
  1373. if (fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_FINISH_AUTO_FOCUS, 0) < 0) {
  1374. LOGE("ERR(%s):Fail on V4L2_CID_CAMERA_FINISH_AUTO_FOCUS", __func__);
  1375. return -1;
  1376. }
  1377. return af_result;
  1378. }
  1379. int SecCamera::cancelAutofocus(void)
  1380. {
  1381. LOGV("%s :", __func__);
  1382. if (m_cam_fd <= 0) {
  1383. LOGE("ERR(%s):Camera was closed\n", __func__);
  1384. return -1;
  1385. }
  1386. if (fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_SET_AUTO_FOCUS, AUTO_FOCUS_OFF) < 0) {
  1387. LOGE("ERR(%s):Fail on V4L2_CID_CAMERA_SET_AUTO_FOCUS", __func__);
  1388. return -1;
  1389. }
  1390. return 0;
  1391. }
  1392. // -----------------------------------
  1393. int SecCamera::zoomIn(void)
  1394. {
  1395. LOGV("%s :", __func__);
  1396. return 0;
  1397. }
  1398. int SecCamera::zoomOut(void)
  1399. {
  1400. LOGV("%s :", __func__);
  1401. return 0;
  1402. }
  1403. // -----------------------------------
  1404. int SecCamera::SetRotate(int angle)
  1405. {
  1406. LOGE("%s(angle(%d))", __func__, angle);
  1407. if (m_angle != angle) {
  1408. switch (angle) {
  1409. case -360:
  1410. case 0:
  1411. case 360:
  1412. m_angle = 0;
  1413. break;
  1414. case -270:
  1415. case 90:
  1416. m_angle = 90;
  1417. break;
  1418. case -180:
  1419. case 180:
  1420. m_angle = 180;
  1421. break;
  1422. case -90:
  1423. case 270:
  1424. m_angle = 270;
  1425. break;
  1426. default:
  1427. LOGE("ERR(%s):Invalid angle(%d)", __func__, angle);
  1428. return -1;
  1429. }
  1430. if (m_flag_camera_start) {
  1431. if (fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_ROTATION, angle) < 0) {
  1432. LOGE("ERR(%s):Fail on V4L2_CID_ROTATION", __func__);
  1433. return -1;
  1434. }
  1435. }
  1436. }
  1437. return 0;
  1438. }
  1439. int SecCamera::getRotate(void)
  1440. {
  1441. LOGV("%s : angle(%d)", __func__, m_angle);
  1442. return m_angle;
  1443. }
  1444. int SecCamera::setFrameRate(int frame_rate)
  1445. {
  1446. LOGV("%s(FrameRate(%d))", __func__, frame_rate);
  1447. if (frame_rate < FRAME_RATE_AUTO || FRAME_RATE_MAX < frame_rate )
  1448. LOGE("ERR(%s):Invalid frame_rate(%d)", __func__, frame_rate);
  1449. if (m_params->capture.timeperframe.denominator != (unsigned)frame_rate) {
  1450. m_params->capture.timeperframe.denominator = frame_rate;
  1451. if (m_flag_camera_start) {
  1452. if (fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_FRAME_RATE, frame_rate) < 0) {
  1453. LOGE("ERR(%s):Fail on V4L2_CID_CAMERA_FRAME_RATE", __func__);
  1454. return -1;
  1455. }
  1456. }
  1457. }
  1458. return 0;
  1459. }
  1460. // -----------------------------------
  1461. int SecCamera::setVerticalMirror(void)
  1462. {
  1463. LOGV("%s :", __func__);
  1464. if (m_cam_fd <= 0) {
  1465. LOGE("ERR(%s):Camera was closed\n", __func__);
  1466. return -1;
  1467. }
  1468. if (fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_VFLIP, 0) < 0) {
  1469. LOGE("ERR(%s):Fail on V4L2_CID_VFLIP", __func__);
  1470. return -1;
  1471. }
  1472. return 0;
  1473. }
  1474. int SecCamera::setHorizontalMirror(void)
  1475. {
  1476. LOGV("%s :", __func__);
  1477. if (m_cam_fd <= 0) {
  1478. LOGE("ERR(%s):Camera was closed\n", __func__);
  1479. return -1;
  1480. }
  1481. if (fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_HFLIP, 0) < 0) {
  1482. LOGE("ERR(%s):Fail on V4L2_CID_HFLIP", __func__);
  1483. return -1;
  1484. }
  1485. return 0;
  1486. }
  1487. // -----------------------------------
  1488. int SecCamera::setWhiteBalance(int white_balance)
  1489. {
  1490. LOGV("%s(white_balance(%d))", __func__, white_balance);
  1491. if (white_balance <= WHITE_BALANCE_BASE || WHITE_BALANCE_MAX <= white_balance) {
  1492. LOGE("ERR(%s):Invalid white_balance(%d)", __func__, white_balance);
  1493. return -1;
  1494. }
  1495. if (m_params->white_balance != white_balance) {
  1496. m_params->white_balance = white_balance;
  1497. if (m_flag_camera_start) {
  1498. if (fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_WHITE_BALANCE, white_balance) < 0) {
  1499. LOGE("ERR(%s):Fail on V4L2_CID_CAMERA_WHITE_BALANCE", __func__);
  1500. return -1;
  1501. }
  1502. }
  1503. }
  1504. return 0;
  1505. }
  1506. int SecCamera::getWhiteBalance(void)
  1507. {
  1508. LOGV("%s : white_balance(%d)", __func__, m_params->white_balance);
  1509. return m_params->white_balance;
  1510. }
  1511. // -----------------------------------
  1512. int SecCamera::setBrightness(int brightness)
  1513. {
  1514. LOGV("%s(brightness(%d))", __func__, brightness);
  1515. brightness += EV_DEFAULT;
  1516. if (brightness < EV_MINUS_4 || EV_PLUS_4 < brightness) {
  1517. LOGE("ERR(%s):Invalid brightness(%d)", __func__, brightness);
  1518. return -1;
  1519. }
  1520. if (m_params->brightness != brightness) {
  1521. m_params->brightness = brightness;
  1522. if (m_flag_camera_start) {
  1523. if (fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_BRIGHTNESS, brightness) < 0) {
  1524. LOGE("ERR(%s):Fail on V4L2_CID_CAMERA_BRIGHTNESS", __func__);
  1525. return -1;
  1526. }
  1527. }
  1528. }
  1529. return 0;
  1530. }
  1531. int SecCamera::getBrightness(void)
  1532. {
  1533. LOGV("%s : brightness(%d)", __func__, m_params->brightness);
  1534. return m_params->brightness;
  1535. }
  1536. // -----------------------------------
  1537. int SecCamera::setImageEffect(int image_effect)
  1538. {
  1539. LOGV("%s(image_effect(%d))", __func__, image_effect);
  1540. if (image_effect <= IMAGE_EFFECT_BASE || IMAGE_EFFECT_MAX <= image_effect) {
  1541. LOGE("ERR(%s):Invalid image_effect(%d)", __func__, image_effect);
  1542. return -1;
  1543. }
  1544. if (m_params->effects != image_effect) {
  1545. m_params->effects = image_effect;
  1546. if (m_flag_camera_start) {
  1547. if (fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_EFFECT, image_effect) < 0) {
  1548. LOGE("ERR(%s):Fail on V4L2_CID_CAMERA_EFFECT", __func__);
  1549. return -1;
  1550. }
  1551. }
  1552. }
  1553. return 0;
  1554. }
  1555. int SecCamera::getImageEffect(void)
  1556. {
  1557. LOGV("%s : image_effect(%d)", __func__, m_params->effects);
  1558. return m_params->effects;
  1559. }
  1560. // ======================================================================
  1561. int SecCamera::setAntiBanding(int anti_banding)
  1562. {
  1563. LOGV("%s(anti_banding(%d))", __func__, anti_banding);
  1564. if (anti_banding < ANTI_BANDING_AUTO || ANTI_BANDING_OFF < anti_banding) {
  1565. LOGE("ERR(%s):Invalid anti_banding (%d)", __func__, anti_banding);
  1566. return -1;
  1567. }
  1568. if (m_anti_banding != anti_banding) {
  1569. m_anti_banding = anti_banding;
  1570. if (m_flag_camera_start) {
  1571. if (fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_ANTI_BANDING, anti_banding) < 0) {
  1572. LOGE("ERR(%s):Fail on V4L2_CID_CAMERA_ANTI_BANDING", __func__);
  1573. return -1;
  1574. }
  1575. }
  1576. }
  1577. return 0;
  1578. }
  1579. //======================================================================
  1580. int SecCamera::setSceneMode(int scene_mode)
  1581. {
  1582. LOGV("%s(scene_mode(%d))", __func__, scene_mode);
  1583. if (scene_mode <= SCENE_MODE_BASE || SCENE_MODE_MAX <= scene_mode) {
  1584. LOGE("ERR(%s):Invalid scene_mode (%d)", __func__, scene_mode);
  1585. return -1;
  1586. }
  1587. if (m_params->scene_mode != scene_mode) {
  1588. m_params->scene_mode = scene_mode;
  1589. if (m_flag_camera_start) {
  1590. if (fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_SCENE_MODE, scene_mode) < 0) {
  1591. LOGE("ERR(%s):Fail on V4L2_CID_CAMERA_SCENE_MODE", __func__);
  1592. return -1;
  1593. }
  1594. }
  1595. }
  1596. return 0;
  1597. }
  1598. int SecCamera::getSceneMode(void)
  1599. {
  1600. return m_params->scene_mode;
  1601. }
  1602. //======================================================================
  1603. int SecCamera::setFlashMode(int flash_mode)
  1604. {
  1605. LOGV("%s(flash_mode(%d))", __func__, flash_mode);
  1606. if (flash_mode <= FLASH_MODE_BASE || FLASH_MODE_MAX <= flash_mode) {
  1607. LOGE("ERR(%s):Invalid flash_mode (%d)", __func__, flash_mode);
  1608. return -1;
  1609. }
  1610. if (m_params->flash_mode != flash_mode) {
  1611. m_params->flash_mode = flash_mode;
  1612. if (m_flag_camera_start) {
  1613. if (fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_FLASH_MODE, flash_mode) < 0) {
  1614. LOGE("ERR(%s):Fail on V4L2_CID_CAMERA_FLASH_MODE", __func__);
  1615. return -1;
  1616. }
  1617. }
  1618. }
  1619. return 0;
  1620. }
  1621. int SecCamera::getFlashMode(void)
  1622. {
  1623. return m_params->flash_mode;
  1624. }
  1625. //======================================================================
  1626. int SecCamera::setISO(int iso_value)
  1627. {
  1628. LOGV("%s(iso_value(%d))", __func__, iso_value);
  1629. if (iso_value < ISO_AUTO || ISO_MAX <= iso_value) {
  1630. LOGE("ERR(%s):Invalid iso_value (%d)", __func__, iso_value);
  1631. return -1;
  1632. }
  1633. if (m_params->iso != iso_value) {
  1634. m_params->iso = iso_value;
  1635. if (m_flag_camera_start) {
  1636. if (fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_ISO, iso_value) < 0) {
  1637. LOGE("ERR(%s):Fail on V4L2_CID_CAMERA_ISO", __func__);
  1638. return -1;
  1639. }
  1640. }
  1641. }
  1642. return 0;
  1643. }
  1644. int SecCamera::getISO(void)
  1645. {
  1646. return m_params->iso;
  1647. }
  1648. //======================================================================
  1649. int SecCamera::setContrast(int contrast_value)
  1650. {
  1651. LOGV("%s(contrast_value(%d))", __func__, contrast_value);
  1652. if (contrast_value < CONTRAST_MINUS_2 || CONTRAST_MAX <= contrast_value) {
  1653. LOGE("ERR(%s):Invalid contrast_value (%d)", __func__, contrast_value);
  1654. return -1;
  1655. }
  1656. if (m_params->contrast != contrast_value) {
  1657. m_params->contrast = contrast_value;
  1658. if (m_flag_camera_start) {
  1659. if (fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_CONTRAST, contrast_value) < 0) {
  1660. LOGE("ERR(%s):Fail on V4L2_CID_CAMERA_CONTRAST", __func__);
  1661. return -1;
  1662. }
  1663. }
  1664. }
  1665. return 0;
  1666. }
  1667. int SecCamera::getContrast(void)
  1668. {
  1669. return m_params->contrast;
  1670. }
  1671. //======================================================================
  1672. int SecCamera::setSaturation(int saturation_value)
  1673. {
  1674. LOGV("%s(saturation_value(%d))", __func__, saturation_value);
  1675. if (saturation_value <SATURATION_MINUS_2 || SATURATION_MAX<= saturation_value) {
  1676. LOGE("ERR(%s):Invalid saturation_value (%d)", __func__, saturation_value);
  1677. return -1;
  1678. }
  1679. if (m_params->saturation != saturation_value) {
  1680. m_params->saturation = saturation_value;
  1681. if (m_flag_camera_start) {
  1682. if (fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_SATURATION, saturation_value) < 0) {
  1683. LOGE("ERR(%s):Fail on V4L2_CID_CAMERA_SATURATION", __func__);
  1684. return -1;
  1685. }
  1686. }
  1687. }
  1688. return 0;
  1689. }
  1690. int SecCamera::getSaturation(void)
  1691. {
  1692. return m_params->saturation;
  1693. }
  1694. //======================================================================
  1695. int SecCamera::setSharpness(int sharpness_value)
  1696. {
  1697. LOGV("%s(sharpness_value(%d))", __func__, sharpness_value);
  1698. if (sharpness_value < SHARPNESS_MINUS_2 || SHARPNESS_MAX <= sharpness_value) {
  1699. LOGE("ERR(%s):Invalid sharpness_value (%d)", __func__, sharpness_value);
  1700. return -1;
  1701. }
  1702. if (m_params->sharpness != sharpness_value) {
  1703. m_params->sharpness = sharpness_value;
  1704. if (m_flag_camera_start) {
  1705. if (fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_SHARPNESS, sharpness_value) < 0) {
  1706. LOGE("ERR(%s):Fail on V4L2_CID_CAMERA_SHARPNESS", __func__);
  1707. return -1;
  1708. }
  1709. }
  1710. }
  1711. return 0;
  1712. }
  1713. int SecCamera::getSharpness(void)
  1714. {
  1715. return m_params->sharpness;
  1716. }
  1717. //======================================================================
  1718. int SecCamera::setWDR(int wdr_value)
  1719. {
  1720. LOGV("%s(wdr_value(%d))", __func__, wdr_value);
  1721. if (wdr_value < WDR_OFF || WDR_MAX <= wdr_value) {
  1722. LOGE("ERR(%s):Invalid wdr_value (%d)", __func__, wdr_value);
  1723. return -1;
  1724. }
  1725. if (m_wdr != wdr_value) {
  1726. m_wdr = wdr_value;
  1727. if (m_flag_camera_start) {
  1728. if (fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_WDR, wdr_value) < 0) {
  1729. LOGE("ERR(%s):Fail on V4L2_CID_CAMERA_WDR", __func__);
  1730. return -1;
  1731. }
  1732. }
  1733. }
  1734. return 0;
  1735. }
  1736. int SecCamera::getWDR(void)
  1737. {
  1738. return m_wdr;
  1739. }
  1740. //======================================================================
  1741. int SecCamera::setAntiShake(int anti_shake)
  1742. {
  1743. LOGV("%s(anti_shake(%d))", __func__, anti_shake);
  1744. if (anti_shake < ANTI_SHAKE_OFF || ANTI_SHAKE_MAX <= anti_shake) {
  1745. LOGE("ERR(%s):Invalid anti_shake (%d)", __func__, anti_shake);
  1746. return -1;
  1747. }
  1748. if (m_anti_shake != anti_shake) {
  1749. m_anti_shake = anti_shake;
  1750. if (m_flag_camera_start) {
  1751. if (fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_ANTI_SHAKE, anti_shake) < 0) {
  1752. LOGE("ERR(%s):Fail on V4L2_CID_CAMERA_ANTI_SHAKE", __func__);
  1753. return -1;
  1754. }
  1755. }
  1756. }
  1757. return 0;
  1758. }
  1759. int SecCamera::getAntiShake(void)
  1760. {
  1761. return m_anti_shake;
  1762. }
  1763. //======================================================================
  1764. int SecCamera::setMetering(int metering_value)
  1765. {
  1766. LOGV("%s(metering (%d))", __func__, metering_value);
  1767. if (metering_value <= METERING_BASE || METERING_MAX <= metering_value) {
  1768. LOGE("ERR(%s):Invalid metering_value (%d)", __func__, metering_value);
  1769. return -1;
  1770. }
  1771. if (m_params->metering != metering_value) {
  1772. m_params->metering = metering_value;
  1773. if (m_flag_camera_start) {
  1774. if (fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_METERING, metering_value) < 0) {
  1775. LOGE("ERR(%s):Fail on V4L2_CID_CAMERA_METERING", __func__);
  1776. return -1;
  1777. }
  1778. }
  1779. }
  1780. return 0;
  1781. }
  1782. int SecCamera::getMetering(void)
  1783. {
  1784. return m_params->metering;
  1785. }
  1786. //======================================================================
  1787. int SecCamera::setJpegQuality(int jpeg_quality)
  1788. {
  1789. LOGV("%s(jpeg_quality (%d))", __func__, jpeg_quality);
  1790. if (jpeg_quality < JPEG_QUALITY_ECONOMY || JPEG_QUALITY_MAX <= jpeg_quality) {
  1791. LOGE("ERR(%s):Invalid jpeg_quality (%d)", __func__, jpeg_quality);
  1792. return -1;
  1793. }
  1794. if (m_jpeg_quality != jpeg_quality) {
  1795. m_jpeg_quality = jpeg_quality;
  1796. if (m_flag_camera_start && (m_camera_id == CAMERA_ID_BACK)) {
  1797. if (fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAM_JPEG_QUALITY, jpeg_quality) < 0) {
  1798. LOGE("ERR(%s):Fail on V4L2_CID_CAM_JPEG_QUALITY", __func__);
  1799. return -1;
  1800. }
  1801. }
  1802. }
  1803. return 0;
  1804. }
  1805. int SecCamera::getJpegQuality(void)
  1806. {
  1807. return m_jpeg_quality;
  1808. }
  1809. //======================================================================
  1810. int SecCamera::setZoom(int zoom_level)
  1811. {
  1812. LOGV("%s(zoom_level (%d))", __func__, zoom_level);
  1813. if (zoom_level < ZOOM_LEVEL_0 || ZOOM_LEVEL_MAX <= zoom_level) {
  1814. LOGE("ERR(%s):Invalid zoom_level (%d)", __func__, zoom_level);
  1815. return -1;
  1816. }
  1817. if (m_zoom_level != zoom_level) {
  1818. m_zoom_level = zoom_level;
  1819. if (m_flag_camera_start) {
  1820. if (fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_ZOOM, zoom_level) < 0) {
  1821. LOGE("ERR(%s):Fail on V4L2_CID_CAMERA_ZOOM", __func__);
  1822. return -1;
  1823. }
  1824. }
  1825. }
  1826. return 0;
  1827. }
  1828. int SecCamera::getZoom(void)
  1829. {
  1830. return m_zoom_level;
  1831. }
  1832. //======================================================================
  1833. int SecCamera::setObjectTracking(int object_tracking)
  1834. {
  1835. LOGV("%s(object_tracking (%d))", __func__, object_tracking);
  1836. if (object_tracking < OBJECT_TRACKING_OFF || OBJECT_TRACKING_MAX <= object_tracking) {
  1837. LOGE("ERR(%s):Invalid object_tracking (%d)", __func__, object_tracking);
  1838. return -1;
  1839. }
  1840. if (m_object_tracking != object_tracking) {
  1841. m_object_tracking = object_tracking;
  1842. }
  1843. return 0;
  1844. }
  1845. int SecCamera::getObjectTracking(void)
  1846. {
  1847. return m_object_tracking;
  1848. }
  1849. int SecCamera::getObjectTrackingStatus(void)
  1850. {
  1851. int obj_status = 0;
  1852. obj_status = fimc_v4l2_g_ctrl(m_cam_fd, V4L2_CID_CAMERA_OBJ_TRACKING_STATUS);
  1853. return obj_status;
  1854. }
  1855. int SecCamera::setObjectTrackingStartStop(int start_stop)
  1856. {
  1857. LOGV("%s(object_tracking_start_stop (%d))", __func__, start_stop);
  1858. if (m_object_tracking_start_stop != start_stop) {
  1859. m_object_tracking_start_stop = start_stop;
  1860. if (fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_OBJ_TRACKING_START_STOP, start_stop) < 0) {
  1861. LOGE("ERR(%s):Fail on V4L2_CID_CAMERA_OBJ_TRACKING_START_STOP", __func__);
  1862. return -1;
  1863. }
  1864. }
  1865. return 0;
  1866. }
  1867. int SecCamera::setTouchAFStartStop(int start_stop)
  1868. {
  1869. LOGV("%s(touch_af_start_stop (%d))", __func__, start_stop);
  1870. if (m_touch_af_start_stop != start_stop) {
  1871. m_touch_af_start_stop = start_stop;
  1872. if (fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_TOUCH_AF_START_STOP, start_stop) < 0) {
  1873. LOGE("ERR(%s):Fail on V4L2_CID_CAMERA_TOUCH_AF_START_STOP", __func__);
  1874. return -1;
  1875. }
  1876. }
  1877. return 0;
  1878. }
  1879. //======================================================================
  1880. int SecCamera::setSmartAuto(int smart_auto)
  1881. {
  1882. LOGV("%s(smart_auto (%d))", __func__, smart_auto);
  1883. if (smart_auto < SMART_AUTO_OFF || SMART_AUTO_MAX <= smart_auto) {
  1884. LOGE("ERR(%s):Invalid smart_auto (%d)", __func__, smart_auto);
  1885. return -1;
  1886. }
  1887. if (m_smart_auto != smart_auto) {
  1888. m_smart_auto = smart_auto;
  1889. if (m_flag_camera_start) {
  1890. if (fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_SMART_AUTO, smart_auto) < 0) {
  1891. LOGE("ERR(%s):Fail on V4L2_CID_CAMERA_SMART_AUTO", __func__);
  1892. return -1;
  1893. }
  1894. }
  1895. }
  1896. return 0;
  1897. }
  1898. int SecCamera::getSmartAuto(void)
  1899. {
  1900. return m_smart_auto;
  1901. }
  1902. int SecCamera::getAutosceneStatus(void)
  1903. {
  1904. int autoscene_status = -1;
  1905. if (getSmartAuto() == SMART_AUTO_ON) {
  1906. autoscene_status = fimc_v4l2_g_ctrl(m_cam_fd, V4L2_CID_CAMERA_SMART_AUTO_STATUS);
  1907. if ((autoscene_status < SMART_AUTO_STATUS_AUTO) || (autoscene_status > SMART_AUTO_STATUS_MAX)) {
  1908. LOGE("ERR(%s):Invalid getAutosceneStatus (%d)", __func__, autoscene_status);
  1909. return -1;
  1910. }
  1911. }
  1912. //LOGV("%s : autoscene_status (%d)", __func__, autoscene_status);
  1913. return autoscene_status;
  1914. }
  1915. //======================================================================
  1916. int SecCamera::setBeautyShot(int beauty_shot)
  1917. {
  1918. LOGV("%s(beauty_shot (%d))", __func__, beauty_shot);
  1919. if (beauty_shot < BEAUTY_SHOT_OFF || BEAUTY_SHOT_MAX <= beauty_shot) {
  1920. LOGE("ERR(%s):Invalid beauty_shot (%d)", __func__, beauty_shot);
  1921. return -1;
  1922. }
  1923. if (m_beauty_shot != beauty_shot) {
  1924. m_beauty_shot = beauty_shot;
  1925. if (m_flag_camera_start) {
  1926. if (fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_BEAUTY_SHOT, beauty_shot) < 0) {
  1927. LOGE("ERR(%s):Fail on V4L2_CID_CAMERA_BEAUTY_SHOT", __func__);
  1928. return -1;
  1929. }
  1930. }
  1931. setFaceDetect(FACE_DETECTION_ON_BEAUTY);
  1932. }
  1933. return 0;
  1934. }
  1935. int SecCamera::getBeautyShot(void)
  1936. {
  1937. return m_beauty_shot;
  1938. }
  1939. //======================================================================
  1940. int SecCamera::setVintageMode(int vintage_mode)
  1941. {
  1942. LOGV("%s(vintage_mode(%d))", __func__, vintage_mode);
  1943. if (vintage_mode <= VINTAGE_MODE_BASE || VINTAGE_MODE_MAX <= vintage_mode) {
  1944. LOGE("ERR(%s):Invalid vintage_mode (%d)", __func__, vintage_mode);
  1945. return -1;
  1946. }
  1947. if (m_vintage_mode != vintage_mode) {
  1948. m_vintage_mode = vintage_mode;
  1949. if (m_flag_camera_start) {
  1950. if (fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_VINTAGE_MODE, vintage_mode) < 0) {
  1951. LOGE("ERR(%s):Fail on V4L2_CID_CAMERA_VINTAGE_MODE", __func__);
  1952. return -1;
  1953. }
  1954. }
  1955. }
  1956. return 0;
  1957. }
  1958. int SecCamera::getVintageMode(void)
  1959. {
  1960. return m_vintage_mode;
  1961. }
  1962. //======================================================================
  1963. int SecCamera::setFocusMode(int focus_mode)
  1964. {
  1965. LOGV("%s(focus_mode(%d))", __func__, focus_mode);
  1966. if (FOCUS_MODE_MAX <= focus_mode) {
  1967. LOGE("ERR(%s):Invalid focus_mode (%d)", __func__, focus_mode);
  1968. return -1;
  1969. }
  1970. if (m_params->focus_mode != focus_mode) {
  1971. m_params->focus_mode = focus_mode;
  1972. if (m_flag_camera_start) {
  1973. if (fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_FOCUS_MODE, focus_mode) < 0) {
  1974. LOGE("ERR(%s):Fail on V4L2_CID_CAMERA_FOCUS_MODE", __func__);
  1975. return -1;
  1976. }
  1977. }
  1978. }
  1979. return 0;
  1980. }
  1981. int SecCamera::getFocusMode(void)
  1982. {
  1983. return m_params->focus_mode;
  1984. }
  1985. //======================================================================
  1986. int SecCamera::setFaceDetect(int face_detect)
  1987. {
  1988. LOGV("%s(face_detect(%d))", __func__, face_detect);
  1989. if (m_face_detect != face_detect) {
  1990. m_face_detect = face_detect;
  1991. if (m_flag_camera_start) {
  1992. if (m_face_detect != FACE_DETECTION_OFF) {
  1993. if (fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_FOCUS_MODE, FOCUS_MODE_AUTO) < 0) {
  1994. LOGE("ERR(%s):Fail on V4L2_CID_CAMERA_FOCUS_MODin face detecion", __func__);
  1995. return -1;
  1996. }
  1997. }
  1998. if (fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_FACE_DETECTION, face_detect) < 0) {
  1999. LOGE("ERR(%s):Fail on V4L2_CID_CAMERA_FACE_DETECTION", __func__);
  2000. return -1;
  2001. }
  2002. }
  2003. }
  2004. return 0;
  2005. }
  2006. int SecCamera::getFaceDetect(void)
  2007. {
  2008. return m_face_detect;
  2009. }
  2010. //======================================================================
  2011. int SecCamera::setGPSLatitude(const char *gps_latitude)
  2012. {
  2013. LOGV("%s(gps_latitude(%s))", __func__, gps_latitude);
  2014. if (gps_latitude == NULL)
  2015. m_gps_enabled = false;
  2016. else {
  2017. m_gps_enabled = true;
  2018. m_gps_latitude = lround(strtod(gps_latitude, NULL) * 10000000);
  2019. }
  2020. LOGV("%s(m_gps_latitude(%ld))", __func__, m_gps_latitude);
  2021. return 0;
  2022. }
  2023. int SecCamera::setGPSLongitude(const char *gps_longitude)
  2024. {
  2025. LOGV("%s(gps_longitude(%s))", __func__, gps_longitude);
  2026. if (gps_longitude == NULL)
  2027. m_gps_enabled = false;
  2028. else {
  2029. m_gps_enabled = true;
  2030. m_gps_longitude = lround(strtod(gps_longitude, NULL) * 10000000);
  2031. }
  2032. LOGV("%s(m_gps_longitude(%ld))", __func__, m_gps_longitude);
  2033. return 0;
  2034. }
  2035. int SecCamera::setGPSAltitude(const char *gps_altitude)
  2036. {
  2037. LOGV("%s(gps_altitude(%s))", __func__, gps_altitude);
  2038. if (gps_altitude == NULL)
  2039. m_gps_altitude = 0;
  2040. else {
  2041. m_gps_altitude = lround(strtod(gps_altitude, NULL) * 100);
  2042. }
  2043. LOGV("%s(m_gps_altitude(%ld))", __func__, m_gps_altitude);
  2044. return 0;
  2045. }
  2046. int SecCamera::setGPSTimeStamp(const char *gps_timestamp)
  2047. {
  2048. LOGV("%s(gps_timestamp(%s))", __func__, gps_timestamp);
  2049. if (gps_timestamp == NULL)
  2050. m_gps_timestamp = 0;
  2051. else
  2052. m_gps_timestamp = atol(gps_timestamp);
  2053. LOGV("%s(m_gps_timestamp(%ld))", __func__, m_gps_timestamp);
  2054. return 0;
  2055. }
  2056. int SecCamera::setGPSProcessingMethod(const char *gps_processing_method)
  2057. {
  2058. LOGV("%s(gps_processing_method(%s))", __func__, gps_processing_method);
  2059. memset(mExifInfo.gps_processing_method, 0, sizeof(mExifInfo.gps_processing_method));
  2060. if (gps_processing_method != NULL) {
  2061. size_t len = strlen(gps_processing_method);
  2062. if (len > sizeof(mExifInfo.gps_processing_method)) {
  2063. len = sizeof(mExifInfo.gps_processing_method);
  2064. }
  2065. memcpy(mExifInfo.gps_processing_method, gps_processing_method, len);
  2066. }
  2067. return 0;
  2068. }
  2069. int SecCamera::setFaceDetectLockUnlock(int facedetect_lockunlock)
  2070. {
  2071. LOGV("%s(facedetect_lockunlock(%d))", __func__, facedetect_lockunlock);
  2072. if (fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_FACEDETECT_LOCKUNLOCK, facedetect_lockunlock) < 0) {
  2073. LOGE("ERR(%s):Fail on V4L2_CID_CAMERA_FACEDETECT_LOCKUNLOCK", __func__);
  2074. return -1;
  2075. }
  2076. return 0;
  2077. }
  2078. int SecCamera::setObjectPosition(int x, int y)
  2079. {
  2080. LOGV("%s(setObjectPosition(x=%d, y=%d))", __func__, x, y);
  2081. if (fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_OBJECT_POSITION_X, x) < 0) {
  2082. LOGE("ERR(%s):Fail on V4L2_CID_CAMERA_OBJECT_POSITION_X", __func__);
  2083. return -1;
  2084. }
  2085. if (fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_OBJECT_POSITION_Y, y) < 0) {
  2086. LOGE("ERR(%s):Fail on V4L2_CID_CAMERA_OBJECT_POSITION_Y", __func__);
  2087. return -1;
  2088. }
  2089. return 0;
  2090. }
  2091. //======================================================================
  2092. int SecCamera::setGamma(int gamma)
  2093. {
  2094. LOGV("%s(gamma(%d))", __func__, gamma);
  2095. if (gamma < GAMMA_OFF || GAMMA_MAX <= gamma) {
  2096. LOGE("ERR(%s):Invalid gamma (%d)", __func__, gamma);
  2097. return -1;
  2098. }
  2099. if (m_video_gamma != gamma) {
  2100. m_video_gamma = gamma;
  2101. if (m_flag_camera_start) {
  2102. if (fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_SET_GAMMA, gamma) < 0) {
  2103. LOGE("ERR(%s):Fail on V4L2_CID_CAMERA_SET_GAMMA", __func__);
  2104. return -1;
  2105. }
  2106. }
  2107. }
  2108. return 0;
  2109. }
  2110. //======================================================================
  2111. int SecCamera::setSlowAE(int slow_ae)
  2112. {
  2113. LOGV("%s(slow_ae(%d))", __func__, slow_ae);
  2114. if (slow_ae < GAMMA_OFF || GAMMA_MAX <= slow_ae) {
  2115. LOGE("ERR(%s):Invalid slow_ae (%d)", __func__, slow_ae);
  2116. return -1;
  2117. }
  2118. if (m_slow_ae!= slow_ae) {
  2119. m_slow_ae = slow_ae;
  2120. if (m_flag_camera_start) {
  2121. if (fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_SET_SLOW_AE, slow_ae) < 0) {
  2122. LOGE("ERR(%s):Fail on V4L2_CID_CAMERA_SET_SLOW_AE", __func__);
  2123. return -1;
  2124. }
  2125. }
  2126. }
  2127. return 0;
  2128. }
  2129. //======================================================================
  2130. int SecCamera::setRecordingSize(int width, int height)
  2131. {
  2132. LOGV("%s(width(%d), height(%d))", __func__, width, height);
  2133. m_recording_width = width;
  2134. m_recording_height = height;
  2135. return 0;
  2136. }
  2137. //======================================================================
  2138. int SecCamera::setExifOrientationInfo(int orientationInfo)
  2139. {
  2140. LOGV("%s(orientationInfo(%d))", __func__, orientationInfo);
  2141. if (orientationInfo < 0) {
  2142. LOGE("ERR(%s):Invalid orientationInfo (%d)", __func__, orientationInfo);
  2143. return -1;
  2144. }
  2145. m_exif_orientation = orientationInfo;
  2146. return 0;
  2147. }
  2148. //======================================================================
  2149. // Must call after parameter update on CE147 (so the changes are reflected in batch)
  2150. int SecCamera::setBatchReflection()
  2151. {
  2152. if (m_flag_camera_start) {
  2153. if (fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_BATCH_REFLECTION, 1) < 0) {
  2154. LOGE("ERR(%s):Fail on V4L2_CID_CAMERA_BATCH_REFLECTION", __func__);
  2155. return -1;
  2156. }
  2157. }
  2158. return 0;
  2159. }
  2160. /*Video call*/
  2161. int SecCamera::setVTmode(int vtmode)
  2162. {
  2163. LOGV("%s(vtmode (%d))", __func__, vtmode);
  2164. if (vtmode < VT_MODE_OFF || VT_MODE_MAX <= vtmode) {
  2165. LOGE("ERR(%s):Invalid vtmode (%d)", __func__, vtmode);
  2166. return -1;
  2167. }
  2168. if (m_vtmode != vtmode) {
  2169. m_vtmode = vtmode;
  2170. }
  2171. return 0;
  2172. }
  2173. /* Camcorder fix fps */
  2174. int SecCamera::setSensorMode(int sensor_mode)
  2175. {
  2176. LOGV("%s(sensor_mode (%d))", __func__, sensor_mode);
  2177. if (sensor_mode < SENSOR_MODE_CAMERA || SENSOR_MODE_MOVIE < sensor_mode) {
  2178. LOGE("ERR(%s):Invalid sensor mode (%d)", __func__, sensor_mode);
  2179. return -1;
  2180. }
  2181. if (m_sensor_mode != sensor_mode) {
  2182. m_sensor_mode = sensor_mode;
  2183. }
  2184. return 0;
  2185. }
  2186. /* Shot mode */
  2187. /* SINGLE = 0
  2188. * CONTINUOUS = 1
  2189. * PANORAMA = 2
  2190. * SMILE = 3
  2191. * SELF = 6
  2192. */
  2193. int SecCamera::setShotMode(int shot_mode)
  2194. {
  2195. LOGV("%s(shot_mode (%d))", __func__, shot_mode);
  2196. if (shot_mode < SHOT_MODE_SINGLE || SHOT_MODE_SELF < shot_mode) {
  2197. LOGE("ERR(%s):Invalid shot_mode (%d)", __func__, shot_mode);
  2198. return -1;
  2199. }
  2200. m_shot_mode = shot_mode;
  2201. return 0;
  2202. }
  2203. int SecCamera::getVTmode(void)
  2204. {
  2205. return m_vtmode;
  2206. }
  2207. int SecCamera::setBlur(int blur_level)
  2208. {
  2209. LOGV("%s(level (%d))", __func__, blur_level);
  2210. if (blur_level < BLUR_LEVEL_0 || BLUR_LEVEL_MAX <= blur_level) {
  2211. LOGE("ERR(%s):Invalid level (%d)", __func__, blur_level);
  2212. return -1;
  2213. }
  2214. if (m_blur_level != blur_level) {
  2215. m_blur_level = blur_level;
  2216. if (m_flag_camera_start) {
  2217. if (fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_VGA_BLUR, blur_level) < 0) {
  2218. LOGE("ERR(%s):Fail on V4L2_CID_CAMERA_VGA_BLUR", __func__);
  2219. return -1;
  2220. }
  2221. }
  2222. }
  2223. return 0;
  2224. }
  2225. int SecCamera::getBlur(void)
  2226. {
  2227. return m_blur_level;
  2228. }
  2229. int SecCamera::setDataLineCheck(int chk_dataline)
  2230. {
  2231. LOGV("%s(chk_dataline (%d))", __func__, chk_dataline);
  2232. if (chk_dataline < CHK_DATALINE_OFF || CHK_DATALINE_MAX <= chk_dataline) {
  2233. LOGE("ERR(%s):Invalid chk_dataline (%d)", __func__, chk_dataline);
  2234. return -1;
  2235. }
  2236. m_chk_dataline = chk_dataline;
  2237. return 0;
  2238. }
  2239. int SecCamera::getDataLineCheck(void)
  2240. {
  2241. return m_chk_dataline;
  2242. }
  2243. int SecCamera::setDataLineCheckStop(void)
  2244. {
  2245. LOGV("%s", __func__);
  2246. if (m_flag_camera_start) {
  2247. if (fimc_v4l2_s_ctrl(m_cam_fd, V4L2_CID_CAMERA_CHECK_DATALINE_STOP, 1) < 0) {
  2248. LOGE("ERR(%s):Fail on V4L2_CID_CAMERA_CHECK_DATALINE_STOP", __func__);
  2249. return -1;
  2250. }
  2251. }
  2252. return 0;
  2253. }
  2254. const __u8* SecCamera::getCameraSensorName(void)
  2255. {
  2256. LOGV("%s", __func__);
  2257. return fimc_v4l2_enuminput(m_cam_fd, getCameraId());
  2258. }
  2259. #ifdef ENABLE_ESD_PREVIEW_CHECK
  2260. int SecCamera::getCameraSensorESDStatus(void)
  2261. {
  2262. LOGV("%s", __func__);
  2263. // 0 : normal operation, 1 : abnormal operation
  2264. int status = fimc_v4l2_g_ctrl(m_cam_fd, V4L2_CID_ESD_INT);
  2265. return status;
  2266. }
  2267. #endif // ENABLE_ESD_PREVIEW_CHECK
  2268. // ======================================================================
  2269. // Jpeg
  2270. int SecCamera::setJpegThumbnailSize(int width, int height)
  2271. {
  2272. LOGV("%s(width(%d), height(%d))", __func__, width, height);
  2273. m_jpeg_thumbnail_width = width;
  2274. m_jpeg_thumbnail_height = height;
  2275. return 0;
  2276. }
  2277. int SecCamera::getJpegThumbnailSize(int *width, int *height)
  2278. {
  2279. if (width)
  2280. *width = m_jpeg_thumbnail_width;
  2281. if (height)
  2282. *height = m_jpeg_thumbnail_height;
  2283. return 0;
  2284. }
  2285. void SecCamera::setExifFixedAttribute()
  2286. {
  2287. char property[PROPERTY_VALUE_MAX];
  2288. //2 0th IFD TIFF Tags
  2289. //3 Maker
  2290. property_get("ro.product.brand", property, EXIF_DEF_MAKER);
  2291. strncpy((char *)mExifInfo.maker, property,
  2292. sizeof(mExifInfo.maker) - 1);
  2293. mExifInfo.maker[sizeof(mExifInfo.maker) - 1] = '\0';
  2294. //3 Model
  2295. property_get("ro.product.model", property, EXIF_DEF_MODEL);
  2296. strncpy((char *)mExifInfo.model, property,
  2297. sizeof(mExifInfo.model) - 1);
  2298. mExifInfo.model[sizeof(mExifInfo.model) - 1] = '\0';
  2299. //3 Software
  2300. property_get("ro.build.id", property, EXIF_DEF_SOFTWARE);
  2301. strncpy((char *)mExifInfo.software, property,
  2302. sizeof(mExifInfo.software) - 1);
  2303. mExifInfo.software[sizeof(mExifInfo.software) - 1] = '\0';
  2304. //3 YCbCr Positioning
  2305. mExifInfo.ycbcr_positioning = EXIF_DEF_YCBCR_POSITIONING;
  2306. //2 0th IFD Exif Private Tags
  2307. //3 F Number
  2308. mExifInfo.fnumber.num = EXIF_DEF_FNUMBER_NUM;
  2309. mExifInfo.fnumber.den = EXIF_DEF_FNUMBER_DEN;
  2310. //3 Exposure Program
  2311. mExifInfo.exposure_program = EXIF_DEF_EXPOSURE_PROGRAM;
  2312. //3 Exif Version
  2313. memcpy(mExifInfo.exif_version, EXIF_DEF_EXIF_VERSION, sizeof(mExifInfo.exif_version));
  2314. //3 Aperture
  2315. uint32_t av = APEX_FNUM_TO_APERTURE((double)mExifInfo.fnumber.num/mExifInfo.fnumber.den);
  2316. mExifInfo.aperture.num = av*EXIF_DEF_APEX_DEN;
  2317. mExifInfo.aperture.den = EXIF_DEF_APEX_DEN;
  2318. //3 Maximum lens aperture
  2319. mExifInfo.max_aperture.num = mExifInfo.aperture.num;
  2320. mExifInfo.max_aperture.den = mExifInfo.aperture.den;
  2321. //3 Lens Focal Length
  2322. if (m_camera_id == CAMERA_ID_BACK)
  2323. mExifInfo.focal_length.num = BACK_CAMERA_FOCAL_LENGTH;
  2324. else
  2325. mExifInfo.focal_length.num = FRONT_CAMERA_FOCAL_LENGTH;
  2326. mExifInfo.focal_length.den = EXIF_DEF_FOCAL_LEN_DEN;
  2327. //3 User Comments
  2328. strcpy((char *)mExifInfo.user_comment, EXIF_DEF_USERCOMMENTS);
  2329. //3 Color Space information
  2330. mExifInfo.color_space = EXIF_DEF_COLOR_SPACE;
  2331. //3 Exposure Mode
  2332. mExifInfo.exposure_mode = EXIF_DEF_EXPOSURE_MODE;
  2333. //2 0th IFD GPS Info Tags
  2334. unsigned char gps_version[4] = { 0x02, 0x02, 0x00, 0x00 };
  2335. memcpy(mExifInfo.gps_version_id, gps_version, sizeof(gps_version));
  2336. //2 1th IFD TIFF Tags
  2337. mExifInfo.compression_scheme = EXIF_DEF_COMPRESSION;
  2338. mExifInfo.x_resolution.num = EXIF_DEF_RESOLUTION_NUM;
  2339. mExifInfo.x_resolution.den = EXIF_DEF_RESOLUTION_DEN;
  2340. mExifInfo.y_resolution.num = EXIF_DEF_RESOLUTION_NUM;
  2341. mExifInfo.y_resolution.den = EXIF_DEF_RESOLUTION_DEN;
  2342. mExifInfo.resolution_unit = EXIF_DEF_RESOLUTION_UNIT;
  2343. }
  2344. void SecCamera::setExifChangedAttribute()
  2345. {
  2346. //2 0th IFD TIFF Tags
  2347. //3 Width
  2348. mExifInfo.width = m_snapshot_width;
  2349. //3 Height
  2350. mExifInfo.height = m_snapshot_height;
  2351. //3 Orientation
  2352. switch (m_exif_orientation) {
  2353. case 0:
  2354. mExifInfo.orientation = EXIF_ORIENTATION_UP;
  2355. break;
  2356. case 90:
  2357. mExifInfo.orientation = EXIF_ORIENTATION_90;
  2358. break;
  2359. case 180:
  2360. mExifInfo.orientation = EXIF_ORIENTATION_180;
  2361. break;
  2362. case 270:
  2363. mExifInfo.orientation = EXIF_ORIENTATION_270;
  2364. break;
  2365. default:
  2366. mExifInfo.orientation = EXIF_ORIENTATION_UP;
  2367. break;
  2368. }
  2369. //3 Date time
  2370. time_t rawtime;
  2371. struct tm *timeinfo;
  2372. time(&rawtime);
  2373. timeinfo = localtime(&rawtime);
  2374. strftime((char *)mExifInfo.date_time, 20, "%Y:%m:%d %H:%M:%S", timeinfo);
  2375. //2 0th IFD Exif Private Tags
  2376. //3 Exposure Time
  2377. int shutterSpeed = fimc_v4l2_g_ctrl(m_cam_fd,
  2378. V4L2_CID_CAMERA_GET_SHT_TIME);
  2379. /* TBD - front camera needs to be fixed to support this g_ctrl,
  2380. it current returns a negative err value, so avoid putting
  2381. odd value into exif for now */
  2382. if (shutterSpeed < 0) {
  2383. LOGE("%s: error %d getting shutterSpeed, camera_id = %d, using 100",
  2384. __func__, shutterSpeed, m_camera_id);
  2385. shutterSpeed = 100;
  2386. }
  2387. mExifInfo.exposure_time.num = 1;
  2388. // x us -> 1/x s */
  2389. mExifInfo.exposure_time.den = (uint32_t)(1000000 / shutterSpeed);
  2390. //3 ISO Speed Rating
  2391. int iso = fimc_v4l2_g_ctrl(m_cam_fd, V4L2_CID_CAMERA_GET_ISO);
  2392. /* TBD - front camera needs to be fixed to support this g_ctrl,
  2393. it current returns a negative err value, so avoid putting
  2394. odd value into exif for now */
  2395. if (iso < 0) {
  2396. LOGE("%s: error %d getting iso, camera_id = %d, using 100",
  2397. __func__, iso, m_camera_id);
  2398. iso = ISO_100;
  2399. }
  2400. switch(iso) {
  2401. case ISO_50:
  2402. mExifInfo.iso_speed_rating = 50;
  2403. break;
  2404. case ISO_100:
  2405. mExifInfo.iso_speed_rating = 100;
  2406. break;
  2407. case ISO_200:
  2408. mExifInfo.iso_speed_rating = 200;
  2409. break;
  2410. case ISO_400:
  2411. mExifInfo.iso_speed_rating = 400;
  2412. break;
  2413. case ISO_800:
  2414. mExifInfo.iso_speed_rating = 800;
  2415. break;
  2416. case ISO_1600:
  2417. mExifInfo.iso_speed_rating = 1600;
  2418. break;
  2419. default:
  2420. mExifInfo.iso_speed_rating = 100;
  2421. break;
  2422. }
  2423. uint32_t av, tv, bv, sv, ev;
  2424. av = APEX_FNUM_TO_APERTURE((double)mExifInfo.fnumber.num / mExifInfo.fnumber.den);
  2425. tv = APEX_EXPOSURE_TO_SHUTTER((double)mExifInfo.exposure_time.num / mExifInfo.exposure_time.den);
  2426. sv = APEX_ISO_TO_FILMSENSITIVITY(mExifInfo.iso_speed_rating);
  2427. bv = av + tv - sv;
  2428. ev = av + tv;
  2429. LOGD("Shutter speed=%d us, iso=%d\n", shutterSpeed, mExifInfo.iso_speed_rating);
  2430. LOGD("AV=%d, TV=%d, SV=%d\n", av, tv, sv);
  2431. //3 Shutter Speed
  2432. mExifInfo.shutter_speed.num = tv*EXIF_DEF_APEX_DEN;
  2433. mExifInfo.shutter_speed.den = EXIF_DEF_APEX_DEN;
  2434. //3 Brightness
  2435. mExifInfo.brightness.num = bv*EXIF_DEF_APEX_DEN;
  2436. mExifInfo.brightness.den = EXIF_DEF_APEX_DEN;
  2437. //3 Exposure Bias
  2438. if (m_params->scene_mode == SCENE_MODE_BEACH_SNOW) {
  2439. mExifInfo.exposure_bias.num = EXIF_DEF_APEX_DEN;
  2440. mExifInfo.exposure_bias.den = EXIF_DEF_APEX_DEN;
  2441. } else {
  2442. mExifInfo.exposure_bias.num = 0;
  2443. mExifInfo.exposure_bias.den = 0;
  2444. }
  2445. //3 Metering Mode
  2446. switch (m_params->metering) {
  2447. case METERING_SPOT:
  2448. mExifInfo.metering_mode = EXIF_METERING_SPOT;
  2449. break;
  2450. case METERING_MATRIX:
  2451. mExifInfo.metering_mode = EXIF_METERING_AVERAGE;
  2452. break;
  2453. case METERING_CENTER:
  2454. mExifInfo.metering_mode = EXIF_METERING_CENTER;
  2455. break;
  2456. default :
  2457. mExifInfo.metering_mode = EXIF_METERING_AVERAGE;
  2458. break;
  2459. }
  2460. //3 Flash
  2461. int flash = fimc_v4l2_g_ctrl(m_cam_fd, V4L2_CID_CAMERA_GET_FLASH_ONOFF);
  2462. if (flash < 0)
  2463. mExifInfo.flash = EXIF_DEF_FLASH;
  2464. else
  2465. mExifInfo.flash = flash;
  2466. //3 White Balance
  2467. if (m_params->white_balance == WHITE_BALANCE_AUTO)
  2468. mExifInfo.white_balance = EXIF_WB_AUTO;
  2469. else
  2470. mExifInfo.white_balance = EXIF_WB_MANUAL;
  2471. //3 Scene Capture Type
  2472. switch (m_params->scene_mode) {
  2473. case SCENE_MODE_PORTRAIT:
  2474. mExifInfo.scene_capture_type = EXIF_SCENE_PORTRAIT;
  2475. break;
  2476. case SCENE_MODE_LANDSCAPE:
  2477. mExifInfo.scene_capture_type = EXIF_SCENE_LANDSCAPE;
  2478. break;
  2479. case SCENE_MODE_NIGHTSHOT:
  2480. mExifInfo.scene_capture_type = EXIF_SCENE_NIGHT;
  2481. break;
  2482. default:
  2483. mExifInfo.scene_capture_type = EXIF_SCENE_STANDARD;
  2484. break;
  2485. }
  2486. //2 0th IFD GPS Info Tags
  2487. if (m_gps_enabled) {
  2488. if (m_gps_latitude >= 0)
  2489. strcpy((char *)mExifInfo.gps_latitude_ref, "N");
  2490. else
  2491. strcpy((char *)mExifInfo.gps_latitude_ref, "S");
  2492. if (m_gps_longitude >= 0)
  2493. strcpy((char *)mExifInfo.gps_longitude_ref, "E");
  2494. else
  2495. strcpy((char *)mExifInfo.gps_longitude_ref, "W");
  2496. if (m_gps_altitude >= 0)
  2497. mExifInfo.gps_altitude_ref = 0;
  2498. else
  2499. mExifInfo.gps_altitude_ref = 1;
  2500. mExifInfo.gps_latitude[0].num = (uint32_t)labs(m_gps_latitude);
  2501. mExifInfo.gps_latitude[0].den = 10000000;
  2502. mExifInfo.gps_latitude[1].num = 0;
  2503. mExifInfo.gps_latitude[1].den = 1;
  2504. mExifInfo.gps_latitude[2].num = 0;
  2505. mExifInfo.gps_latitude[2].den = 1;
  2506. mExifInfo.gps_longitude[0].num = (uint32_t)labs(m_gps_longitude);
  2507. mExifInfo.gps_longitude[0].den = 10000000;
  2508. mExifInfo.gps_longitude[1].num = 0;
  2509. mExifInfo.gps_longitude[1].den = 1;
  2510. mExifInfo.gps_longitude[2].num = 0;
  2511. mExifInfo.gps_longitude[2].den = 1;
  2512. mExifInfo.gps_altitude.num = (uint32_t)labs(m_gps_altitude);
  2513. mExifInfo.gps_altitude.den = 100;
  2514. struct tm tm_data;
  2515. gmtime_r(&m_gps_timestamp, &tm_data);
  2516. mExifInfo.gps_timestamp[0].num = tm_data.tm_hour;
  2517. mExifInfo.gps_timestamp[0].den = 1;
  2518. mExifInfo.gps_timestamp[1].num = tm_data.tm_min;
  2519. mExifInfo.gps_timestamp[1].den = 1;
  2520. mExifInfo.gps_timestamp[2].num = tm_data.tm_sec;
  2521. mExifInfo.gps_timestamp[2].den = 1;
  2522. snprintf((char*)mExifInfo.gps_datestamp, sizeof(mExifInfo.gps_datestamp),
  2523. "%04d:%02d:%02d", tm_data.tm_year + 1900, tm_data.tm_mon + 1, tm_data.tm_mday);
  2524. mExifInfo.enableGps = true;
  2525. } else {
  2526. mExifInfo.enableGps = false;
  2527. }
  2528. //2 1th IFD TIFF Tags
  2529. mExifInfo.widthThumb = m_jpeg_thumbnail_width;
  2530. mExifInfo.heightThumb = m_jpeg_thumbnail_height;
  2531. }
  2532. // ======================================================================
  2533. // Conversions
  2534. inline int SecCamera::m_frameSize(int format, int width, int height)
  2535. {
  2536. int size = 0;
  2537. switch (format) {
  2538. case V4L2_PIX_FMT_YUV420:
  2539. case V4L2_PIX_FMT_NV12:
  2540. case V4L2_PIX_FMT_NV21:
  2541. size = (width * height * 3 / 2);
  2542. break;
  2543. case V4L2_PIX_FMT_NV12T:
  2544. size = ALIGN_TO_8KB(ALIGN_TO_128B(width) * ALIGN_TO_32B(height)) +
  2545. ALIGN_TO_8KB(ALIGN_TO_128B(width) * ALIGN_TO_32B(height / 2));
  2546. break;
  2547. case V4L2_PIX_FMT_YUV422P:
  2548. case V4L2_PIX_FMT_YUYV:
  2549. case V4L2_PIX_FMT_UYVY:
  2550. size = (width * height * 2);
  2551. break;
  2552. default :
  2553. LOGE("ERR(%s):Invalid V4L2 pixel format(%d)\n", __func__, format);
  2554. case V4L2_PIX_FMT_RGB565:
  2555. size = (width * height * BPP);
  2556. break;
  2557. }
  2558. return size;
  2559. }
  2560. status_t SecCamera::dump(int fd)
  2561. {
  2562. const size_t SIZE = 256;
  2563. char buffer[SIZE];
  2564. String8 result;
  2565. snprintf(buffer, 255, "dump(%d)\n", fd);
  2566. result.append(buffer);
  2567. ::write(fd, result.string(), result.size());
  2568. return NO_ERROR;
  2569. }
  2570. double SecCamera::jpeg_ratio = 0.7;
  2571. int SecCamera::interleaveDataSize = 5242880;
  2572. int SecCamera::jpegLineLength = 636;
  2573. }; // namespace android