libexplain
1.4.D001
|
00001 /* 00002 * libexplain - a library of system-call-specific strerror replacements 00003 * Copyright (C) 2011, 2013 Peter Miller 00004 * 00005 * This program is free software; you can redistribute it and/or modify 00006 * it under the terms of the GNU Lesser General Public License as 00007 * published by the Free Software Foundation; either version 3 of the 00008 * License, or (at your option) any later version. 00009 * 00010 * This program is distributed in the hope that it will be useful, 00011 * but WITHOUT ANY WARRANTY; without even the implied warranty of 00012 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU 00013 * Lesser General Public License for more details. 00014 * 00015 * You should have received a copy of the GNU Lesser General Public License 00016 * along with this program. If not, see <http://www.gnu.org/licenses/>. 00017 */ 00018 00019 #include <libexplain/ac/errno.h> 00020 #include <libexplain/ac/linux/videodev2.h> 00021 #include <libexplain/ac/string.h> 00022 #include <libexplain/ac/sys/ioctl.h> 00023 00024 #include <libexplain/buffer/int32_t.h> 00025 #include <libexplain/buffer/pointer.h> 00026 #include <libexplain/buffer/v4l2_frmsize_discrete.h> 00027 #include <libexplain/buffer/v4l2_frmsizeenum.h> 00028 #include <libexplain/buffer/v4l2_frmsizeenum_type.h> 00029 #include <libexplain/buffer/v4l2_frmsize_stepwise.h> 00030 #include <libexplain/buffer/v4l2_pixel_format.h> 00031 #include <libexplain/is_efault.h> 00032 #include <libexplain/sizeof.h> 00033 00034 00035 #ifdef HAVE_LINUX_VIDEODEV2_H 00036 00037 void 00038 explain_buffer_v4l2_frmsizeenum(explain_string_buffer_t *sb, 00039 const struct v4l2_frmsizeenum *data, int extra) 00040 { 00041 if (explain_is_efault_pointer(data, sizeof(*data))) 00042 { 00043 explain_buffer_pointer(sb, data); 00044 return; 00045 } 00046 00047 explain_string_buffer_puts(sb, "{ index = "); 00048 explain_buffer_uint32_t(sb, data->index); 00049 explain_string_buffer_puts(sb, ", pixel_format = "); 00050 explain_buffer_v4l2_pixel_format(sb, data->pixel_format); 00051 if (extra) 00052 { 00053 explain_string_buffer_puts(sb, ", type = "); 00054 explain_buffer_v4l2_frmsizeenum_type(sb, data->type); 00055 switch (data->type) 00056 { 00057 case V4L2_FRMSIZE_TYPE_DISCRETE: 00058 explain_string_buffer_puts(sb, ", discrete = "); 00059 explain_buffer_v4l2_frmsize_discrete(sb, &data->discrete); 00060 break; 00061 00062 case V4L2_FRMSIZE_TYPE_STEPWISE: 00063 explain_string_buffer_puts(sb, ", stepwise = "); 00064 explain_buffer_v4l2_frmsize_stepwise(sb, &data->stepwise); 00065 break; 00066 00067 case V4L2_FRMSIZE_TYPE_CONTINUOUS: 00068 default: 00069 break; 00070 }; 00071 if (!explain_uint32_array_all_zero(data->reserved, 00072 SIZEOF(data->reserved))) 00073 { 00074 explain_string_buffer_puts(sb, ", reserved = "); 00075 explain_buffer_uint32_array(sb, data->reserved, 00076 SIZEOF(data->reserved)); 00077 } 00078 } 00079 explain_string_buffer_puts(sb, " }"); 00080 } 00081 00082 00083 int 00084 explain_v4l2_frmsizeenum_get_n(int fildes, int pixfmt) 00085 { 00086 int lo = 0; 00087 int hi = 200; 00088 for (;;) 00089 { 00090 int mid = (lo + hi) / 2; 00091 struct v4l2_frmsizeenum qry; 00092 memset(&qry, 0, sizeof(qry)); 00093 qry.index = mid; 00094 qry.pixel_format = pixfmt; 00095 if (ioctl(fildes, VIDIOC_ENUM_FRAMESIZES, &qry) >= 0) 00096 { 00097 if (hi <= 0 && lo <= 0) 00098 return -1; 00099 /* mid < ninputs */ 00100 lo = mid + 1; 00101 if (lo > hi) 00102 return lo; 00103 } 00104 else if (errno != EINVAL) 00105 { 00106 return -1; 00107 } 00108 else 00109 { 00110 if (hi <= 0 && lo <= 0) 00111 return -1; 00112 /* mid >= ninputs */ 00113 hi = mid - 1; 00114 if (lo >= hi) 00115 return lo; 00116 } 00117 } 00118 } 00119 00120 #endif 00121 00122 /* vim: set ts=8 sw=4 et : */