v4l2部分函数接口使用

void setSensorFmt(int w, int h)

{

    int subdev_fd,ispdev_fd;                

    struct v4l2_subdev_selection sel;

    struct v4l2_subdev_format subfmt;

    subfmt.pad = 0;

    subfmt.which = V4L2_SUBDEV_FORMAT_ACTIVE;

    subfmt.format.width = w;  

    subfmt.format.height = h;  

    subdev_fd = open("/dev/v4l-subdev2", O_RDWR , 0); // set sensor

    if(-1 == subdev_fd)

    {

        err = QString("open v4l-subdev2 fail \n");

    }

    ispdev_fd = open("/dev/v4l-subdev0", O_RDWR , 0);

    if(-1 == ispdev_fd)

    {

        err = QString("open v4l-subdev0 fail \n");

    }

    //set sensor fmt

    if (-1 == ioctl(subdev_fd,VIDIOC_SUBDEV_S_FMT, &subfmt))

            errno_exit("VIDIOC_SUBDEV_S_FMT");

    if (-1 == ioctl(subdev_fd,VIDIOC_SUBDEV_G_FMT, &subfmt))

            errno_exit("VIDIOC_SUBDEV_G_FMT");

    printf(">>>>>>>>>>>>>>>>>>>>sylon debug:subfmt.format.width:%d,subfmt.format.height:%d,function %s FILE:%s \n",subfmt.format.width,subfmt.format.height,__FUNCTION__,__FILE__);

   

    sel.r.left = 0;

    sel.r.top = 0;

    sel.r.width = subfmt.format.width;

    sel.r.height = subfmt.format.height;

    sel.target = V4L2_SEL_TGT_CROP;

    sel.which = V4L2_SUBDEV_FORMAT_ACTIVE;

    subfmt.which = V4L2_SUBDEV_FORMAT_ACTIVE;

    /* change fmt&size for RKISP1_ISP_PAD_SINK */

    subfmt.pad = 0;//RKISP1_ISP_PAD_SINK;

    sel.pad = 0;//RKISP1_ISP_PAD_SINK;

    if (-1 == ioctl(ispdev_fd,VIDIOC_SUBDEV_S_FMT, &subfmt))

            errno_exit("VIDIOC_SUBDEV_S_FMT");

    if (-1 == ioctl(ispdev_fd,VIDIOC_SUBDEV_S_SELECTION, &sel))

        errno_exit("VIDIOC_SUBDEV_S_SELECTION");

    // if (-1 == ioctl(ispdev_fd,VIDIOC_SUBDEV_S_CROP, &sel))

    //     errno_exit("VIDIOC_SUBDEV_S_SELECTION");

    printf("2222sylon debug:sel.r.width:%d,sel.r.width:%d,function %s FILE:%s \n",sel.r.width,sel.r.height,__FUNCTION__,__FILE__);

    subfmt.pad = 2;//RKISP1_ISP_PAD_SOURCE_PATH;

    sel.pad = 2;//RKISP1_ISP_PAD_SOURCE_PATH;

    if (-1 == ioctl(ispdev_fd,VIDIOC_SUBDEV_S_FMT, &subfmt))

            errno_exit("VIDIOC_SUBDEV_S_FMT");

    if (-1 == ioctl(ispdev_fd,VIDIOC_SUBDEV_S_SELECTION, &sel))

        errno_exit("VIDIOC_SUBDEV_S_SELECTION");

    // if (-1 == ioctl(ispdev_fd,VIDIOC_SUBDEV_S_CROP, &sel))

    //     errno_exit("VIDIOC_SUBDEV_S_SELECTION");

    printf("3333sylon debug:subfmt.format.width:%d,subfmt.format.height:%d,function %s FILE:%s \n",sel.r.width,sel.r.height,__FUNCTION__,__FILE__);

    close(subdev_fd);        

    close(ispdev_fd);        

}