void common_list(int fd)
{
if (options[OptListCtrlsMenus]) {
list_controls(fd, 1);
}
if (options[OptListCtrls]) {
list_controls(fd, 0);
}
}
int
main (int argc, char **argv)
{
CHandle handle = 0;
CResult res = C_SUCCESS;
// Parse the command line
if(cmdline_parser(argc, argv, &args_info) != 0)
exit(1);
// Display help if no arguments were specified
if(argc == 1) {
cmdline_parser_print_help();
exit(0);
}
res = c_init();
if(res) goto done;
// Open the device
if (!args_info.list_given && (!args_info.import_given || args_info.device_given)) {
handle = c_open_device(args_info.device_arg);
if(!handle) {
print_error("Unable to open device", -1);
res = C_INVALID_DEVICE;
goto done;
}
}
// List devices
if(args_info.list_given) {
res = list_devices();
goto done;
}
// Import dynamic controls from XML file
else if(args_info.import_given) {
res = add_control_mappings(handle, args_info.import_arg);
goto done;
}
// Import dynamic controls from XML files at default location
if(args_info.addctrl_given) {
// list all xml files at default data/vid dir
int nf=0;
char vid[5];
char pid[5];
short pid_set = 0;
if(fnmatch("[[:xdigit:]][[:xdigit:]][[:xdigit:]][[:xdigit:]]:[[:xdigit:]][[:xdigit:]][[:xdigit:]][[:xdigit:]]", args_info.addctrl_arg, 0))
{
if(fnmatch("[[:xdigit:]][[:xdigit:]][[:xdigit:]][[:xdigit:]]", args_info.addctrl_arg, 0))
{
printf("%s invalid: set at least a valid vid value, :pid is optional\n", args_info.addctrl_arg);
goto done;
}
else
{
/*extract vid and reset pid*/
int c = 0;
for (c = 0; c < 4; c++)
{
vid[c] = args_info.addctrl_arg[c];
pid[c] = 0;
}
vid[4] = '\0';
pid[4] = '\0';
}
}
else
{
/*extract vid and pid*/
int c = 0;
for (c = 0; c < 4; c++)
{
vid[c] = args_info.addctrl_arg[c];
pid[c] = args_info.addctrl_arg[c+5];
}
vid[4] = '\0';
pid[4] = '\0';
pid_set = 1; /*flag pid.xml check*/
//printf("vid:%s pid:%s\n", vid, pid);
}
/* get xml file list from DATA_DIR/vid/ */
char **xml_files = get_filename (DATA_DIR, vid);
/*check for pid.xml*/
char fname[9];
strcpy(fname, pid);
strcat(fname,".xml");
if(pid_set)
{
pid_set = 0; /*reset*/
nf=0;
while (xml_files[nf] != NULL)
{
if ( strcasecmp(fname, xml_files[nf]) == 0)
pid_set = 1; /*file exists so flag it*/
nf++;
}
}
/*parse xml files*/
nf = 0;
while (xml_files[nf] != NULL)
{
/* if pid was set and pid.xml exists parse it*/
if(pid_set)
{
if ((strcasecmp(fname, xml_files[nf]) == 0))
{
printf ( "Parsing: %s \n", xml_files[nf]);
res = add_control_mappings(handle, xml_files[nf]);
}
}
else /* parse all xml files inside vid dir */
{
printf ( "Parsing: %s \n", xml_files[nf]);
res = add_control_mappings(handle, xml_files[nf]);
}
free(xml_files[nf]);
xml_files[nf]=NULL;
nf++;
}
free(xml_files);
goto done;
}
// List frame formats
if(args_info.formats_given) {
printf("Listing available frame formats for device %s:\n", args_info.device_arg);
res = list_frame_formats(handle);
}
// List controls
else if(args_info.clist_given) {
printf("Listing available controls for device %s:\n", args_info.device_arg);
res = list_controls(handle);
}
// Retrieve control value
else if(args_info.get_given) {
CControlValue value;
// Resolve the control Id
CControlId controlId = get_control_id(handle, args_info.get_arg);
if(!controlId) {
res = 1;
print_handle_error(handle, "Unknown control specified", -1);
goto done;
}
// Retrieve the control value
res = c_get_control(handle, controlId, &value);
if(res) {
print_handle_error(handle, "Unable to retrieve control value", res);
goto done;
}
printf("%d\n", value.value);
}
// Retrieve raw control value
else if(args_info.get_raw_given) {
//scan input
uint16_t unit_id;
unsigned char selector;
sscanf(args_info.get_raw_arg, "%hu:%hhu", &unit_id, &selector);
CControlValue value;
value.type = CC_TYPE_RAW;
// the entity is only used for the generating a control name
//TODO: pass the guid through cmdline (optional)
unsigned char entity[] = {0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00};
res = c_read_xu_control(handle, entity, unit_id, selector, &value);
if(res) {
print_handle_error(handle, "Unable to retrieve control value", res);
goto done;
}
//print the raw value
uint8_t * val = value.raw.data;
int i=0;
printf("query current value of: (LE)0x");
for(i=0; i<value.raw.size; i++) {
printf("%.2x", val[i]);
}
printf(" (BE)0x");
for(i=value.raw.size-1; i >=0; i--) {
printf("%.2x", val[i]);
}
printf("\n");
//free the raw value alocation
if(value.raw.data) free(value.raw.data);
}
else if(args_info.set_given) {
CControlValue value;
// Parse the control value
if(args_info.inputs_num < 1) {
res = 3;
print_error("No control value specified", -1);
goto done;
}
if(parse_control_value(args_info.inputs[0], &value)) {
res = 2;
print_error("Invalid control value specified", -1);
goto done;
}
// Resolve the control Id
CControlId controlId = get_control_id(handle, args_info.set_arg);
if(!controlId) {
res = 1;
print_handle_error(handle, "Unknown control specified", -1);
goto done;
}
// Set the new control value
res = c_set_control(handle, controlId, &value);
if(res) {
print_handle_error(handle, "Unable to set new control value", res);
goto done;
}
}
// Set the raw control value
else if(args_info.set_raw_given) {
CControlValue value;
// Parse the control value
if(args_info.inputs_num < 1) {
res = 3;
print_error("No raw control value specified", -1);
goto done;
}
uint16_t unit_id;
unsigned char selector;
sscanf(args_info.set_raw_arg, "%hu:%hhu", &unit_id, &selector);
parse_raw_control_value (args_info.inputs[0], &value);
// the entity is only used for the generating a control name
//TODO: pass the guid through cmdline (optional)
unsigned char entity[] = {0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00};
res = c_write_xu_control(handle, entity, unit_id, selector, &value);
if(res) {
print_handle_error(handle, "Unable to set the control value", res);
goto done;
}
//print the raw value le and be format
uint8_t * val = value.raw.data;
int i=0;
printf("set value of : (LE)0x");
for(i=0; i<value.raw.size; i++) {
printf("%.2x", val[i]);
}
printf(" (BE)0x");
for(i=value.raw.size-1; i >=0; i--) {
printf("%.2x", val[i]);
}
printf("\n");
//free the raw value alocation
if(value.raw.data) free(value.raw.data);
}
else if(args_info.save_ctrl_given) {
res = save_controls( handle, args_info.save_ctrl_arg);
}
else if(args_info.load_ctrl_given) {
res = load_controls( handle, args_info.load_ctrl_arg);
}
// Clean up
done:
if(handle) c_close_device(handle);
c_cleanup();
cmdline_parser_free(&args_info);
return res;
}
int main(int argc, char **argv)
{
char *value, *subs;
int i;
int fd = -1;
/* command args */
int ch;
const char *device = "/dev/video0"; /* -d device */
struct v4l2_capability vcap; /* list_cap */
char short_options[26 * 2 * 2 + 1];
int idx = 0;
if (argc == 1) {
usage();
return 0;
}
for (i = 0; long_options[i].name; i++) {
if (!isalpha(long_options[i].val))
continue;
short_options[idx++] = long_options[i].val;
if (long_options[i].has_arg == required_argument)
short_options[idx++] = ':';
}
while (1) {
int option_index = 0;
short_options[idx] = 0;
ch = getopt_long(argc, argv, short_options,
long_options, &option_index);
if (ch == -1)
break;
options[(int)ch] = 1;
switch (ch) {
case OptHelp:
usage();
return 0;
case OptSetDevice:
device = optarg;
if (device[0] >= '0' && device[0] <= '9' && device[1] == 0) {
static char newdev[20];
char dev = device[0];
sprintf(newdev, "/dev/video%c", dev);
device = newdev;
}
break;
case OptGetCtrl:
subs = optarg;
while (*subs != '\0') {
parse_next_subopt(&subs, &value);
if (strchr(value, '=')) {
usage();
exit(1);
}
else {
get_ctrls.push_back(value);
}
}
break;
case OptSetCtrl:
subs = optarg;
while (*subs != '\0') {
parse_next_subopt(&subs, &value);
if (const char *equal = strchr(value, '=')) {
set_ctrls[std::string(value, (equal - value))] = equal + 1;
}
else {
fprintf(stderr, "control '%s' without '='\n", value);
exit(1);
}
}
break;
case ':':
fprintf(stderr, "Option `%s' requires a value\n",
argv[optind]);
usage();
return 1;
case '?':
fprintf(stderr, "Unknown argument `%s'\n",
argv[optind]);
usage();
return 1;
}
}
if (optind < argc) {
printf("unknown arguments: ");
while (optind < argc)
printf("%s ", argv[optind++]);
printf("\n");
usage();
return 1;
}
if ((fd = open(device, O_RDWR)) < 0) {
fprintf(stderr, "Failed to open %s: %s\n", device,
strerror(errno));
exit(1);
}
doioctl(fd, VIDIOC_QUERYCAP, &vcap, "VIDIOC_QUERYCAP");
capabilities = vcap.capabilities;
find_controls(fd);
for (ctrl_get_list::iterator iter = get_ctrls.begin(); iter != get_ctrls.end(); ++iter) {
if (ctrl_str2id.find(*iter) == ctrl_str2id.end()) {
fprintf(stderr, "unknown control '%s'\n", (*iter).c_str());
exit(1);
}
}
for (ctrl_set_map::iterator iter = set_ctrls.begin(); iter != set_ctrls.end(); ++iter) {
if (ctrl_str2id.find(iter->first) == ctrl_str2id.end()) {
fprintf(stderr, "unknown control '%s'\n", iter->first.c_str());
exit(1);
}
}
/* Information Opts */
if (options[OptSetCtrl] && !set_ctrls.empty()) {
struct v4l2_ext_controls ctrls = { 0 };
for (ctrl_set_map::iterator iter = set_ctrls.begin();
iter != set_ctrls.end(); ++iter) {
struct v4l2_ext_control ctrl = { 0 };
ctrl.id = ctrl_str2id[iter->first];
ctrl.value = strtol(iter->second.c_str(), NULL, 0);
if (V4L2_CTRL_ID2CLASS(ctrl.id) == V4L2_CTRL_CLASS_MPEG)
mpeg_ctrls.push_back(ctrl);
else
user_ctrls.push_back(ctrl);
}
for (unsigned i = 0; i < user_ctrls.size(); i++) {
struct v4l2_control ctrl;
ctrl.id = user_ctrls[i].id;
ctrl.value = user_ctrls[i].value;
if (doioctl(fd, VIDIOC_S_CTRL, &ctrl, "VIDIOC_S_CTRL")) {
fprintf(stderr, "%s: %s\n",
ctrl_id2str[ctrl.id].c_str(),
strerror(errno));
}
}
if (mpeg_ctrls.size()) {
ctrls.ctrl_class = V4L2_CTRL_CLASS_MPEG;
ctrls.count = mpeg_ctrls.size();
ctrls.controls = &mpeg_ctrls[0];
if (doioctl(fd, VIDIOC_S_EXT_CTRLS, &ctrls, "VIDIOC_S_EXT_CTRLS")) {
if (ctrls.error_idx >= ctrls.count) {
fprintf(stderr, "Error setting MPEG controls: %s\n",
strerror(errno));
}
else {
fprintf(stderr, "%s: %s\n",
ctrl_id2str[mpeg_ctrls[ctrls.error_idx].id].c_str(),
strerror(errno));
}
}
}
}
/* Get options */
if (options[OptGetCtrl] && !get_ctrls.empty()) {
struct v4l2_ext_controls ctrls = { 0 };
mpeg_ctrls.clear();
user_ctrls.clear();
for (ctrl_get_list::iterator iter = get_ctrls.begin();
iter != get_ctrls.end(); ++iter) {
struct v4l2_ext_control ctrl = { 0 };
ctrl.id = ctrl_str2id[*iter];
if (V4L2_CTRL_ID2CLASS(ctrl.id) == V4L2_CTRL_CLASS_MPEG)
mpeg_ctrls.push_back(ctrl);
else
user_ctrls.push_back(ctrl);
}
for (unsigned i = 0; i < user_ctrls.size(); i++) {
struct v4l2_control ctrl;
ctrl.id = user_ctrls[i].id;
doioctl(fd, VIDIOC_G_CTRL, &ctrl, "VIDIOC_G_CTRL");
printf("%s: %d\n", ctrl_id2str[ctrl.id].c_str(), ctrl.value);
}
if (mpeg_ctrls.size()) {
ctrls.ctrl_class = V4L2_CTRL_CLASS_MPEG;
ctrls.count = mpeg_ctrls.size();
ctrls.controls = &mpeg_ctrls[0];
doioctl(fd, VIDIOC_G_EXT_CTRLS, &ctrls, "VIDIOC_G_EXT_CTRLS");
for (unsigned i = 0; i < mpeg_ctrls.size(); i++) {
struct v4l2_ext_control ctrl = mpeg_ctrls[i];
printf("%s: %d\n", ctrl_id2str[ctrl.id].c_str(), ctrl.value);
}
}
}
if (options[OptListCtrlsMenus]) {
list_controls(fd, 1);
}
if (options[OptListCtrls]) {
list_controls(fd, 0);
}
close(fd);
exit(app_result);
}
int
main (int argc, char **argv)
{
CHandle handle = 0;
CResult res = C_SUCCESS;
// Parse the command line
if(cmdline_parser(argc, argv, &args_info) != 0)
exit(1);
// Display help if no arguments were specified
if(argc == 1) {
cmdline_parser_print_help();
exit(0);
}
res = c_init();
if(res) goto done;
// List devices
if(args_info.list_given) {
res = list_devices();
goto done;
}
// Import dynamic controls from XML file
else if(args_info.import_given) {
res = add_control_mappings(args_info.import_arg);
goto done;
}
// Open the device
handle = c_open_device(args_info.device_arg);
if(!handle) {
print_error("Unable to open device", -1);
res = C_INVALID_DEVICE;
goto done;
}
// List frame formats
if(args_info.formats_given) {
printf("Listing available frame formats for device %s:\n", args_info.device_arg);
res = list_frame_formats(handle);
}
// List controls
else if(args_info.clist_given) {
printf("Listing available controls for device %s:\n", args_info.device_arg);
res = list_controls(handle);
}
// Retrieve control value
else if(args_info.get_given) {
CControlValue value;
// Resolve the control Id
CControlId controlId = get_control_id(handle, args_info.get_arg);
if(!controlId) {
print_handle_error(handle, "Unknown control specified", -1);
goto done;
}
// Retrieve the control value
res = c_get_control(handle, controlId, &value);
if(res) {
print_handle_error(handle, "Unable to retrieve control value", res);
goto done;
}
printf("%d\n", value.value);
}
else if(args_info.set_given) {
CControlValue value;
// Parse the control value
if(args_info.inputs_num < 1) {
print_error("No control value specified", -1);
goto done;
}
if(parse_control_value(args_info.inputs[0], &value)) {
print_error("Invalid control value specified", -1);
goto done;
}
// Resolve the control Id
CControlId controlId = get_control_id(handle, args_info.set_arg);
if(!controlId) {
print_handle_error(handle, "Unknown control specified", -1);
goto done;
}
// Set the new control value
res = c_set_control(handle, controlId, &value);
if(res) {
print_handle_error(handle, "Unable to set new control value", res);
goto done;
}
}
// Clean up
done:
if(handle) c_close_device(handle);
c_cleanup();
cmdline_parser_free(&args_info);
return res;
}
