uvc摄像头调试
改分辨率:
源码中
v412fmt.fmt.pix.width
图像宽度
v412fmt.fmt.pix.height
图像高度
/*
* capturing from UVC
* platform: rk3568
*/
#include <stdint.h>
#include <stdlib.h>
#include <stdio.h>
#include <string.h>
#include <errno.h>
#include <netinet/in.h>
#include <arpa/inet.h>
#include <sys/socket.h>
#include <fcntl.h>
#include <sys/ioctl.h>
#include <sys/mman.h>
#include <asm/types.h>
#include <linux/videodev2.h>
#include <errno.h>
#include <sys/time.h>
#include <sys/types.h>
#include <unistd.h>
#include <jpeglib.h>
#define FILENAME_DEFAULT "/mnt/holdenhuang/image/output"
#define IP_DEFAULT "172.16.31.208"
int imag_w = 0;
int imag_h = 0;
int *video_buff[4];
__u32 format;
void helper(char *sPrgNm)
{
printf("\nUsage : %s [-d <device>] [-f <format>] [-n <number>] [-help] etc.\n", sPrgNm);
printf("-d <device> -- /dev/video9 to switch uvc\n");
printf("-n <framenum> -- buffer frame, default as [30]\n");
printf("-f <format> -- support list as [0-1], 0: mjpeg, 1: yuyv\n \
-- <v4l2-ctl --list-formats -d /dev/video> can view the supported formats\r\n");
printf(" -i <ipaddr> -- set udp receive ip\n");
}
static void _save_stream_to_file(unsigned char *buffer, int size, char *outname)
{
FILE *fp = NULL;
fp = fopen(outname, "wb");
if (!fp) {
printf("save file error..\n");
return;
}
fwrite(buffer, size, 1, fp);
fflush(fp);
if (fp) fclose(fp);
}
/*摄像头初始化*/
int Camera_Init(char *dev)
{
int i=0;
/*1.打开摄像头设备*/
int fd=open(dev, 2);
if(fd<0)
return -1;//摄像头打开失败
/*2.设置摄像头捕获格式*/
struct v4l2_format v4l2fmt;
memset(&v4l2fmt, 0, sizeof(v4l2fmt));//初始化结构体
v4l2fmt.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;//视频捕获格式
v4l2fmt.fmt.pix.width = 1920;//图像宽度
v4l2fmt.fmt.pix.height = 1080;//图像高度
v4l2fmt.fmt.pix.pixelformat = format;//V4L2_PIX_FMT_MJPEG;//YUYV颜色编码格式
if(ioctl(fd,VIDIOC_S_FMT, &v4l2fmt))
return -2;//设置格式失败
printf("采集图像大小:%d*%d\n",v4l2fmt.fmt.pix.width, v4l2fmt.fmt.pix.height);
imag_w = v4l2fmt.fmt.pix.width;
imag_h = v4l2fmt.fmt.pix.height;
/*3.申请缓冲区*/
struct v4l2_requestbuffers v4l2reqbuf;
memset(&v4l2reqbuf, 0, sizeof(v4l2reqbuf));//初始化结构体
v4l2reqbuf.count = 4;//申请的缓冲区个数
v4l2reqbuf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;//视频捕获格式
v4l2reqbuf.memory = V4L2_MEMORY_MMAP;//内存映射
if(ioctl(fd, VIDIOC_REQBUFS, &v4l2reqbuf))
return -3;//申请缓冲区失败
printf("申请的缓冲区个数:%d\n", v4l2reqbuf.count);
/*4.将缓冲区映射到进程空间*/
struct v4l2_buffer v4l2buf;
memset(&v4l2buf, 0, sizeof(v4l2buf));//初始化结构体
v4l2buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;//视频捕获格式
v4l2buf.memory = V4L2_MEMORY_MMAP;//内存映射
for(i = 0; i < v4l2reqbuf.count; i++)
{
v4l2buf.index = i;/*缓冲区下标*/
if(ioctl(fd, VIDIOC_QUERYBUF, &v4l2buf))
return -4;//申请缓冲区失败
video_buff[i] = mmap(NULL, v4l2buf.length, PROT_READ|PROT_WRITE, MAP_SHARED, fd, v4l2buf.m.offset);
printf("video_buff[%d]=%p, len = %d\n", i, video_buff[i], v4l2buf.length);
}
/*5.将映射的空间添加到采集队列*/
memset(&v4l2buf, 0, sizeof(v4l2buf));//初始化结构体
v4l2buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;//视频捕获格式
v4l2buf.memory = V4L2_MEMORY_MMAP;//内存映射
for(i = 0; i < v4l2reqbuf.count; i++)
{
v4l2buf.index = i;/*缓冲区下标*/
if(ioctl(fd, VIDIOC_QBUF, &v4l2buf))
return -5;//添加到采集队列失败
}
/*6.开启摄像头*/
int type = V4L2_BUF_TYPE_VIDEO_CAPTURE;//视频捕获格式
if(ioctl(fd, VIDIOC_STREAMON, &type))
return -6;//启动摄像头失败
return fd;//成功返回摄像头文件描述符
}
/*YUYV转RGB888*/
void yuv_to_rgb(unsigned char *yuv_buffer, unsigned char *rgb_buffer, int iWidth, int iHeight)
{
int x;
int z = 0;
unsigned char *ptr = rgb_buffer;
unsigned char *yuyv = yuv_buffer;
for (x = 0; x < iWidth * iHeight; x++)
{
int r, g, b;
int y, u, v;
if (!z)
y = yuyv[0] << 8;
else
y = yuyv[2] << 8;
u = yuyv[1] - 128;
v = yuyv[3] - 128;
r = (y + (359 * v)) >> 8;
g = (y - (88 * u) - (183 * v)) >> 8;
b = (y + (454 * u)) >> 8;
*(ptr++) = (b > 255) ? 255 : ((b < 0) ? 0 : b);
*(ptr++) = (g > 255) ? 255 : ((g < 0) ? 0 : g);
*(ptr++) = (r > 255) ? 255 : ((r < 0) ? 0 : r);
if(z++)
{
z = 0;
yuyv += 4;
}
}
}
int main(int argc, char **argv)
{
int ret = -1;
int count = 30;
char filename[64];
int fd = -1;
struct timeval tv_begin, tv_end;
int capture = 0;
char *dev_path;
int para = 0;
int input_format = 0;
int i = 0;
char name[4];
char *ip_addr = IP_DEFAULT;
if(argc < 5){
helper(argv[0]);
return -1;
}
for(int j =0; j < argc; j++){
if(strstr(argv[j], "help")){
helper(argv[0]);
return -1;
}
}
while ((para = getopt(argc, argv, "d:n:f:i:help::")) != -1) {
switch(para) {
case 'd':
dev_path = optarg;
break;
case 'f':
input_format = atoi(optarg);
if(input_format == 0){
format = V4L2_PIX_FMT_MJPEG;
snprintf(name, sizeof(name), "%s", "jpg");
}
if(input_format == 1){
format = V4L2_PIX_FMT_YUYV;
snprintf(name, sizeof(name), "%s", "yuv");
}
break;
case 'n':
count = atoi(optarg);
printf("getframe num: %d\r\n", count);
break;
case 'i':
ip_addr = optarg;
break;
default:
break;
}
}
//printf("V4L2_PIX_FMT_MJPEG = %d\r\n", format);
fd=Camera_Init(dev_path);
if(fd<0){
printf("初始化摄像头失败,res=%d\n",fd);
return 0;
}
printf("初始化摄像头成功\n");
struct v4l2_buffer v4l2buf;
memset(&v4l2buf, 0, sizeof(v4l2buf));//初始化结构体
v4l2buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;//视频捕获格式
v4l2buf.memory = V4L2_MEMORY_MMAP;//内存映射
/*
int sockfd;
struct sockaddr_in dest_addr;
dest_addr.sin_family = AF_INET; //使用IPV4
dest_addr.sin_port = htons(8099);//服务器端口号
dest_addr.sin_addr.s_addr = inet_addr(ip_addr);//适用于局域网通信
sockfd = socket(AF_INET,SOCK_DGRAM,0);//创建TCP,指定ip类型为IPV4
if(sockfd < 0){
printf("socket create fail!\r\n");
return -1;
}
int optval = 1920 * 1080;
int optlen = sizeof(optval);
int sendbuff = 0;
setsockopt(sockfd, SOL_SOCKET, SO_SNDBUF, (char*)&optval,optlen);
getsockopt(sockfd, SOL_SOCKET, SO_SNDBUF, &sendbuff, &optlen);
printf("send buffer size = %d\n", sendbuff);
printf("sockfd = %d ip = %s \r\n", sockfd, ip_addr);
*/
char *sensor_srcbuf;
sensor_srcbuf = malloc(1920 * 1080 * 2);
while(i < count){
gettimeofday(&tv_begin, NULL);
/*从采集队列中取出图像数据*/
if(ioctl(fd, VIDIOC_DQBUF, &v4l2buf)) break;//取数据失败
//printf("v4l2buff[%d]=%p\n, len = %d\r\n",v4l2buf.index, video_buff[v4l2buf.index], v4l2buf.length);
/*将头数据和位图数据写入到文件中*/
gettimeofday(&tv_end, NULL);
printf("> capture frame timecost %lums\n", (((tv_end.tv_sec*1000 + tv_end.tv_usec/1000)) - (tv_begin.tv_sec*1000 + tv_begin.tv_usec/1000)));
snprintf(filename,sizeof(filename),"%s-%d.%s", FILENAME_DEFAULT, i, name);//图片名字
memcpy(sensor_srcbuf, video_buff[v4l2buf.index], v4l2buf.length);
//printf("filename = %s, ret = %d\n", filename, ret);
_save_stream_to_file((unsigned char *)sensor_srcbuf, v4l2buf.length, filename);
if(ioctl(fd, VIDIOC_QBUF, &v4l2buf)) break;//添加到采集队列失败
i++;
}
//if(sockfd) close(sockfd);
if(fd) close(fd);//关闭摄像头
}
运行指令
v4l2-ctl --list-formats-ext -d /dev/video9
标签:uvc,format,int,printf,char,tv,linux,include,摄像头
From: https://www.cnblogs.com/dysonnnn/p/17220559.html