stv0g
/
comedilib
1
0
Fork 0
Code Issues Pull Requests Releases Wiki Activity
comedilib/comedi_config/comedi_config.c

509 lines
12 KiB
C
Raw Permalink Blame History

/*
comedi_config/comedi_config.c
configuration program for comedi kernel module
COMEDI - Linux Control and Measurement Device Interface
Copyright (C) 1998,2000 David A. Schleef <ds@schleef.org>
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, or
(at your option) any later version.
This program is distributed in the hope that it will be useful,
but WITHOUT ANY WARRANTY; without even the implied warranty of
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
GNU General Public License for more details.
You should have received a copy of the GNU General Public License
along with this program; if not, write to the Free Software
Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
*/
#define CC_VERSION "0.11.0"
#include <sys/types.h>
#include <sys/stat.h>
#include <sys/sysmacros.h>
#include <fcntl.h>
#include <sys/ioctl.h>
#include <stdio.h>
#include <getopt.h>
#include <errno.h>
#include <string.h>
#include <stdint.h>
#include <stdlib.h>
#include <unistd.h>
#include <getopt.h>
#include <comedi.h>
#ifdef I18N
#include <libintl.h>
#define _(a) gettext(a)
#else
#define _(a) (a)
#endif
int quiet=0,verbose=0;
#define MAX_NUM_INIT_FILES 4
char *init_file[MAX_NUM_INIT_FILES] = {NULL,NULL,NULL,NULL};
enum option_ids
{
READ_BUFFER_OPT_ID = 0x1000,
WRITE_BUFFER_OPT_ID,
SUBDEVICE_BUFFER_OPT_ID,
INIT_DATA1_OPT_ID,
INIT_DATA2_OPT_ID,
INIT_DATA3_OPT_ID
};
struct option options[] = {
{ "verbose", 0, NULL, 'v' },
{ "quiet", 0, NULL, 'q' },
{ "version", 0, NULL, 'V' },
{ "init-data", 1, NULL, 'i' },
{ "init-data0", 1, NULL, 'i' },
{ "remove", 0, NULL, 'r' },
{ "read-buffer", 1, NULL, READ_BUFFER_OPT_ID},
{ "write-buffer", 1, NULL, WRITE_BUFFER_OPT_ID},
{ "subdevice-buffer", 1, NULL, SUBDEVICE_BUFFER_OPT_ID},
{ "init-data1", 1, NULL, INIT_DATA1_OPT_ID },
{ "init-data2", 1, NULL, INIT_DATA2_OPT_ID },
{ "init-data3", 1, NULL, INIT_DATA3_OPT_ID },
{ 0 },
};
void do_help(int i)
{
fputs("comedi_config version " CC_VERSION "\n",stderr);
fputs(
_("usage: comedi_config [OPTIONS] <device file> [<driver> <opt1>,<opt2>,...]\n"
"\n"
"OPTIONS:\n"
" -v, --verbose\n"
" Verbose output.\n"
" -q, --quiet\n"
" Quiet output.\n"
" -V, --version\n"
" Print program version.\n"
" -i, --init-data, --init-data0 <filename>\n"
" Use file for driver initialization data, typically firmware code.\n"
" --init-data1 <filename>\n"
" --init-data2 <filename>\n"
" --init-data3 <filename>\n"
" Some drivers require multiple files of initialization data. Use these\n"
" options to specify them. See the driver-specific documentation for further details.\n"
" -r, --remove\n"
" Remove previously configured driver.\n"
" --read-buffer <size>\n"
" Set buffer size in kilobytes used for reading.\n"
" --write-buffer <size>\n"
" Set buffer size in kilobytes used for writing.\n"
" --subdevice-buffer <subd>,<size>[,<subd>,<size>]...\n"
" Set buffer size in kilobytes for subdevice <subd>.\n"
" Option may be repeated.\n"
"\n"
" <optN> are integers whose interpretation is driver dependent.\n"
" In general, for PCI boards, <opt1> and <opt2> refer to the bus/slot\n"
" indices of the board. If not specified, a board will automatically\n"
" be chosen. For non-PCI boards, <opt1> specifies the I/O port base\n"
" address and, if applicable, <opt2> specifies the IRQ. Additional\n"
" options may be useful, see the Comedi documentation for details.\n")
,stderr);
exit(i);
}
void read_init_files(char* file_names[], int num_files, int *options)
{
int i;
int offset;
FILE* files[num_files];
int sizes[num_files];
uintptr_t data_address;
int data_length = 0;
void *data = NULL;
for(i = 0; i < num_files; ++i)
{
struct stat buf;
if(file_names[i] == NULL)
{
sizes[i] = 0;
continue;
}
files[i] = fopen(file_names[i],"r");
if(files[i] == NULL)
{
perror(file_names[i]);
exit(1);
}
fstat(fileno(files[i]), &buf);
sizes[i] = buf.st_size;
data_length += sizes[i];
}
options[COMEDI_DEVCONF_AUX_DATA0_LENGTH] = sizes[0];
options[COMEDI_DEVCONF_AUX_DATA1_LENGTH] = sizes[1];
options[COMEDI_DEVCONF_AUX_DATA2_LENGTH] = sizes[2];
options[COMEDI_DEVCONF_AUX_DATA3_LENGTH] = sizes[3];
options[COMEDI_DEVCONF_AUX_DATA_LENGTH] = data_length;
if(data_length == 0)
{
return;
}
data = malloc(data_length);
if(data==NULL)
{
perror(_("allocating initialization data\n"));
exit(1);
}
data_address = (uintptr_t)data;
options[COMEDI_DEVCONF_AUX_DATA_LO] = data_address;
options[COMEDI_DEVCONF_AUX_DATA_HI] = 0;
if(sizeof(void*) > sizeof(int))
{
int bit_shift = sizeof(int) * 8;
options[COMEDI_DEVCONF_AUX_DATA_HI] = data_address >> bit_shift;
}
offset = 0;
for(i = 0; i < num_files; ++i)
{
size_t ret;
if(file_names[i] == NULL)
{
continue;
}
ret = fread(data + offset, 1, sizes[i], files[i]);
if(ret < sizes[i])
{
perror(_("reading initialization data\n"));
exit(1);
}
offset += sizes[i];
fclose(files[i]);
}
return;
}
int main(int argc,char *argv[])
{
comedi_devconfig it;
comedi_bufconfig bc;
comedi_devinfo devinfo;
int fd;
int c,i,num,k;
char *opts;
char *fn,*driver;
struct stat statbuf;
int ret;
int remove=0;
int index;
int read_buf_size=0;
int write_buf_size=0;
int *sub_buf_list=NULL;
int sub_buf_len=0;
#ifdef I18N
setlocale(LC_ALL, "");
bindtextdomain("comedilib", "/usr/share/locale");
textdomain("comedilib");
#endif
if(geteuid() != 0)
fprintf(stderr,_("comedi_config should be run as root. Attempting to continue anyway.\n"));
while(1){
c=getopt_long(argc, argv, "rvVqi:", options, &index);
if(c==-1)break;
switch(c){
case 'v':
verbose=1;
break;
case 'V':
fputs("comedi_config version " CC_VERSION "\n",stderr);
exit(0);
break;
case 'q':
quiet=1;
break;
case 'r':
remove=1;
break;
case 'i':
init_file[0]=optarg;
break;
case INIT_DATA1_OPT_ID:
init_file[1]=optarg;
break;
case INIT_DATA2_OPT_ID:
init_file[2]=optarg;
break;
case INIT_DATA3_OPT_ID:
init_file[3]=optarg;
break;
case READ_BUFFER_OPT_ID:
read_buf_size = strtol(optarg, NULL, 0);
if(read_buf_size < 0)
{
fprintf(stderr, _("invalid buffer size\n"));
exit(-1);
}
break;
case WRITE_BUFFER_OPT_ID:
write_buf_size = strtol(optarg, NULL, 0);
if(write_buf_size < 0)
{
fprintf(stderr, _("invalid buffer size\n"));
exit(-1);
}
break;
case SUBDEVICE_BUFFER_OPT_ID:
{
char *s, *e;
int subd, size;
s = optarg;
do
{
subd = strtol(s, &e, 0);
if(s == e || subd < 0)
{
fprintf(stderr, _("invalid subdevice\n"));
exit(-1);
}
if(*e && *e != ',')
{
fprintf(stderr, _("invalid separator\n"));
exit(-1);
}
if(*e)
{
e++;
}
s = e;
size = strtol(s, &e, 0);
if(s == e || size < 0)
{
fprintf(stderr, _("invalid buffer size\n"));
exit(-1);
}
if(*e && *e != ',')
{
fprintf(stderr, _("invalid separator\n"));
exit(-1);
}
if(*e)
{
e++;
}
s = e;
sub_buf_list =
realloc(sub_buf_list,
sizeof(*sub_buf_list) *
(sub_buf_len + 2));
if(!sub_buf_list)
{
perror(_("allocating subdevice buffer list\n"));
exit(-1);
}
sub_buf_list[sub_buf_len++] = subd;
sub_buf_list[sub_buf_len++] = size;
} while(*s);
}
break;
default:
do_help(1);
}
}
if((argc-optind) < 1 || (argc-optind) > 3 ||
((argc-optind) == 1 && read_buf_size == 0 && write_buf_size == 0 && remove == 0 && sub_buf_len == 0)){
do_help(1);
}
fn=argv[optind];
fd=open(fn,O_RDWR);
if(fd<0){
switch(errno){
case ENODEV:
fprintf(stderr,_("comedi.o not loaded\n"));
break;
case ENXIO:
fprintf(stderr,_("device not configured\n"));
break;
case EPERM:
fprintf(stderr,_("modprobe problem\n"));
break;
default:
perror(fn);
break;
}
exit(1);
}
// if we are attaching or detaching a device
if((argc-optind) > 1 || ((argc-optind) == 1 && remove))
{
if(argc - optind > 1)
driver=argv[optind+1];
else
driver = "none";
strncpy(it.board_name,driver,COMEDI_NAMELEN-1);
for(i=0;i<COMEDI_NDEVCONFOPTS;i++)it.options[i]=0;
if((argc-optind)==3){
opts=argv[optind+2];
i=0;
while(*opts){
if((*opts)==','){
i++;
opts++;
if(i>=COMEDI_NDEVCONFOPTS)
do_help(1);
continue;
}
if(sscanf(opts,"%i%n",&num,&k)>0){
it.options[i]=num;
opts+=k;
continue;
}
do_help(1);
}
}
ret=stat(fn,&statbuf);
if(ret<0){
perror(fn);
exit(1);
}
#if 0
/* this appears to be broken */
if( !(S_ISCHR(statbuf.st_mode)) ||
major(statbuf.st_dev)!=COMEDI_MAJOR){
if(!quiet)
fprintf(stderr,"warning: %s might not be a comedi device\n",fn);
}
#endif
read_init_files(init_file, MAX_NUM_INIT_FILES, it.options);
/* add: sanity check for device */
if(verbose){
printf(_("configuring driver=%s "),it.board_name);
for(i=0;i<COMEDI_NDEVCONFOPTS;i++)printf("%d,",it.options[i]);
printf("\n");
}
if(ioctl(fd,COMEDI_DEVCONFIG,remove?NULL:&it)<0){
int err=errno;
perror(_("Configure failed!"));
fprintf(stderr,_("Check kernel log for more information\n"));
fprintf(stderr,_("Possible reasons for failure:\n"));
switch(err){
case EINVAL:
fprintf(stderr," \n");
break;
case EBUSY:
fprintf(stderr,_(" Already configured\n"));
break;
case EIO:
fprintf(stderr,_(" Driver not found\n"));
break;
case EPERM:
fprintf(stderr,_(" Not root\n"));
break;
case EFAULT:
fprintf(stderr,_(" Comedi bug\n"));
break;
default:
fprintf(stderr,_(" Unknown\n"));
break;
}
exit(1);
}
}
// dont do buffer resize if we have removed device
if(remove == 0)
{
if(read_buf_size || write_buf_size || sub_buf_len){
ret = ioctl(fd,COMEDI_DEVINFO,&devinfo);
if(ret<0){
perror("devinfo");
exit(1);
}
if(devinfo.version_code < ((7<<8) | (57))){
fprintf(stderr,_("Buffer resizing requires Comedi version >= 0.7.57\n"));
exit(1);
}
}
// do buffer resizing
if(read_buf_size)
{
if(devinfo.read_subdevice < 0){
fprintf(stderr,_("warning: no read subdevice, resize ignored\n"));
}else{
memset(&bc, 0, sizeof(bc));
bc.subdevice = devinfo.read_subdevice;
bc.maximum_size = read_buf_size * 1024;
bc.size = read_buf_size * 1024;
if(ioctl(fd, COMEDI_BUFCONFIG, &bc) < 0)
{
perror(_("buffer resize error"));
exit(1);
}
if(verbose)
{
printf(_("%s read buffer resized to %i kilobytes\n"),
fn, bc.size / 1024);
}
}
}
if(write_buf_size)
{
if(devinfo.write_subdevice < 0){
fprintf(stderr,_("warning: no write subdevice, resize ignored\n"));
}else{
memset(&bc, 0, sizeof(bc));
bc.subdevice = devinfo.write_subdevice;
bc.maximum_size = write_buf_size * 1024;
bc.size = write_buf_size * 1024;
if(ioctl(fd, COMEDI_BUFCONFIG, &bc) < 0)
{
perror(_("buffer resize error"));
exit(1);
}
if(verbose)
{
printf(_("%s write buffer resized to %i kilobytes\n"),
fn, bc.size / 1024);
}
}
}
for(index=0; index + 1 < sub_buf_len; index += 2)
{
memset(&bc, 0, sizeof(bc));
bc.subdevice = sub_buf_list[index + 0];
bc.maximum_size = sub_buf_list[index + 1] * 1024;
bc.size = bc.maximum_size;
if(ioctl(fd, COMEDI_BUFCONFIG, &bc) < 0)
{
perror(_("buffer resize error"));
exit(1);
}
if(verbose)
{
printf(_("%s subdevice %u buffer resized to %u kilobytes\n"),
fn, bc.subdevice, bc.size / 1024);
}
}
}
exit(0);
}
Reference in New Issue View Git Blame Copy Permalink