summaryrefslogtreecommitdiff
path: root/v4l2_vdin.cpp (plain)
blob: 9e2283f993325a729264a8b1137c0d7424d2014a
1/*
2 * Copyright (C) 2013 The Android Open Source Project
3 *
4 * Licensed under the Apache License, Version 2.0 (the "License");
5 * you may not use this file except in compliance with the License.
6 * You may obtain a copy of the License at
7 *
8 * http://www.apache.org/licenses/LICENSE-2.0
9 *
10 * Unless required by applicable law or agreed to in writing, software
11 * distributed under the License is distributed on an "AS IS" BASIS,
12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
13 * See the License for the specific language governing permissions and
14 * limitations under the License.
15 */
16
17
18//reinclude because of a bug with the log macros
19//#define LOG_NDEBUG 0
20#define LOG_TAG "V4L2VINSOURCE"
21#include <utils/Log.h>
22#include <utils/String8.h>
23
24#include <signal.h>
25#include <stdio.h>
26#include <stdlib.h>
27#include <string.h>
28#include <fcntl.h>
29#include <unistd.h>
30#include <errno.h>
31#include <sys/ioctl.h>
32#include <sys/mman.h>
33#include <sys/select.h>
34#include <linux/videodev2.h>
35#include <sys/time.h>
36
37#include <cutils/properties.h>
38#include <sys/types.h>
39#include <sys/stat.h>
40
41#include "v4l2_vdin.h"
42#include <ui/GraphicBufferMapper.h>
43#include <ui/GraphicBuffer.h>
44#include <linux/videodev2.h>
45
46namespace android {
47
48#define V4L2_ROTATE_ID 0x980922
49
50#ifndef container_of
51#define container_of(ptr, type, member) ({ \
52 const typeof(((type *) 0)->member) *__mptr = (ptr); \
53 (type *) ((char *) __mptr - (char *)(&((type *)0)->member)); })
54#endif
55
56#define BOUNDRY 32
57
58#define ALIGN(x) (x + (BOUNDRY) - 1)& ~((BOUNDRY) - 1)
59
60static size_t getBufSize(int format, int width, int height)
61{
62 size_t buf_size = 0;
63
64 switch(format){
65 case V4L2_PIX_FMT_YVU420:
66 case V4L2_PIX_FMT_NV21:
67 buf_size = width * height * 3 / 2;
68 break;
69 case V4L2_PIX_FMT_YUYV:
70 case V4L2_PIX_FMT_RGB565:
71 buf_size = width * height * 2;
72 break;
73 case V4L2_PIX_FMT_RGB24:
74 buf_size = width * height * 3;
75 break;
76 case V4L2_PIX_FMT_RGB32:
77 buf_size = width * height * 4;
78 break;
79 default:
80 ALOGE("Invalid format");
81 buf_size = 0;
82 }
83 return buf_size;
84}
85
86static int getNativeWindowFormat(int format)
87{
88 int nativeFormat = HAL_PIXEL_FORMAT_YCbCr_422_I;
89
90 switch(format){
91 case V4L2_PIX_FMT_YVU420:
92 nativeFormat = HAL_PIXEL_FORMAT_YV12;
93 break;
94 case V4L2_PIX_FMT_NV21:
95 nativeFormat = HAL_PIXEL_FORMAT_YCrCb_420_SP;
96 break;
97 case V4L2_PIX_FMT_YUYV:
98 nativeFormat = HAL_PIXEL_FORMAT_YCbCr_422_I;
99 break;
100 case V4L2_PIX_FMT_RGB565:
101 nativeFormat = HAL_PIXEL_FORMAT_RGB_565;
102 break;
103 case V4L2_PIX_FMT_RGB24:
104 nativeFormat = HAL_PIXEL_FORMAT_RGB_888;
105 break;
106 case V4L2_PIX_FMT_RGB32:
107 nativeFormat = HAL_PIXEL_FORMAT_RGBA_8888;
108 break;
109 default:
110 ALOGE("Invalid format,Use default format");
111 }
112 return nativeFormat;
113}
114
115
116static ANativeWindowBuffer* handle_to_buffer(buffer_handle_t *handle)
117{
118 return container_of(handle, ANativeWindowBuffer, handle);
119}
120
121vdin_screen_source::vdin_screen_source()
122 : mCameraHandle(-1),
123 mVideoInfo(NULL)
124{
125 ALOGV("%s %d", __FUNCTION__, __LINE__);
126}
127
128int vdin_screen_source::init(){
129 ALOGV("%s %d", __FUNCTION__, __LINE__);
130 mCameraHandle = open("/dev/video11", O_RDWR| O_NONBLOCK);
131 if (mCameraHandle < 0)
132 {
133 ALOGE("[%s %d] mCameraHandle:%x [%s]", __FUNCTION__, __LINE__, mCameraHandle,strerror(errno));
134 return -1;
135 }
136 mVideoInfo = (struct VideoInfo *) calloc (1, sizeof (struct VideoInfo));
137 if (mVideoInfo == NULL)
138 {
139 ALOGE("[%s %d] no memory for mVideoInfo", __FUNCTION__, __LINE__);
140 close(mCameraHandle);
141 return NO_MEMORY;
142 }
143 mBufferCount = 4;
144 mPixelFormat = V4L2_PIX_FMT_NV21;
145 mNativeWindowPixelFormat = HAL_PIXEL_FORMAT_YCrCb_420_SP;
146 mFrameWidth = 1280;
147 mFrameHeight = 720;
148 mBufferSize = mFrameWidth * mFrameHeight * 3/2;
149 mSetStateCB = NULL;
150 mState = STOP;
151 mANativeWindow = NULL;
152 mFrameType = 0;
153 mWorkThread = NULL;
154 mDataCB = NULL;
155 mOpen = false;
156 return NO_ERROR;
157}
158
159vdin_screen_source::~vdin_screen_source()
160{
161 if (mVideoInfo)
162 free (mVideoInfo);
163 if (mCameraHandle >= 0)
164 close(mCameraHandle);
165}
166
167int vdin_screen_source::start_v4l2_device()
168{
169 int ret = -1;
170
171 ALOGV("[%s %d] mCameraHandle:%x", __FUNCTION__, __LINE__, mCameraHandle);
172
173 ioctl(mCameraHandle, VIDIOC_QUERYCAP, &mVideoInfo->cap);
174
175 mVideoInfo->rb.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
176 mVideoInfo->rb.memory = V4L2_MEMORY_MMAP;
177 mVideoInfo->rb.count = mBufferCount;
178
179 ret = ioctl(mCameraHandle, VIDIOC_REQBUFS, &mVideoInfo->rb);
180
181 if (ret < 0) {
182 ALOGE("[%s %d] VIDIOC_REQBUFS:%d mCameraHandle:%x", __FUNCTION__, __LINE__, ret, mCameraHandle);
183 return ret;
184 }
185
186 for (int i = 0; i < mBufferCount; i++) {
187 memset (&mVideoInfo->buf, 0, sizeof (struct v4l2_buffer));
188
189 mVideoInfo->buf.index = i;
190 mVideoInfo->buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
191 mVideoInfo->buf.memory = V4L2_MEMORY_MMAP;
192
193 ret = ioctl (mCameraHandle, VIDIOC_QUERYBUF, &mVideoInfo->buf);
194 if (ret < 0) {
195 ALOGE("[%s %d]VIDIOC_QUERYBUF %d failed", __FUNCTION__, __LINE__, i);
196 return ret;
197 }
198 mVideoInfo->canvas[i] = mVideoInfo->buf.reserved;
199 mVideoInfo->mem[i] = mmap (0, mVideoInfo->buf.length, PROT_READ | PROT_WRITE,
200 MAP_SHARED, mCameraHandle, mVideoInfo->buf.m.offset);
201
202 if (mVideoInfo->mem[i] == MAP_FAILED) {
203 ALOGE("[%s %d] MAP_FAILED", __FUNCTION__, __LINE__);
204 return -1;
205 }
206 mVideoInfo->refcount[i] = 0;
207 mBufs.add(mVideoInfo->mem[i],i);
208 }
209 ALOGV("[%s %d] VIDIOC_QUERYBUF successful", __FUNCTION__, __LINE__);
210
211 for (int i = 0; i < mBufferCount; i++) {
212 mVideoInfo->buf.index = i;
213 mVideoInfo->buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
214 mVideoInfo->buf.memory = V4L2_MEMORY_MMAP;
215 ret = ioctl(mCameraHandle, VIDIOC_QBUF, &mVideoInfo->buf);
216 if (ret < 0) {
217 ALOGE("VIDIOC_QBUF Failed");
218 return -1;
219 }
220 }
221 enum v4l2_buf_type bufType;
222 bufType = V4L2_BUF_TYPE_VIDEO_CAPTURE;
223
224 ret = ioctl (mCameraHandle, VIDIOC_STREAMON, &bufType);
225
226 ALOGV("[%s %d] VIDIOC_STREAMON:%x", __FUNCTION__, __LINE__, ret);
227 return ret;
228}
229
230int vdin_screen_source::start()
231{
232 ALOGV("%s %d", __FUNCTION__, __LINE__);
233 int ret;
234 if(mOpen == true){
235 ALOGI("already open");
236 return NO_ERROR;
237 }
238
239 ret = start_v4l2_device();
240 if(ret != NO_ERROR){
241 ALOGE("Start v4l2 device failed:%d",ret);
242 return ret;
243 }
244 if(mFrameType & NATIVE_WINDOW_DATA){
245 ret = init_native_window();
246 if(ret != NO_ERROR){
247 ALOGE("Init Native Window Failed:%d",ret);
248 return ret;
249 }
250 }
251 if(mFrameType & NATIVE_WINDOW_DATA || mFrameType & CALL_BACK_DATA){
252 ALOGD("Create Work Thread");
253 mWorkThread = new WorkThread(this);
254 }
255 if(mSetStateCB != NULL)
256 mSetStateCB(START);
257 mState = START;
258 mOpen = true;
259 ALOGV("%s %d ret:%d", __FUNCTION__, __LINE__, ret);
260 return NO_ERROR;
261}
262
263int vdin_screen_source::pause()
264{
265 ALOGV("%s %d", __FUNCTION__, __LINE__);
266 mState = PAUSE;
267 if(mSetStateCB != NULL)
268 mSetStateCB(PAUSE);
269 return NO_ERROR;
270}
271int vdin_screen_source::stop()
272{
273 ALOGV("%s %d", __FUNCTION__, __LINE__);
274 int ret;
275 mState = STOPING;
276
277 if(mWorkThread != NULL){
278 mWorkThread->requestExitAndWait();
279 mWorkThread.clear();
280 }
281
282 enum v4l2_buf_type bufType = V4L2_BUF_TYPE_VIDEO_CAPTURE;
283
284 ret = ioctl (mCameraHandle, VIDIOC_STREAMOFF, &bufType);
285 if (ret < 0) {
286 ALOGE("StopStreaming: Unable to stop capture: %s", strerror(errno));
287 }
288 for (int i = 0; i < mBufferCount; i++){
289 if (munmap(mVideoInfo->mem[i], mVideoInfo->buf.length) < 0)
290 ALOGE("Unmap failed");
291 }
292
293 mBufferCount = 0;
294 mState = STOP;
295 if(mSetStateCB != NULL)
296 mSetStateCB(STOP);
297 mOpen = false;
298 return ret;
299}
300
301int vdin_screen_source::set_state_callback(olStateCB callback)
302{
303 if (!callback){
304 ALOGE("NULL state callback pointer");
305 return BAD_VALUE;
306 }
307 mSetStateCB = callback;
308 return NO_ERROR;
309}
310
311int vdin_screen_source::set_preview_window(ANativeWindow* window)
312{
313 ALOGV("%s %d", __FUNCTION__, __LINE__);
314 if(mOpen == true)
315 return NO_ERROR;
316 //can work without a valid window object ?
317 if (window == NULL){
318 ALOGD("NULL window object passed to ScreenSource");
319 if(mWorkThread != NULL){
320 mWorkThread->requestExitAndWait();
321 mWorkThread.clear();
322 }
323 mFrameType &= ~NATIVE_WINDOW_DATA;
324 return NO_ERROR;
325 }
326 mFrameType |= NATIVE_WINDOW_DATA;
327 mANativeWindow = window;
328 return NO_ERROR;
329}
330
331int vdin_screen_source::set_data_callback(app_data_callback callback, void* user)
332{
333 ALOGV("%s %d", __FUNCTION__, __LINE__);
334 if (callback == NULL){
335 ALOGE("NULL data callback pointer");
336 return BAD_VALUE;
337 }
338 mDataCB = callback;
339 mUser = user;
340 mFrameType |= CALL_BACK_DATA;
341 return NO_ERROR;
342}
343
344int vdin_screen_source::get_format()
345{
346 return mPixelFormat;
347}
348
349int vdin_screen_source::set_format(int width, int height, int color_format)
350{
351 ALOGV("[%s %d]", __FUNCTION__, __LINE__);
352 if(mOpen == true)
353 return NO_ERROR;
354 int ret;
355 mVideoInfo->width = ALIGN(width);
356 mVideoInfo->height = height;
357 mVideoInfo->framesizeIn = (mVideoInfo->width * mVideoInfo->height << 3); //note color format
358 mVideoInfo->formatIn = color_format;
359
360 mVideoInfo->format.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
361 mVideoInfo->format.fmt.pix.width = ALIGN(width);
362 mVideoInfo->format.fmt.pix.height = height;
363 mVideoInfo->format.fmt.pix.pixelformat = color_format;
364 mPixelFormat = color_format;
365 mNativeWindowPixelFormat = getNativeWindowFormat(color_format);
366 mFrameWidth = ALIGN(width);
367 mFrameHeight = height;
368 mBufferSize = getBufSize(color_format, mFrameWidth, mFrameHeight);
369 ALOGD("mFrameWidth:%d,mFrameHeight:%d",mFrameWidth,mFrameHeight);
370 ALOGD("mPixelFormat:%x,mNativeWindowPixelFormat:%x,mBufferSize:%d",mPixelFormat,mNativeWindowPixelFormat,mBufferSize);
371 ret = ioctl(mCameraHandle, VIDIOC_S_FMT, &mVideoInfo->format);
372 if (ret < 0) {
373 ALOGE("[%s %d]VIDIOC_S_FMT %d", __FUNCTION__, __LINE__, ret);
374 return ret;
375 }
376 return ret;
377}
378
379int vdin_screen_source::set_rotation(int degree)
380{
381 ALOGV("[%s %d]", __FUNCTION__, __LINE__);
382
383 int ret = 0;
384 struct v4l2_control ctl;
385
386 if(mCameraHandle<0)
387 return -1;
388
389 if((degree!=0)&&(degree!=90)&&(degree!=180)&&(degree!=270)){
390 ALOGE("Set rotate value invalid: %d.", degree);
391 return -1;
392 }
393
394 memset( &ctl, 0, sizeof(ctl));
395 ctl.value=degree;
396 ctl.id = V4L2_ROTATE_ID;
397 ret = ioctl(mCameraHandle, VIDIOC_S_CTRL, &ctl);
398
399 if(ret<0){
400 ALOGE("Set rotate value fail: %s. ret=%d", strerror(errno),ret);
401 }
402 return ret ;
403}
404
405int vdin_screen_source::set_crop(int x, int y, int width, int height)
406{
407 ALOGV("[%s %d]", __FUNCTION__, __LINE__);
408 if (NULL == mANativeWindow.get())
409 return BAD_VALUE;
410
411 int err = NO_ERROR;
412 android_native_rect_t crop = { x, y, x + width - 1, y + height - 1 };
413 err = native_window_set_crop(mANativeWindow.get(), &crop);
414 if (err != 0) {
415 ALOGW("Failed to set crop!");
416 return err;
417 }
418 return NO_ERROR;
419}
420
421int vdin_screen_source::set_frame_rate(int frameRate)
422{
423 ALOGV("[%s %d]", __FUNCTION__, __LINE__);
424 int ret = 0;
425 struct v4l2_control ctl;
426
427 if(mCameraHandle<0)
428 return -1;
429
430 struct v4l2_streamparm sparm;
431 memset(&sparm, 0, sizeof( sparm ));
432 sparm.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;//stream_flag;
433 sparm.parm.output.timeperframe.denominator = frameRate;
434 sparm.parm.output.timeperframe.numerator = 1;
435
436 ret = ioctl(mCameraHandle, VIDIOC_S_PARM, &sparm);
437 if(ret < 0){
438 ALOGE("Set frame rate fail: %s. ret=%d", strerror(errno),ret);
439 }
440 return ret ;
441}
442
443int vdin_screen_source::set_source_type(int sourceType)
444{
445 ALOGV("[%s %d]", __FUNCTION__, __LINE__);
446 int ret = 0;
447
448 ret = ioctl(mCameraHandle, VIDIOC_S_INPUT, &sourceType);
449 if(ret < 0){
450 ALOGE("Set source type fail: %s. ret:%d", strerror(errno),ret);
451 }
452 return ret;
453}
454
455int vdin_screen_source::get_source_type()
456{
457 ALOGV("[%s %d]", __FUNCTION__, __LINE__);
458 int ret = -1;
459 int sourceType;
460
461 ret = ioctl(mCameraHandle, VIDIOC_G_INPUT, &sourceType);
462 if(ret < 0){
463 ALOGE("Set source type fail: %s. ret:%d", strerror(errno),ret);
464 return ret;
465 }
466 return sourceType;
467}
468
469int vdin_screen_source::aquire_buffer(aml_screen_buffer_info_t *buff_info)
470{
471 ALOGV("%s %d", __FUNCTION__, __LINE__);
472 int ret = -1;
473 mVideoInfo->buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
474 mVideoInfo->buf.memory = V4L2_MEMORY_MMAP;
475
476 ret = ioctl(mCameraHandle, VIDIOC_DQBUF, &mVideoInfo->buf);
477 if (ret < 0) {
478 if(EAGAIN == errno){
479 ret = -EAGAIN;
480 }else{
481 ALOGE("[%s %d]aquire_buffer %d", __FUNCTION__, __LINE__, ret);
482 }
483 buff_info->buffer_mem = 0;
484 buff_info->buffer_canvas = 0;
485 return ret;
486 }
487 buff_info->buffer_mem = mVideoInfo->mem[mVideoInfo->buf.index];
488 buff_info->buffer_canvas = mVideoInfo->canvas[mVideoInfo->buf.index];
489 buff_info->tv_sec = mVideoInfo->buf.timestamp.tv_sec;
490 buff_info->tv_usec = mVideoInfo->buf.timestamp.tv_usec;
491 return ret;
492}
493
494/* int vdin_screen_source::inc_buffer_refcount(int *ptr){
495 ALOGV("%s %d", __FUNCTION__, __LINE__);
496 int ret = -1;
497 int index;
498 index = mBufs.valueFor((unsigned int)ptr);
499 mVideoInfo->refcount[index] += 1;
500 return true;
501} */
502
503int vdin_screen_source::release_buffer(void* ptr)
504{
505 ALOGV("%s %d", __FUNCTION__, __LINE__);
506 int ret = -1;
507 int currentIndex;
508 v4l2_buffer hbuf_query;
509
510 Mutex::Autolock autoLock(mLock);
511
512 currentIndex = mBufs.valueFor(ptr);
513 if(mVideoInfo->refcount[currentIndex] > 0){
514 mVideoInfo->refcount[currentIndex] -= 1;
515 }else{
516 ALOGE("return buffer when refcount already zero");
517 return 0;
518 }
519 if(mVideoInfo->refcount[currentIndex] == 0){
520 memset(&hbuf_query,0,sizeof(v4l2_buffer));
521 hbuf_query.index = currentIndex;
522 hbuf_query.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
523 hbuf_query.memory = V4L2_MEMORY_MMAP;
524 ALOGV("return buffer :%d",currentIndex);
525 ret = ioctl(mCameraHandle, VIDIOC_QBUF, &hbuf_query);
526 if(ret != 0){
527 ALOGE("Return Buffer :%d failed", currentIndex);
528 }
529 }
530 return 0;
531}
532
533int vdin_screen_source::init_native_window()
534{
535 ALOGV("%s %d", __FUNCTION__, __LINE__);
536 int err = NO_ERROR;
537
538 if(NULL == mANativeWindow.get())
539 return BAD_VALUE;
540
541 // Set gralloc usage bits for window.
542 err = native_window_set_usage(mANativeWindow.get(), SCREENSOURCE_GRALLOC_USAGE);
543 if (err != 0) {
544 ALOGE("native_window_set_usage failed: %s\n", strerror(-err));
545 if(ENODEV == err ){
546 ALOGE("Preview surface abandoned!");
547 mANativeWindow = NULL;
548 }
549 return err;
550 }
551
552 ALOGD("Number of buffers set to ANativeWindow %d", mBufferCount);
553 ///Set the number of buffers needed for camera preview
554 err = native_window_set_buffer_count(mANativeWindow.get(), mBufferCount);
555 if (err != 0) {
556 ALOGE("native_window_set_buffer_count failed: %s (%d)", strerror(-err), -err);
557 if(ENODEV == err){
558 ALOGE("Preview surface abandoned!");
559 mANativeWindow = NULL;
560 }
561 return err;
562 }
563
564 ALOGD("native_window_set_buffers_geometry format:0x%x",mNativeWindowPixelFormat);
565 // Set window geometry
566 err = native_window_set_buffers_geometry(
567 mANativeWindow.get(),
568 mFrameWidth,
569 mFrameHeight,
570 mNativeWindowPixelFormat);
571
572 if (err != 0) {
573 ALOGE("native_window_set_buffers_geometry failed: %s", strerror(-err));
574 if ( ENODEV == err ) {
575 ALOGE("Surface abandoned!");
576 mANativeWindow = NULL;
577 }
578 return err;
579 }
580 err = native_window_set_scaling_mode(mANativeWindow.get(), NATIVE_WINDOW_SCALING_MODE_SCALE_TO_WINDOW);
581 if (err != 0) {
582 ALOGW("Failed to set scaling mode: %d", err);
583 return err;
584 }
585 return NO_ERROR;
586}
587
588int vdin_screen_source::workThread()
589{
590 bool buff_keep = false;
591 int index;
592 aml_screen_buffer_info_t buff_info;
593 int ret;
594 void *src = NULL;
595 unsigned char *dest = NULL;
596 uint8_t *handle = NULL;
597 ANativeWindowBuffer* buf;
598 if(mState == START){
599 usleep(5000);
600 ret = aquire_buffer(&buff_info);
601 if (ret != 0 || (buff_info.buffer_mem == 0)) {
602 ALOGV("Get V4l2 buffer failed");
603 return ret;
604 }
605 src = buff_info.buffer_mem;
606 index = mBufs.valueFor(src);
607 if(mFrameType & NATIVE_WINDOW_DATA){
608 mVideoInfo->refcount[index] += 1;
609 if(mANativeWindow.get() == NULL){
610 ALOGE("Null window");
611 return BAD_VALUE;
612 }
613 ret = mANativeWindow->dequeueBuffer_DEPRECATED(mANativeWindow.get(), &buf);
614 if(ret != 0){
615 ALOGE("dequeue buffer failed :%s (%d)",strerror(-ret), -ret);
616 return BAD_VALUE;
617 }
618 mANativeWindow->lockBuffer_DEPRECATED(mANativeWindow.get(), buf);
619 sp<GraphicBuffer> graphicBuffer(new GraphicBuffer(buf, false));
620 graphicBuffer->lock(SCREENSOURCE_GRALLOC_USAGE, (void **)&dest);
621 if(dest == NULL){
622 ALOGE("Invalid Gralloc Handle");
623 return BAD_VALUE;
624 }
625 memcpy(dest, src, mBufferSize);
626 graphicBuffer->unlock();
627 mANativeWindow->queueBuffer_DEPRECATED(mANativeWindow.get(), buf);
628 graphicBuffer.clear();
629 ALOGV("queue one buffer to native window");
630 release_buffer(src);
631 }
632 if(mFrameType & CALL_BACK_DATA && mDataCB != NULL&& mState == START){
633 mVideoInfo->refcount[index] += 1;
634 mDataCB(mUser, &buff_info);
635 }
636 }
637 return NO_ERROR;
638}
639
640}
641
generated by cgit at 2024-05-17 00:32:11 (GMT)