android4.0 USB Camera实例(三)UVC

前面我写了两篇文章说明了zc301的实现 具体请看

下面顺便把通用的USB也写上 前面的ZC301获取到的格式是JPEG的所以不用进行什么处理就可以用来显示,,但是标准的UVC获取到的是YUV422格式的需要转换成RGB后才能进行显示 这里我们在前面两篇的代码稍作修改就可以了

HAL层 代码如下

/* * Android USB Camera zc3xx Library * * Copyright (c) 2014 Store information technology guangzhou ltd<> * Copyright (c) 2014 hclydao <hclydao@gmail.com> * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation; either version 2 of the License. */#include <errno.h>#include <sys/types.h>#include <sys/stat.h>#include <fcntl.h>#include <sys/ioctl.h>#include <unistd.h>#include <stdint.h>#include <stdio.h>#include <stdlib.h>#include <asm/types.h>#include <linux/videodev2.h>#include <sys/mman.h>#include <string.h>#include <malloc.h>#include <linux/fb.h>#include <jni.h>#include <string.h>#include <android/log.h>#include <syslog.h>#include <android/log.h>#include <android/bitmap.h>#define LOG_TAG "FimcGzsd"#define LOGV(…) __android_log_print(ANDROID_LOG_VERBOSE, LOG_TAG, __VA_ARGS__)#define LOGD(…) __android_log_print(ANDROID_LOG_DEBUG , LOG_TAG, __VA_ARGS__)#define LOGI(…) __android_log_print(ANDROID_LOG_INFO , LOG_TAG, __VA_ARGS__)#define LOGW(…) __android_log_print(ANDROID_LOG_WARN , LOG_TAG, __VA_ARGS__)#define LOGE(…) __android_log_print(ANDROID_LOG_ERROR , LOG_TAG, __VA_ARGS__)struct fimc_buffer {unsigned char *start;size_t length;};static int fd = -1;struct fimc_buffer *buffers=NULL;struct v4l2_buffer v4l2_buf;static int bufnum = 1;static int mwidth,mheight;static int c_type = 0;int *rgb = NULL;int *ybuf = NULL;int yuv_tbl_ready=0;int y1192_tbl[256];int v1634_tbl[256];int v833_tbl[256];int u400_tbl[256];int u2066_tbl[256];/* *open usb camera device */JNIEXPORT jint JNICALL Java_com_dao_usbcam_Fimcgzsd_open(JNIEnv * env, jclass obj, const jbyteArray devname){jbyte *dev = (jbyte*)(*env)->GetByteArrayElements(env, devname, 0);fd = open(dev, O_RDWR, 0); if (fd<0){LOGE("%s ++++ open error\n",dev);return -1;}(*env)->ReleaseByteArrayElements(env, devname, dev, 0);return fd;}/* * init device */JNIEXPORT jint JNICALL Java_com_dao_usbcam_Fimcgzsd_init(JNIEnv * env, jclass obj, jint width, jint height,jint numbuf,jint ctype){int ret;int i;bufnum = numbuf;mwidth = width;mheight = height;c_type = ctype;struct v4l2_format fmt;struct v4l2_capability cap;ret = ioctl(fd, VIDIOC_QUERYCAP, &cap);if (ret < 0) {LOGE("%d :VIDIOC_QUERYCAP failed\n",__LINE__);return -1;}if (!(cap.capabilities & V4L2_CAP_VIDEO_CAPTURE)) {LOGE("%d : no capture devices\n",__LINE__);return -1;}memset( &fmt, 0, sizeof(fmt));fmt.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;if(c_type == 1)fmt.fmt.pix.pixelformat = V4L2_PIX_FMT_YUYV;elsefmt.fmt.pix.pixelformat = V4L2_PIX_FMT_RGB565;fmt.fmt.pix.width = width;fmt.fmt.pix.height = height;if (ioctl(fd, VIDIOC_S_FMT, &fmt) < 0){LOGE("++++%d : set format failed\n",__LINE__);return -1;}struct v4l2_requestbuffers req;req.count = numbuf;req.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;req.memory = V4L2_MEMORY_MMAP;ret = ioctl(fd, VIDIOC_REQBUFS, &req);if (ret < 0) {LOGE("++++%d : VIDIOC_REQBUFS failed\n",__LINE__);return -1;}buffers = calloc(req.count, sizeof(*buffers));if (!buffers) {LOGE ("++++%d Out of memory\n",__LINE__);return -1;}for(i = 0; i< bufnum; ++i) {memset(&v4l2_buf, 0, sizeof(v4l2_buf));v4l2_buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;v4l2_buf.memory = V4L2_MEMORY_MMAP;v4l2_buf.index = i;ret = ioctl(fd , VIDIOC_QUERYBUF, &v4l2_buf);if(ret < 0) {LOGE("+++%d : VIDIOC_QUERYBUF failed\n",__LINE__);return -1;}buffers[i].length = v4l2_buf.length;if ((buffers[i].start = (char *)mmap(0, v4l2_buf.length,PROT_READ | PROT_WRITE, MAP_SHARED,fd, v4l2_buf.m.offset)) < 0) {LOGE("%d : mmap() failed",__LINE__);return -1;}}rgb = (int *)malloc(sizeof(int) * (mwidth*mheight));ybuf = (int *)malloc(sizeof(int) * (mwidth*mheight));return 0;}/* *open usb camera device */JNIEXPORT jint JNICALL Java_com_dao_usbcam_Fimcgzsd_streamon(JNIEnv * env, jclass obj){int i;int ret;enum v4l2_buf_type type = V4L2_BUF_TYPE_VIDEO_CAPTURE;for(i = 0; i< bufnum; ++i) {memset(&v4l2_buf, 0, sizeof(v4l2_buf));v4l2_buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;v4l2_buf.memory = V4L2_MEMORY_MMAP;v4l2_buf.index = i;ret = ioctl(fd, VIDIOC_QBUF, &v4l2_buf);if (ret < 0) {LOGE("%d : VIDIOC_QBUF failed\n",__LINE__);return ret;}}ret = ioctl(fd, VIDIOC_STREAMON, &type);if (ret < 0) {LOGE("%d : VIDIOC_STREAMON failed\n",__LINE__);return ret;}return 0;}void yuyv422toABGRY(unsigned char *src){int width=0;int height=0;width = mwidth;height = mheight;int frameSize =width*height*2;int i;if((!rgb || !ybuf)){return;}int *lrgb = NULL;int *lybuf = NULL;lrgb = &rgb[0];lybuf = &ybuf[0];if(yuv_tbl_ready==0){for(i=0 ; i<256 ; i++){y1192_tbl[i] = 1192*(i-16);if(y1192_tbl[i]<0){y1192_tbl[i]=0;}v1634_tbl[i] = 1634*(i-128);v833_tbl[i] = 833*(i-128);u400_tbl[i] = 400*(i-128);u2066_tbl[i] = 2066*(i-128);}yuv_tbl_ready=1;}for(i=0 ; i<frameSize ; i+=4){unsigned char y1, y2, u, v;y1 = src[i];u = src[i+1];y2 = src[i+2];v = src[i+3];int y1192_1=y1192_tbl[y1];int r1 = (y1192_1 + v1634_tbl[v])>>10;int g1 = (y1192_1 – v833_tbl[v] – u400_tbl[u])>>10;int b1 = (y1192_1 + u2066_tbl[u])>>10;int y1192_2=y1192_tbl[y2];int r2 = (y1192_2 + v1634_tbl[v])>>10;int g2 = (y1192_2 – v833_tbl[v] – u400_tbl[u])>>10;int b2 = (y1192_2 + u2066_tbl[u])>>10;r1 = r1>255 ? 255 : r1<0 ? 0 : r1;g1 = g1>255 ? 255 : g1<0 ? 0 : g1;b1 = b1>255 ? 255 : b1<0 ? 0 : b1;r2 = r2>255 ? 255 : r2<0 ? 0 : r2;g2 = g2>255 ? 255 : g2<0 ? 0 : g2;b2 = b2>255 ? 255 : b2<0 ? 0 : b2;*lrgb++ = 0xff000000 | b1<<16 | g1<<8 | r1;*lrgb++ = 0xff000000 | b2<<16 | g2<<8 | r2;if(lybuf!=NULL){*lybuf++ = y1;*lybuf++ = y2;}}}void Java_com_dao_usbcam_Fimcgzsd_pixeltobmp( JNIEnv* env,jobject thiz,jobject bitmap){jboolean bo;AndroidBitmapInfo info;void*pixels;intret;int i;int *colors;int width=0;int height=0;if ((ret = AndroidBitmap_getInfo(env, bitmap, &info)) < 0) {LOGE("AndroidBitmap_getInfo() failed ! error=%d", ret);return;}width = info.width;height = info.height;if(!rgb || !ybuf) return;if (info.format != ANDROID_BITMAP_FORMAT_RGBA_8888) {LOGE("Bitmap format is not RGBA_8888 !");return;}if ((ret = AndroidBitmap_lockPixels(env, bitmap, &pixels)) < 0) {LOGE("AndroidBitmap_lockPixels() failed ! error=%d", ret);}colors = (int*)pixels;int *lrgb =NULL;lrgb = &rgb[0];for(i=0 ; i<width*height ; i++){*colors++ = *lrgb++;}AndroidBitmap_unlockPixels(env, bitmap);}void yuyv422torgb(unsigned char *src,unsigned int *mrgb){int width=0;int height=0;width = mwidth;height = mheight;int frameSize =width*height*2;int i;if((!rgb || !ybuf)){return;}int *lrgb = NULL;int *lybuf = NULL;lrgb = mrgb;lybuf = &ybuf[0];if(yuv_tbl_ready==0){for(i=0 ; i<256 ; i++){y1192_tbl[i] = 1192*(i-16);if(y1192_tbl[i]<0){y1192_tbl[i]=0;}v1634_tbl[i] = 1634*(i-128);v833_tbl[i] = 833*(i-128);u400_tbl[i] = 400*(i-128);u2066_tbl[i] = 2066*(i-128);}yuv_tbl_ready=1;}for(i=0 ; i<frameSize ; i+=4){unsigned char y1, y2, u, v;y1 = src[i];u = src[i+1];y2 = src[i+2];v = src[i+3];int y1192_1=y1192_tbl[y1];int r1 = (y1192_1 + v1634_tbl[v])>>10;int g1 = (y1192_1 – v833_tbl[v] – u400_tbl[u])>>10;int b1 = (y1192_1 + u2066_tbl[u])>>10;int y1192_2=y1192_tbl[y2];int r2 = (y1192_2 + v1634_tbl[v])>>10;int g2 = (y1192_2 – v833_tbl[v] – u400_tbl[u])>>10;int b2 = (y1192_2 + u2066_tbl[u])>>10;r1 = r1>255 ? 255 : r1<0 ? 0 : r1;g1 = g1>255 ? 255 : g1<0 ? 0 : g1;b1 = b1>255 ? 255 : b1<0 ? 0 : b1;r2 = r2>255 ? 255 : r2<0 ? 0 : r2;g2 = g2>255 ? 255 : g2<0 ? 0 : g2;b2 = b2>255 ? 255 : b2<0 ? 0 : b2;*lrgb++ = 0xff000000 | b1<<16 | g1<<8 | r1;*lrgb++ = 0xff000000 | b2<<16 | g2<<8 | r2;if(lybuf!=NULL){*lybuf++ = y1;*lybuf++ = y2;}}}JNIEXPORT jint JNICALL Java_com_dao_usbcam_Fimcgzsd_yuvtorgb(JNIEnv * env, jclass obj,const jbyteArray yuvdata, jintArray rgbdata){jbyte *ydata = (jbyte*)(*env)->GetByteArrayElements(env, yuvdata, 0);jint *rdata = (jint*)(*env)->GetIntArrayElements(env, rgbdata, 0);yuyv422torgb(ydata,rdata);(*env)->ReleaseByteArrayElements(env, yuvdata, ydata, 0);(*env)->ReleaseIntArrayElements(env, rgbdata, rdata, 0);return 0;}/* *get one frame data */JNIEXPORT jint JNICALL Java_com_dao_usbcam_Fimcgzsd_dqbuf(JNIEnv * env, jclass obj,const jbyteArray videodata){int ret;jbyte *data = (jbyte*)(*env)->GetByteArrayElements(env, videodata, 0);v4l2_buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;v4l2_buf.memory = V4L2_MEMORY_MMAP;ret = ioctl(fd, VIDIOC_DQBUF, &v4l2_buf);if (ret < 0) {LOGE("%s : VIDIOC_DQBUF failed, dropped frame\n",__func__);return ret;}if(c_type == 1)yuyv422toABGRY((unsigned char *)buffers[v4l2_buf.index].start);memcpy(data,buffers[v4l2_buf.index].start,buffers[v4l2_buf.index].length);(*env)->ReleaseByteArrayElements(env, videodata, data, 0);return v4l2_buf.index;}/* *put in frame buffer to queue */JNIEXPORT jint JNICALL Java_com_dao_usbcam_Fimcgzsd_qbuf(JNIEnv * env, jclass obj,jint index){int ret;v4l2_buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;v4l2_buf.memory = V4L2_MEMORY_MMAP;v4l2_buf.index = index;ret = ioctl(fd, VIDIOC_QBUF, &v4l2_buf);if (ret < 0) {LOGE("%s : VIDIOC_QBUF failed\n",__func__);return ret;}return 0;}/* *streamoff */JNIEXPORT jint JNICALL Java_com_dao_usbcam_Fimcgzsd_streamoff(JNIEnv * env, jclass obj,jint index){enum v4l2_buf_type type = V4L2_BUF_TYPE_VIDEO_CAPTURE;int ret;ret = ioctl(fd, VIDIOC_STREAMOFF, &type);if (ret < 0) {LOGE("%s : VIDIOC_STREAMOFF failed\n",__func__);return ret;}return 0;}/* *release */JNIEXPORT jint JNICALL Java_com_dao_usbcam_Fimcgzsd_release(JNIEnv * env, jclass obj){enum v4l2_buf_type type = V4L2_BUF_TYPE_VIDEO_CAPTURE;int ret;int i;ret = ioctl(fd, VIDIOC_STREAMOFF, &type);if (ret < 0) {LOGE("%s : VIDIOC_STREAMOFF failed\n",__func__);return ret;}for (i = 0; i < bufnum; i++) {ret = munmap(buffers[i].start, buffers[i].length);if (ret < 0) {LOGE("%s : munmap failed\n",__func__);return ret;}}free (buffers);if(rgb) free(rgb);if(ybuf) free(ybuf);close(fd);return 0;}主要增加了两个函数

yuyv422toABGRY 这个是yuv转rgb

Java_com_dao_usbcam_Fimcgzsd_pixeltobmp 这个是rgb转bitmap

这两个函数是我在网上找到例子simplewebcam里拷出来的

同时Android.mk修改如下

有多少和我一样,坐在不足平米的空间里,

android4.0 USB Camera实例(三)UVC

相关文章:

你感兴趣的文章:

标签云: