blob: 263a91c76f33fc1de162e336381228786966bfd4 [file] [log] [blame]
Wind Yuan75564b12015-01-15 06:51:15 -05001/*
2 * main.cpp - test
3 *
4 * Copyright (c) 2014 Intel Corporation
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 * Author: Wind Yuan <feng.yuan@intel.com>
19 */
20
21#include "device_manager.h"
22#include "atomisp_device.h"
Sameer Kibey7b429292015-08-07 10:55:38 -070023#include "uvc_device.h"
Jia Meng0a532932015-10-15 08:44:09 -040024#include "fake_v4l2_device.h"
Wind Yuan75564b12015-01-15 06:51:15 -050025#include "isp_controller.h"
26#include "isp_image_processor.h"
27#include "x3a_analyzer_simple.h"
28#if HAVE_IA_AIQ
29#include "x3a_analyzer_aiq.h"
30#endif
Wind Yuand4427312015-02-11 16:09:00 +080031#if HAVE_LIBCL
Wind Yuane4ba0c92015-03-26 16:59:06 +080032#include "cl_3a_image_processor.h"
Yinhang Liu2ab1f992016-03-15 10:41:17 +080033#include "cl_post_image_processor.h"
wangfeicf4c4e72015-05-25 17:11:41 +080034#include "cl_csc_image_processor.h"
Yinhang Liu81c44e02015-06-03 15:47:48 +080035#include "cl_hdr_handler.h"
36#include "cl_tnr_handler.h"
Wind Yuane4ba0c92015-03-26 16:59:06 +080037#endif
38#if HAVE_LIBDRM
39#include "drm_display.h"
Wind Yuand4427312015-02-11 16:09:00 +080040#endif
zongwave03954a32015-09-22 15:40:44 +080041#include "x3a_analyzer_loader.h"
Jia Meng0a532932015-10-15 08:44:09 -040042#include "poll_thread.h"
43#include "fake_poll_thread.h"
Jia Meng66efecf2015-06-17 11:11:10 +000044#include <base/xcam_3a_types.h>
Wind Yuan75564b12015-01-15 06:51:15 -050045#include <unistd.h>
46#include <signal.h>
47#include <stdlib.h>
ShincyTue521cf92015-03-27 15:13:51 +080048#include <string>
Yinhang Liu81c44e02015-06-03 15:47:48 +080049#include <getopt.h>
John Yeae9da732015-01-22 13:36:36 +080050#include "test_common.h"
51
Wind Yuan75564b12015-01-15 06:51:15 -050052using namespace XCam;
53
wujunkai16682950fb2015-10-19 18:09:05 +080054#define IMX185_WDR_CPF "/etc/atomisp/imx185_wdr.cpf"
55
ShincyTue521cf92015-03-27 15:13:51 +080056static Mutex g_mutex;
57static Cond g_cond;
58static bool g_stop = false;
59
Wind Yuan75564b12015-01-15 06:51:15 -050060class MainDeviceManager
61 : public DeviceManager
62{
63public:
64 MainDeviceManager ()
65 : _file (NULL)
66 , _save_file (false)
67 , _interval (1)
Yinhang Liud9346492015-12-17 11:14:25 +080068 , _frame_width (0)
69 , _frame_height (0)
Wind Yuan75564b12015-01-15 06:51:15 -050070 , _frame_count (0)
ShincyTue521cf92015-03-27 15:13:51 +080071 , _frame_save (0)
Wind Yuan683f8662015-03-27 18:52:38 +080072 , _enable_display (false)
Wind Yuane4ba0c92015-03-26 16:59:06 +080073 {
74#if HAVE_LIBDRM
75 _display = DrmDisplay::instance();
76#endif
Wind Yuan91625802015-06-24 15:36:01 +080077 XCAM_OBJ_PROFILING_INIT;
Wind Yuane4ba0c92015-03-26 16:59:06 +080078 }
Wind Yuan75564b12015-01-15 06:51:15 -050079
80 ~MainDeviceManager () {
81 close_file ();
82 }
83
84 void enable_save_file (bool enable) {
85 _save_file = enable;
86 }
Yinhang Liud9346492015-12-17 11:14:25 +080087
Wind Yuan75564b12015-01-15 06:51:15 -050088 void set_interval (uint32_t inteval) {
89 _interval = inteval;
90 }
Yinhang Liud9346492015-12-17 11:14:25 +080091
92 void set_frame_width (uint32_t frame_width) {
93 _frame_width = frame_width;
94 }
95
96 void set_frame_height (uint32_t frame_height) {
97 _frame_height = frame_height;
98 }
99
ShincyTue521cf92015-03-27 15:13:51 +0800100 void set_frame_save (uint32_t frame_save) {
101 _frame_save = frame_save;
102 }
Wind Yuan75564b12015-01-15 06:51:15 -0500103
Wind Yuan683f8662015-03-27 18:52:38 +0800104 void enable_display(bool value) {
105 _enable_display = value;
106 }
107
wangfeicf4c4e72015-05-25 17:11:41 +0800108 void set_display_mode(DrmDisplayMode mode) {
109 _display->set_display_mode (mode);
110 }
111
Wind Yuan75564b12015-01-15 06:51:15 -0500112protected:
Wind Yuan73af3932015-07-02 17:52:43 +0800113 virtual void handle_message (const SmartPtr<XCamMessage> &msg);
114 virtual void handle_buffer (const SmartPtr<VideoBuffer> &buf);
Wind Yuan75564b12015-01-15 06:51:15 -0500115
Wind Yuan73af3932015-07-02 17:52:43 +0800116 int display_buf (const SmartPtr<VideoBuffer> &buf);
Wind Yuane4ba0c92015-03-26 16:59:06 +0800117
Wind Yuan75564b12015-01-15 06:51:15 -0500118private:
119 void open_file ();
120 void close_file ();
Wind Yuan71111322016-02-24 22:56:27 +0800121 XCamReturn write_buf (const SmartPtr<VideoBuffer> &buf);
Wind Yuan75564b12015-01-15 06:51:15 -0500122
123 FILE *_file;
124 bool _save_file;
125 uint32_t _interval;
Yinhang Liud9346492015-12-17 11:14:25 +0800126 uint32_t _frame_width;
127 uint32_t _frame_height;
Wind Yuan75564b12015-01-15 06:51:15 -0500128 uint32_t _frame_count;
ShincyTue521cf92015-03-27 15:13:51 +0800129 uint32_t _frame_save;
Wind Yuane4ba0c92015-03-26 16:59:06 +0800130 SmartPtr<DrmDisplay> _display;
Wind Yuan683f8662015-03-27 18:52:38 +0800131 bool _enable_display;
Wind Yuan91625802015-06-24 15:36:01 +0800132 XCAM_OBJ_PROFILING_DEFINES;
Wind Yuan75564b12015-01-15 06:51:15 -0500133};
134
135void
Wind Yuan73af3932015-07-02 17:52:43 +0800136MainDeviceManager::handle_message (const SmartPtr<XCamMessage> &msg)
Wind Yuan75564b12015-01-15 06:51:15 -0500137{
138 XCAM_UNUSED (msg);
139}
140
141void
Wind Yuan73af3932015-07-02 17:52:43 +0800142MainDeviceManager::handle_buffer (const SmartPtr<VideoBuffer> &buf)
Wind Yuan75564b12015-01-15 06:51:15 -0500143{
Wind Yuan683f8662015-03-27 18:52:38 +0800144 FPS_CALCULATION (fps_buf, 30);
145
Wind Yuan91625802015-06-24 15:36:01 +0800146 XCAM_OBJ_PROFILING_START;
147
Wind Yuan683f8662015-03-27 18:52:38 +0800148 if (_enable_display)
149 display_buf (buf);
Wind Yuane4ba0c92015-03-26 16:59:06 +0800150
Wind Yuan91625802015-06-24 15:36:01 +0800151 XCAM_OBJ_PROFILING_END("main_dev_manager_display", 30);
152
Wind Yuan75564b12015-01-15 06:51:15 -0500153 if (!_save_file)
154 return ;
155
156 if ((_frame_count++ % _interval) != 0)
157 return;
158
ShincyTue521cf92015-03-27 15:13:51 +0800159 if ((_frame_save != 0) && (_frame_count > _frame_save)) {
160 SmartLock locker (g_mutex);
161 g_stop = true;
162 g_cond.broadcast ();
163 return;
164 }
165
Wind Yuan75564b12015-01-15 06:51:15 -0500166 open_file ();
Jia Meng6c9241d2015-06-12 11:08:45 +0000167
168 if (!_file) {
169 XCAM_LOG_ERROR ("open file failed");
Jia Meng54a2dcb2015-08-20 15:23:47 +0800170 return;
Jia Meng6c9241d2015-06-12 11:08:45 +0000171 }
Wind Yuan71111322016-02-24 22:56:27 +0800172 write_buf (buf);
Wind Yuan75564b12015-01-15 06:51:15 -0500173}
174
Wind Yuane4ba0c92015-03-26 16:59:06 +0800175int
Wind Yuan73af3932015-07-02 17:52:43 +0800176MainDeviceManager::display_buf (const SmartPtr<VideoBuffer> &data)
Wind Yuane4ba0c92015-03-26 16:59:06 +0800177{
178#if HAVE_LIBDRM
179 XCamReturn ret = XCAM_RETURN_NO_ERROR;
Wind Yuan73af3932015-07-02 17:52:43 +0800180 SmartPtr<VideoBuffer> buf = data;
Wind Yuane4ba0c92015-03-26 16:59:06 +0800181 const VideoBufferInfo & frame_info = buf->get_video_info ();
182 struct v4l2_rect rect = { 0, 0, (int)frame_info.width, (int)frame_info.height };
183
184 if (!_display->is_render_inited ()) {
Yinhang Liud9346492015-12-17 11:14:25 +0800185 ret = _display->render_init (0, 0, this->_frame_width, this->_frame_height,
186 frame_info.format, &rect);
Wind Yuane4ba0c92015-03-26 16:59:06 +0800187 CHECK (ret, "display failed on render_init");
188 }
189 ret = _display->render_setup_frame_buffer (buf);
190 CHECK (ret, "display failed on framebuf set");
191 ret = _display->render_buffer (buf);
192 CHECK (ret, "display failed on rendering");
193#endif
194 return 0;
195}
196
197
Wind Yuan75564b12015-01-15 06:51:15 -0500198void
199MainDeviceManager::open_file ()
200{
ShincyTue521cf92015-03-27 15:13:51 +0800201 if ((_file) && (_frame_save == 0))
Wind Yuan75564b12015-01-15 06:51:15 -0500202 return;
ShincyTue521cf92015-03-27 15:13:51 +0800203
204 std::string file_name = DEFAULT_SAVE_FILE_NAME;
205
206 if (_frame_save != 0) {
207 file_name += std::to_string(_frame_count);
208 }
209 file_name += ".raw";
210
211 _file = fopen(file_name.c_str(), "wb");
Wind Yuan75564b12015-01-15 06:51:15 -0500212}
213
214void
215MainDeviceManager::close_file ()
216{
217 if (_file)
218 fclose (_file);
219 _file = NULL;
220}
221
Wind Yuan71111322016-02-24 22:56:27 +0800222XCamReturn
223MainDeviceManager::write_buf (const SmartPtr<VideoBuffer> &buf)
224{
225 const VideoBufferInfo &info = buf->get_video_info ();
226 VideoBufferPlanarInfo planar;
227 uint8_t *memory = NULL;
228 XCamReturn ret = XCAM_RETURN_NO_ERROR;
229
230 memory = buf->map ();
231 if (!memory) {
232 XCAM_LOG_ERROR ("map buffer failed in write_buf");
233 return XCAM_RETURN_ERROR_MEM;
234 }
235
236 for (uint32_t index = 0; index < info.components; index++) {
237 info.get_planar_info (planar, index);
238 uint32_t line_bytes = planar.width * planar.pixel_bytes;
239
240 for (uint32_t i = 0; i < planar.height; i++) {
241 if (fwrite (memory + info.offsets [index] + i * info.strides [index], 1, line_bytes, _file) != line_bytes) {
242 XCAM_LOG_ERROR ("write file failed, size doesn't match");
243 ret = XCAM_RETURN_ERROR_FILE;
244 }
245 }
246 }
247 buf->unmap ();
248 return ret;
249}
250
Wind Yuan75564b12015-01-15 06:51:15 -0500251#define V4L2_CAPTURE_MODE_STILL 0x2000
252#define V4L2_CAPTURE_MODE_VIDEO 0x4000
253#define V4L2_CAPTURE_MODE_PREVIEW 0x8000
254
Wind Yuan26e9e212015-04-16 15:55:45 +0800255typedef enum {
256 AnalyzerTypeSimple = 0,
257 AnalyzerTypeAiq,
Wind Yuane25ce3f2015-05-04 18:07:29 +0800258 AnalyzerTypeDynamic,
Jia Meng9724cfe2015-08-12 15:04:45 +0800259 AnalyzerTypeHybrid,
Wind Yuan26e9e212015-04-16 15:55:45 +0800260} AnalyzerType;
261
Wind Yuan75564b12015-01-15 06:51:15 -0500262void dev_stop_handler(int sig)
263{
264 XCAM_UNUSED (sig);
265
266 SmartLock locker (g_mutex);
267 g_stop = true;
268 g_cond.broadcast ();
269
270 //exit(0);
271}
272
273void print_help (const char *bin_name)
274{
275 printf ("Usage: %s [-a analyzer]\n"
Yinhang Liu81c44e02015-06-03 15:47:48 +0800276 "Configurations:\n"
ShincyTue521cf92015-03-27 15:13:51 +0800277 "\t -a analyzer specify a analyzer\n"
Wind Yuane25ce3f2015-05-04 18:07:29 +0800278 "\t select from [simple, aiq, dynamic], default is [simple]\n"
ShincyTue521cf92015-03-27 15:13:51 +0800279 "\t -m mem_type specify video memory type\n"
280 "\t mem_type select from [dma, mmap], default is [mmap]\n"
281 "\t -s save file to %s\n"
282 "\t -n interval save file on every [interval] frame\n"
Yinhang Liuc2f19082015-08-28 12:27:48 +0800283#if HAVE_LIBCL
ShincyTue521cf92015-03-27 15:13:51 +0800284 "\t -c process image with cl kernel\n"
Yinhang Liuc2f19082015-08-28 12:27:48 +0800285#endif
ShincyTue521cf92015-03-27 15:13:51 +0800286 "\t -f pixel_fmt specify output pixel format\n"
wujunkai1669845b022015-08-27 15:59:27 +0800287 "\t pixel_fmt select from [NV12, YUYV, BA10, BA12], default is [NV12]\n"
ShincyTue521cf92015-03-27 15:13:51 +0800288 "\t -d cap_mode specify capture mode\n"
289 "\t cap_mode select from [video, still], default is [video]\n"
yaowang1a5f12122015-07-27 14:53:38 +0800290 "\t -b brightness specify brightness level\n"
291 "\t brightness level select from [0, 256], default is [128]\n"
ShincyTue521cf92015-03-27 15:13:51 +0800292 "\t -i frame_save specify the frame count to save, default is 0 which means endless\n"
wangfeicf4c4e72015-05-25 17:11:41 +0800293 "\t -p preview on local display\n"
Sameer Kibey7b429292015-08-07 10:55:38 -0700294 "\t --usb specify node for usb camera device, enables capture path through USB camera \n"
295 "\t specify [/dev/video4, /dev/video5] depending on which node USB camera is attached\n"
Yinhang Liud9346492015-12-17 11:14:25 +0800296 "\t --resolution specify the resolution of usb camera\n"
297 "\t select from [1920x1080, 1280x720 ...], default is [1920x1080]\n"
wangfeicf4c4e72015-05-25 17:11:41 +0800298 "\t -e display_mode preview mode\n"
299 "\t select from [primary, overlay], default is [primary]\n"
Jia Meng8f94a102015-08-11 16:24:19 +0800300 "\t --sync set analyzer in sync mode\n"
Jia Meng0a532932015-10-15 08:44:09 -0400301 "\t -r raw_input specify the path of raw image as fake source instead of live camera\n"
ShincyTue521cf92015-03-27 15:13:51 +0800302 "\t -h help\n"
Yinhang Liuc2f19082015-08-28 12:27:48 +0800303#if HAVE_LIBCL
Yinhang Liu81c44e02015-06-03 15:47:48 +0800304 "CL features:\n"
wujunkai166a84ba052015-09-08 15:54:12 +0800305 "\t --capture capture_stage specify the capture stage of image\n"
306 "\t capture_stage select from [bayer, tonemapping], default is [tonemapping]\n"
Yinhang Liu81c44e02015-06-03 15:47:48 +0800307 "\t --hdr specify hdr type, default is hdr off\n"
308 "\t select from [rgb, lab]\n"
309 "\t --tnr specify temporal noise reduction type, default is tnr off\n"
310 "\t select from [rgb, yuv, both]\n"
311 "\t --tnr-level specify tnr level\n"
wujunkai16606f77622016-03-18 14:41:10 +0800312 "\t --wdr-mode specify wdr mode. select from [gaussian, haleq]\n"
Yinhang Liub92930c2015-06-23 16:26:35 +0800313 "\t --bilateral enable bilateral noise reduction\n"
Yinhang Liu81c44e02015-06-03 15:47:48 +0800314 "\t --enable-snr enable simple noise reduction\n"
Jia Meng66efecf2015-06-17 11:11:10 +0000315 "\t --enable-ee enable YEENR\n"
ShincyTu63e2c262015-06-26 10:52:51 +0800316 "\t --enable-bnr enable bayer noise reduction\n"
Yinhang Liue26b2622015-07-21 18:32:36 +0800317 "\t --enable-dpc enable defect pixel correction\n"
Wangfei8e5e3e42016-02-18 19:41:54 +0800318 "\t --enable-retinex enable retinex\n"
zongwave2ba7f642016-03-15 19:24:12 +0800319 "\t --wavelet-mode specify wavelet mode\n"
Wangfei1487b9b2015-08-28 15:10:39 +0800320 "\t --pipeline pipe mode\n"
Wangfei16b65db2015-09-11 14:44:28 +0800321 "\t select from [basic, advance, extreme], default is [basic]\n"
Yinhang Liue26b2622015-07-21 18:32:36 +0800322 "(e.g.: xxxx --hdr=xx --tnr=xx --tnr-level=xx --bilateral --enable-snr --enable-ee --enable-bnr --enable-dpc)\n\n"
Yinhang Liuc2f19082015-08-28 12:27:48 +0800323#endif
Wind Yuan75564b12015-01-15 06:51:15 -0500324 , bin_name
325 , DEFAULT_SAVE_FILE_NAME);
326}
327
328int main (int argc, char *argv[])
329{
330 XCamReturn ret = XCAM_RETURN_NO_ERROR;
331 SmartPtr<MainDeviceManager> device_manager = new MainDeviceManager;
332 SmartPtr<V4l2Device> device;
333 SmartPtr<V4l2SubDevice> event_device;
334 SmartPtr<IspController> isp_controller;
335 SmartPtr<X3aAnalyzer> analyzer;
zongwave03954a32015-09-22 15:40:44 +0800336 SmartPtr<X3aAnalyzerLoader> loader;
Jia Meng9724cfe2015-08-12 15:04:45 +0800337 const char *path_of_3a;
Wind Yuane4ba0c92015-03-26 16:59:06 +0800338 SmartPtr<ImageProcessor> isp_processor;
Wind Yuan26e9e212015-04-16 15:55:45 +0800339 AnalyzerType analyzer_type = AnalyzerTypeSimple;
wangfeicf4c4e72015-05-25 17:11:41 +0800340 DrmDisplayMode display_mode = DRM_DISPLAY_MODE_PRIMARY;
Wind Yuane4ba0c92015-03-26 16:59:06 +0800341#if HAVE_LIBDRM
342 SmartPtr<DrmDisplay> drm_disp = DrmDisplay::instance();
343#endif
344
Wind Yuand4427312015-02-11 16:09:00 +0800345#if HAVE_LIBCL
Wind Yuane4ba0c92015-03-26 16:59:06 +0800346 SmartPtr<CL3aImageProcessor> cl_processor;
Yinhang Liu2ab1f992016-03-15 10:41:17 +0800347 SmartPtr<CLPostImageProcessor> cl_post_processor;
Yinhang Liuc2f19082015-08-28 12:27:48 +0800348 uint32_t hdr_type = CL_HDR_DISABLE;
349 uint32_t tnr_type = CL_TNR_DISABLE;
350 uint32_t denoise_type = 0;
351 uint8_t tnr_level = 0;
352 bool dpc_type = false;
Wangfei1487b9b2015-08-28 15:10:39 +0800353 CL3aImageProcessor::PipelineProfile pipeline_mode = CL3aImageProcessor::BasicPipelineProfile;
wujunkai166a84ba052015-09-08 15:54:12 +0800354 CL3aImageProcessor::CaptureStage capture_stage = CL3aImageProcessor::TonemappingStage;
wujunkai16606f77622016-03-18 14:41:10 +0800355 CL3aImageProcessor::CLTonemappingMode wdr_mode = CL3aImageProcessor::WDRdisabled;
Wind Yuand4427312015-02-11 16:09:00 +0800356#endif
357 bool have_cl_processor = false;
Wind Yuane4ba0c92015-03-26 16:59:06 +0800358 bool need_display = false;
Wind Yuand4427312015-02-11 16:09:00 +0800359 enum v4l2_memory v4l2_mem_type = V4L2_MEMORY_MMAP;
Wind Yuan75564b12015-01-15 06:51:15 -0500360 const char *bin_name = argv[0];
361 int opt;
ShincyTu2808b592015-03-13 17:17:25 +0800362 uint32_t capture_mode = V4L2_CAPTURE_MODE_VIDEO;
363 uint32_t pixel_format = V4L2_PIX_FMT_NV12;
Jia Menga6580232015-10-08 16:51:28 +0800364 bool wdr_type = false;
Wangfei8e5e3e42016-02-18 19:41:54 +0800365 bool retinex_type = false;
zongwave28a747b2016-03-17 12:49:08 +0800366 CL3aImageProcessor::WaveletBasis wavelet_mode = CL3aImageProcessor::WaveletDisable;
yaowang1a5f12122015-07-27 14:53:38 +0800367 int32_t brightness_level = 128;
Sameer Kibey7b429292015-08-07 10:55:38 -0700368 bool have_usbcam = 0;
Wind Yuan155c8f52016-03-18 23:16:59 +0800369 SmartPtr<char> usb_device_name;
Jia Meng8f94a102015-08-11 16:24:19 +0800370 bool sync_mode = false;
Jia Meng757f3c92015-09-09 11:18:36 +0800371 int frame_rate;
Yinhang Liud9346492015-12-17 11:14:25 +0800372 int frame_width = 1920;
373 int frame_height = 1080;
Wind Yuan155c8f52016-03-18 23:16:59 +0800374 SmartPtr<char> path_to_fake = NULL;
Wind Yuan75564b12015-01-15 06:51:15 -0500375
Jia Meng0a532932015-10-15 08:44:09 -0400376 const char *short_opts = "sca:n:m:f:d:b:pi:e:r:h";
Yinhang Liu81c44e02015-06-03 15:47:48 +0800377 const struct option long_opts[] = {
378 {"hdr", required_argument, NULL, 'H'},
379 {"tnr", required_argument, NULL, 'T'},
380 {"tnr-level", required_argument, NULL, 'L'},
wujunkai16606f77622016-03-18 14:41:10 +0800381 {"wdr-mode", required_argument, NULL, 'W'},
Yinhang Liub92930c2015-06-23 16:26:35 +0800382 {"bilateral", no_argument, NULL, 'I'},
Yinhang Liu81c44e02015-06-03 15:47:48 +0800383 {"enable-snr", no_argument, NULL, 'S'},
Jia Meng66efecf2015-06-17 11:11:10 +0000384 {"enable-ee", no_argument, NULL, 'E'},
ShincyTu63e2c262015-06-26 10:52:51 +0800385 {"enable-bnr", no_argument, NULL, 'B'},
Yinhang Liue26b2622015-07-21 18:32:36 +0800386 {"enable-dpc", no_argument, NULL, 'D'},
Wangfei8e5e3e42016-02-18 19:41:54 +0800387 {"enable-retinex", no_argument, NULL, 'X'},
zongwave2ba7f642016-03-15 19:24:12 +0800388 {"wavelet-mode", required_argument, NULL, 'V'},
Sameer Kibey7b429292015-08-07 10:55:38 -0700389 {"usb", required_argument, NULL, 'U'},
Yinhang Liud9346492015-12-17 11:14:25 +0800390 {"resolution", required_argument, NULL, 'R'},
Jia Meng8f94a102015-08-11 16:24:19 +0800391 {"sync", no_argument, NULL, 'Y'},
wujunkai166a84ba052015-09-08 15:54:12 +0800392 {"capture", required_argument, NULL, 'C'},
Wangfei1487b9b2015-08-28 15:10:39 +0800393 {"pipeline", required_argument, NULL, 'P'},
Yinhang Liu81c44e02015-06-03 15:47:48 +0800394 {0, 0, 0, 0},
395 };
396
397 while ((opt = getopt_long(argc, argv, short_opts, long_opts, NULL)) != -1) {
Wind Yuan75564b12015-01-15 06:51:15 -0500398 switch (opt) {
399 case 'a': {
Wind Yuan6b437392016-02-02 00:31:30 +0800400 XCAM_ASSERT (optarg);
Wind Yuane25ce3f2015-05-04 18:07:29 +0800401 if (!strcmp (optarg, "dynamic"))
402 analyzer_type = AnalyzerTypeDynamic;
403 else if (!strcmp (optarg, "simple"))
Wind Yuan26e9e212015-04-16 15:55:45 +0800404 analyzer_type = AnalyzerTypeSimple;
Wind Yuan75564b12015-01-15 06:51:15 -0500405#if HAVE_IA_AIQ
406 else if (!strcmp (optarg, "aiq"))
Wind Yuan26e9e212015-04-16 15:55:45 +0800407 analyzer_type = AnalyzerTypeAiq;
Jia Meng9724cfe2015-08-12 15:04:45 +0800408 else if (!strcmp (optarg, "hybrid"))
409 analyzer_type = AnalyzerTypeHybrid;
Wind Yuan75564b12015-01-15 06:51:15 -0500410#endif
411 else {
412 print_help (bin_name);
413 return -1;
414 }
415 break;
416 }
417
Wind Yuand4427312015-02-11 16:09:00 +0800418 case 'm': {
Wind Yuan6b437392016-02-02 00:31:30 +0800419 XCAM_ASSERT (optarg);
Wind Yuand4427312015-02-11 16:09:00 +0800420 if (!strcmp (optarg, "dma"))
421 v4l2_mem_type = V4L2_MEMORY_DMABUF;
422 else if (!strcmp (optarg, "mmap"))
423 v4l2_mem_type = V4L2_MEMORY_MMAP;
424 else
425 print_help (bin_name);
426 break;
427 }
428
Wind Yuan75564b12015-01-15 06:51:15 -0500429 case 's':
430 device_manager->enable_save_file (true);
431 break;
432 case 'n':
433 device_manager->set_interval (atoi(optarg));
434 break;
Yinhang Liuc2f19082015-08-28 12:27:48 +0800435#if HAVE_LIBCL
Wind Yuand4427312015-02-11 16:09:00 +0800436 case 'c':
437 have_cl_processor = true;
438 break;
Yinhang Liuc2f19082015-08-28 12:27:48 +0800439#endif
ShincyTu2808b592015-03-13 17:17:25 +0800440 case 'f':
ShincyTuc8466402015-03-31 11:03:39 +0800441 CHECK_EXP ((strlen(optarg) == 4), "invalid pixel format\n");
442 pixel_format = v4l2_fourcc ((unsigned)optarg[0],
443 (unsigned)optarg[1],
444 (unsigned)optarg[2],
445 (unsigned)optarg[3]);
ShincyTu2808b592015-03-13 17:17:25 +0800446 break;
447 case 'd':
Wind Yuan6b437392016-02-02 00:31:30 +0800448 XCAM_ASSERT (optarg);
ShincyTu2808b592015-03-13 17:17:25 +0800449 if (!strcmp (optarg, "still"))
450 capture_mode = V4L2_CAPTURE_MODE_STILL;
451 else if (!strcmp (optarg, "video"))
452 capture_mode = V4L2_CAPTURE_MODE_VIDEO;
453 else {
454 print_help (bin_name);
455 return -1;
456 }
457 break;
yaowang1a5f12122015-07-27 14:53:38 +0800458 case 'b':
459 brightness_level = atoi(optarg);
460 if(brightness_level < 0 || brightness_level > 256) {
461 print_help (bin_name);
462 return -1;
463 }
464 break;
Wind Yuane4ba0c92015-03-26 16:59:06 +0800465 case 'p':
466 need_display = true;
467 break;
Sameer Kibey7b429292015-08-07 10:55:38 -0700468 case 'U':
469 have_usbcam = true;
Wind Yuan155c8f52016-03-18 23:16:59 +0800470 usb_device_name = strndup(optarg, XCAM_MAX_STR_SIZE);
471 XCAM_LOG_DEBUG("using USB camera plugged in at node: %s", XCAM_STR(usb_device_name.ptr ()));
Sameer Kibey7b429292015-08-07 10:55:38 -0700472 break;
Yinhang Liud9346492015-12-17 11:14:25 +0800473 case 'R':
Wind Yuan6b437392016-02-02 00:31:30 +0800474 XCAM_ASSERT (optarg);
Yinhang Liud9346492015-12-17 11:14:25 +0800475 sscanf (optarg, "%d%*c%d", &frame_width, &frame_height);
476 break;
wangfeicf4c4e72015-05-25 17:11:41 +0800477 case 'e': {
Wind Yuan6b437392016-02-02 00:31:30 +0800478 XCAM_ASSERT (optarg);
wangfeicf4c4e72015-05-25 17:11:41 +0800479 if (!strcmp (optarg, "primary"))
480 display_mode = DRM_DISPLAY_MODE_PRIMARY;
481 else if (!strcmp (optarg, "overlay"))
482 display_mode = DRM_DISPLAY_MODE_OVERLAY;
483 else {
484 print_help (bin_name);
485 return -1;
486 }
487 break;
488 }
ShincyTue521cf92015-03-27 15:13:51 +0800489 case 'i':
490 device_manager->set_frame_save(atoi(optarg));
491 break;
Jia Meng8f94a102015-08-11 16:24:19 +0800492 case 'Y':
493 sync_mode = true;
494 break;
Yinhang Liuc2f19082015-08-28 12:27:48 +0800495#if HAVE_LIBCL
Yinhang Liu81c44e02015-06-03 15:47:48 +0800496 case 'H': {
Wind Yuan6b437392016-02-02 00:31:30 +0800497 XCAM_ASSERT (optarg);
Yinhang Liu81c44e02015-06-03 15:47:48 +0800498 if (!strcasecmp (optarg, "rgb"))
499 hdr_type = CL_HDR_TYPE_RGB;
500 else if (!strcasecmp (optarg, "lab"))
501 hdr_type = CL_HDR_TYPE_LAB;
502 else {
503 print_help (bin_name);
504 return -1;
505 }
506 break;
507 }
Yinhang Liub92930c2015-06-23 16:26:35 +0800508 case 'I': {
Jia Meng66efecf2015-06-17 11:11:10 +0000509 denoise_type |= XCAM_DENOISE_TYPE_BILATERAL;
Juan Zhaod9664932015-09-08 10:22:19 +0800510 denoise_type |= XCAM_DENOISE_TYPE_BIYUV;
Yinhang Liu81c44e02015-06-03 15:47:48 +0800511 break;
512 }
513 case 'S': {
Jia Meng66efecf2015-06-17 11:11:10 +0000514 denoise_type |= XCAM_DENOISE_TYPE_SIMPLE;
515 break;
516 }
517 case 'E': {
518 denoise_type |= XCAM_DENOISE_TYPE_EE;
Yinhang Liu81c44e02015-06-03 15:47:48 +0800519 break;
520 }
ShincyTu63e2c262015-06-26 10:52:51 +0800521 case 'B': {
522 denoise_type |= XCAM_DENOISE_TYPE_BNR;
523 break;
524 }
Wangfei8e5e3e42016-02-18 19:41:54 +0800525 case 'X': {
526 retinex_type = true;
527 break;
528 }
zongwave80adcf52016-02-29 12:38:06 +0800529 case 'V': {
zongwave2ba7f642016-03-15 19:24:12 +0800530 XCAM_ASSERT (optarg);
531 if (atoi(optarg) < 0 || atoi(optarg) > 255) {
532 print_help (bin_name);
533 return -1;
534 }
zongwave28a747b2016-03-17 12:49:08 +0800535 if (atoi(optarg) == 1) {
536 wavelet_mode = CL3aImageProcessor::HatWavelet;
537 } else if (atoi(optarg) == 2) {
538 wavelet_mode = CL3aImageProcessor::HaarWavelet;
539 } else {
540 wavelet_mode = CL3aImageProcessor::WaveletDisable;
541 }
zongwave80adcf52016-02-29 12:38:06 +0800542 break;
543 }
Yinhang Liue26b2622015-07-21 18:32:36 +0800544 case 'D': {
545 dpc_type = true;
546 break;
547 }
Yinhang Liu81c44e02015-06-03 15:47:48 +0800548 case 'T': {
Wind Yuan6b437392016-02-02 00:31:30 +0800549 XCAM_ASSERT (optarg);
Yinhang Liu81c44e02015-06-03 15:47:48 +0800550 if (!strcasecmp (optarg, "yuv"))
551 tnr_type = CL_TNR_TYPE_YUV;
552 else if (!strcasecmp (optarg, "rgb"))
553 tnr_type = CL_TNR_TYPE_RGB;
554 else if (!strcasecmp (optarg, "both"))
555 tnr_type = CL_TNR_TYPE_YUV | CL_TNR_TYPE_RGB;
556 else {
557 print_help (bin_name);
558 return -1;
559 }
560 break;
561 }
562 case 'L': {
Wind Yuan6b437392016-02-02 00:31:30 +0800563 XCAM_ASSERT (optarg);
Yinhang Liu81c44e02015-06-03 15:47:48 +0800564 if (atoi(optarg) < 0 || atoi(optarg) > 255) {
565 print_help (bin_name);
566 return -1;
567 }
568 tnr_level = atoi(optarg);
569 break;
570 }
Jia Menga6580232015-10-08 16:51:28 +0800571 case 'W': {
wujunkai16606f77622016-03-18 14:41:10 +0800572 XCAM_ASSERT (optarg);
573 if (!strcasecmp (optarg, "gaussian"))
574 wdr_mode = CL3aImageProcessor::Gaussian;
575 else if (!strcasecmp (optarg, "haleq"))
576 wdr_mode = CL3aImageProcessor::Haleq;
wujunkai16682950fb2015-10-19 18:09:05 +0800577
wujunkai166b0bd5512016-02-18 18:25:42 +0800578 pixel_format = V4L2_PIX_FMT_SGRBG12;
wujunkai16606f77622016-03-18 14:41:10 +0800579 wdr_type = true;
wujunkai166b0bd5512016-02-18 18:25:42 +0800580 setenv ("AIQ_CPF_PATH", IMX185_WDR_CPF, 1);
581 break;
582 }
Wangfei1487b9b2015-08-28 15:10:39 +0800583 case 'P': {
Wind Yuan6b437392016-02-02 00:31:30 +0800584 XCAM_ASSERT (optarg);
Wangfei1487b9b2015-08-28 15:10:39 +0800585 if (!strcasecmp (optarg, "basic"))
586 pipeline_mode = CL3aImageProcessor::BasicPipelineProfile;
587 else if (!strcasecmp (optarg, "advance"))
588 pipeline_mode = CL3aImageProcessor::AdvancedPipelineProfile;
Wangfei16b65db2015-09-11 14:44:28 +0800589 else if (!strcasecmp (optarg, "extreme"))
590 pipeline_mode = CL3aImageProcessor::ExtremePipelineProfile;
Wangfei1487b9b2015-08-28 15:10:39 +0800591 else {
592 print_help (bin_name);
593 return -1;
594 }
595 break;
596 }
wujunkai166a84ba052015-09-08 15:54:12 +0800597 case 'C': {
Wind Yuan6b437392016-02-02 00:31:30 +0800598 XCAM_ASSERT (optarg);
wujunkai166a84ba052015-09-08 15:54:12 +0800599 if (!strcmp (optarg, "bayer"))
600 capture_stage = CL3aImageProcessor::BasicbayerStage;
601 break;
602 }
Yinhang Liuc2f19082015-08-28 12:27:48 +0800603#endif
Jia Meng0a532932015-10-15 08:44:09 -0400604 case 'r': {
605 if (optarg) {
606 XCAM_LOG_INFO ("use raw image %s as input source", optarg);
Wind Yuan155c8f52016-03-18 23:16:59 +0800607 path_to_fake = strndup(optarg, XCAM_MAX_STR_SIZE);
Jia Meng0a532932015-10-15 08:44:09 -0400608 }
609 break;
610 }
Wind Yuan75564b12015-01-15 06:51:15 -0500611 case 'h':
612 print_help (bin_name);
613 return 0;
614
615 default:
616 print_help (bin_name);
617 return -1;
618 }
619 }
620
Yinhang Liud9346492015-12-17 11:14:25 +0800621 device_manager->set_frame_width(frame_width);
622 device_manager->set_frame_height(frame_height);
wangfeicf4c4e72015-05-25 17:11:41 +0800623 if (need_display) {
Wind Yuan683f8662015-03-27 18:52:38 +0800624 device_manager->enable_display (true);
wangfeicf4c4e72015-05-25 17:11:41 +0800625 device_manager->set_display_mode (display_mode);
626 }
ShincyTu2808b592015-03-13 17:17:25 +0800627 if (!device.ptr ()) {
Wind Yuan155c8f52016-03-18 23:16:59 +0800628 if (path_to_fake.ptr ()) {
Jia Meng0a532932015-10-15 08:44:09 -0400629 device = new FakeV4l2Device ();
630 } else if (have_usbcam) {
Wind Yuan155c8f52016-03-18 23:16:59 +0800631 device = new UVCDevice (usb_device_name.ptr ());
Sameer Kibey7b429292015-08-07 10:55:38 -0700632 } else {
633 if (capture_mode == V4L2_CAPTURE_MODE_STILL)
634 device = new AtomispDevice (CAPTURE_DEVICE_STILL);
635 else if (capture_mode == V4L2_CAPTURE_MODE_VIDEO)
636 device = new AtomispDevice (CAPTURE_DEVICE_VIDEO);
637 else
638 device = new AtomispDevice (DEFAULT_CAPTURE_DEVICE);
639 }
ShincyTu2808b592015-03-13 17:17:25 +0800640 }
Wind Yuan75564b12015-01-15 06:51:15 -0500641 if (!event_device.ptr ())
642 event_device = new V4l2SubDevice (DEFAULT_EVENT_DEVICE);
643 if (!isp_controller.ptr ())
644 isp_controller = new IspController (device);
Wind Yuan26e9e212015-04-16 15:55:45 +0800645
646 switch (analyzer_type) {
Wind Yuan3d1d15e2015-04-16 17:40:47 +0800647 case AnalyzerTypeSimple:
648 analyzer = new X3aAnalyzerSimple ();
649 break;
Wind Yuan26e9e212015-04-16 15:55:45 +0800650#if HAVE_IA_AIQ
Wind Yuan3d1d15e2015-04-16 17:40:47 +0800651 case AnalyzerTypeAiq:
652 analyzer = new X3aAnalyzerAiq (isp_controller, DEFAULT_CPF_FILE);
653 break;
Jia Meng9724cfe2015-08-12 15:04:45 +0800654 case AnalyzerTypeHybrid: {
Jia Mengc54c3322015-08-26 09:45:18 +0800655 path_of_3a = DEFAULT_HYBRID_3A_LIB;
zongwave03954a32015-09-22 15:40:44 +0800656 loader = new X3aAnalyzerLoader (path_of_3a);
Jia Meng9724cfe2015-08-12 15:04:45 +0800657 analyzer = loader->load_hybrid_analyzer (loader, isp_controller, DEFAULT_CPF_FILE);
658 CHECK_EXP (analyzer.ptr (), "load hybrid 3a lib(%s) failed", path_of_3a);
659 break;
660 }
Wind Yuan26e9e212015-04-16 15:55:45 +0800661#endif
Wind Yuane25ce3f2015-05-04 18:07:29 +0800662 case AnalyzerTypeDynamic: {
Jia Meng9724cfe2015-08-12 15:04:45 +0800663 path_of_3a = DEFAULT_DYNAMIC_3A_LIB;
zongwave03954a32015-09-22 15:40:44 +0800664 loader = new X3aAnalyzerLoader (path_of_3a);
Jia Meng9724cfe2015-08-12 15:04:45 +0800665 analyzer = loader->load_dynamic_analyzer (loader);
Wind Yuane25ce3f2015-05-04 18:07:29 +0800666 CHECK_EXP (analyzer.ptr (), "load dynamic 3a lib(%s) failed", path_of_3a);
667 break;
668 }
Wind Yuan3d1d15e2015-04-16 17:40:47 +0800669 default:
670 print_help (bin_name);
671 return -1;
Wind Yuan26e9e212015-04-16 15:55:45 +0800672 }
Jia Meng8f94a102015-08-11 16:24:19 +0800673 XCAM_ASSERT (analyzer.ptr ());
674 analyzer->set_sync_mode (sync_mode);
Wind Yuan75564b12015-01-15 06:51:15 -0500675
676 signal(SIGINT, dev_stop_handler);
677
678 device->set_sensor_id (0);
ShincyTu2808b592015-03-13 17:17:25 +0800679 device->set_capture_mode (capture_mode);
Wind Yuan75564b12015-01-15 06:51:15 -0500680 //device->set_mem_type (V4L2_MEMORY_DMABUF);
Wind Yuand4427312015-02-11 16:09:00 +0800681 device->set_mem_type (v4l2_mem_type);
Wind Yuan75564b12015-01-15 06:51:15 -0500682 device->set_buffer_count (8);
Jia Meng757f3c92015-09-09 11:18:36 +0800683 if (pixel_format == V4L2_PIX_FMT_SGRBG12) {
684 frame_rate = 30;
685 device->set_framerate (frame_rate, 1);
686 }
687 else {
688 frame_rate = 25;
689 device->set_framerate (frame_rate, 1);
wujunkai16606f77622016-03-18 14:41:10 +0800690 if(wdr_type == true) {
wujunkai166a9a55f22015-10-10 15:53:32 +0800691 XCAM_LOG_WARNING("Tonemapping is only applicable under BA12 format. Disable tonemapping automatically.");
wujunkai16606f77622016-03-18 14:41:10 +0800692 wdr_type = false;
wujunkai166a9a55f22015-10-10 15:53:32 +0800693 }
Jia Meng757f3c92015-09-09 11:18:36 +0800694 }
Wind Yuan75564b12015-01-15 06:51:15 -0500695 ret = device->open ();
696 CHECK (ret, "device(%s) open failed", device->get_device_name());
Yinhang Liud9346492015-12-17 11:14:25 +0800697 ret = device->set_format (frame_width, frame_height, pixel_format, V4L2_FIELD_NONE, frame_width * 2);
Wind Yuan75564b12015-01-15 06:51:15 -0500698 CHECK (ret, "device(%s) set format failed", device->get_device_name());
699
700 ret = event_device->open ();
Wind Yuanb67045c2015-08-27 13:50:53 +0800701 if (ret == XCAM_RETURN_NO_ERROR) {
702 CHECK (ret, "event device(%s) open failed", event_device->get_device_name());
703 int event = V4L2_EVENT_ATOMISP_3A_STATS_READY;
704 ret = event_device->subscribe_event (event);
705 CHECK_CONTINUE (
706 ret,
707 "device(%s) subscribe event(%d) failed",
708 event_device->get_device_name(), event);
709 event = V4L2_EVENT_FRAME_SYNC;
710 ret = event_device->subscribe_event (event);
711 CHECK_CONTINUE (
712 ret,
713 "device(%s) subscribe event(%d) failed",
714 event_device->get_device_name(), event);
715
716 device_manager->set_event_device (event_device);
717 }
Wind Yuan75564b12015-01-15 06:51:15 -0500718
719 device_manager->set_capture_device (device);
Wind Yuan75564b12015-01-15 06:51:15 -0500720 device_manager->set_isp_controller (isp_controller);
721 if (analyzer.ptr())
zongwave03954a32015-09-22 15:40:44 +0800722 device_manager->set_3a_analyzer (analyzer);
Wind Yuan3d1d15e2015-04-16 17:40:47 +0800723
724 if (have_cl_processor)
725 isp_processor = new IspExposureImageProcessor (isp_controller);
726 else
727 isp_processor = new IspImageProcessor (isp_controller);
728
729 XCAM_ASSERT (isp_processor.ptr ());
Wind Yuane4ba0c92015-03-26 16:59:06 +0800730 device_manager->add_image_processor (isp_processor);
Yinhang Liuc2f19082015-08-28 12:27:48 +0800731#if HAVE_LIBCL
Wind Yuand4427312015-02-11 16:09:00 +0800732 if (have_cl_processor) {
Wind Yuane4ba0c92015-03-26 16:59:06 +0800733 cl_processor = new CL3aImageProcessor ();
Wind Yuan7ddf2602015-04-14 18:49:45 +0800734 cl_processor->set_stats_callback(device_manager);
Yinhang Liue26b2622015-07-21 18:32:36 +0800735 cl_processor->set_dpc(dpc_type);
Yinhang Liu81c44e02015-06-03 15:47:48 +0800736 cl_processor->set_hdr (hdr_type);
Jia Meng66efecf2015-06-17 11:11:10 +0000737 cl_processor->set_denoise (denoise_type);
wujunkai16606f77622016-03-18 14:41:10 +0800738 cl_processor->set_tonemapping(wdr_mode);
Jia Menga6580232015-10-08 16:51:28 +0800739 cl_processor->set_gamma (!wdr_type); // disable gamma for WDR
zongwave28a747b2016-03-17 12:49:08 +0800740 cl_processor->set_wavelet (wavelet_mode);
wujunkai166a84ba052015-09-08 15:54:12 +0800741 cl_processor->set_capture_stage (capture_stage);
wujunkai166c8f3b442016-02-29 17:12:09 +0800742
743 if (wdr_type) {
744 cl_processor->set_3a_stats_bits(12);
745 }
Yinhang Liu81c44e02015-06-03 15:47:48 +0800746 cl_processor->set_tnr (tnr_type, tnr_level);
Wangfei1487b9b2015-08-28 15:10:39 +0800747 cl_processor->set_profile (pipeline_mode);
yaowang1a5f12122015-07-27 14:53:38 +0800748 analyzer->set_parameter_brightness((brightness_level - 128) / 128.0);
Wind Yuand4427312015-02-11 16:09:00 +0800749 device_manager->add_image_processor (cl_processor);
750 }
Yinhang Liu3c17fea2016-03-15 10:47:03 +0800751
752 cl_post_processor = new CLPostImageProcessor ();
Yinhang Liu3c721c12016-03-15 15:03:51 +0800753
754 cl_post_processor->set_retinex (retinex_type);
755
Yinhang Liu3c17fea2016-03-15 10:47:03 +0800756 if ((display_mode == DRM_DISPLAY_MODE_PRIMARY) && need_display) {
757 cl_post_processor->set_output_format (V4L2_PIX_FMT_XBGR32);
758 }
759 device_manager->add_image_processor (cl_post_processor);
Wind Yuand4427312015-02-11 16:09:00 +0800760#endif
Wind Yuane4ba0c92015-03-26 16:59:06 +0800761
Jia Meng0a532932015-10-15 08:44:09 -0400762 SmartPtr<PollThread> poll_thread;
Wind Yuan155c8f52016-03-18 23:16:59 +0800763 if (path_to_fake.ptr ())
764 poll_thread = new FakePollThread (path_to_fake.ptr ());
Jia Meng0a532932015-10-15 08:44:09 -0400765 else
766 poll_thread = new PollThread ();
767 device_manager->set_poll_thread (poll_thread);
768
Wind Yuan75564b12015-01-15 06:51:15 -0500769 ret = device_manager->start ();
770 CHECK (ret, "device manager start failed");
771
Jia Meng757f3c92015-09-09 11:18:36 +0800772 // hard code exposure range and max gain for imx185 WDR
Jia Menga6580232015-10-08 16:51:28 +0800773 if (wdr_type) {
Jia Meng757f3c92015-09-09 11:18:36 +0800774 if (frame_rate == 30)
775 analyzer->set_ae_exposure_time_range (80 * 1110 * 1000 / 37125, 1120 * 1110 * 1000 / 37125);
776 else
Jia Menga6580232015-10-08 16:51:28 +0800777 analyzer->set_ae_exposure_time_range (80 * 1320 * 1000 / 37125, 1120 * 1320 * 1000 / 37125);
Jia Meng757f3c92015-09-09 11:18:36 +0800778 analyzer->set_ae_max_analog_gain (3.98); // 12dB
779 }
780
Wind Yuan75564b12015-01-15 06:51:15 -0500781 // wait for interruption
782 {
783 SmartLock locker (g_mutex);
784 while (!g_stop)
785 g_cond.wait (g_mutex);
786 }
787
788 ret = device_manager->stop();
789 CHECK_CONTINUE (ret, "device manager stop failed");
790 device->close ();
791 event_device->close ();
Wind Yuan75564b12015-01-15 06:51:15 -0500792
793 return 0;
794}