Module: xenomai-2.5
Branch: master
Commit: f483906192fee927dafc5435a32673912ce1a247
URL:
http://git.xenomai.org/?p=xenomai-2.5.git;a=commit;h=f483906192fee927dafc5435a32673912ce1a247
Author: Alexis Berlemont <alexis.berlem...@gmail.com>
Date: Sun Jan 24 22:47:49 2010 +0100
analogy: add the program insn_bits to test digital subdevices
---
src/utils/analogy/Makefile.am | 5 +-
src/utils/analogy/Makefile.in | 15 +++-
src/utils/analogy/insn_bits.c | 204 +++++++++++++++++++++++++++++++++++++++++
3 files changed, 220 insertions(+), 4 deletions(-)
diff --git a/src/utils/analogy/Makefile.am b/src/utils/analogy/Makefile.am
index 6a232aa..3bc5d47 100644
--- a/src/utils/analogy/Makefile.am
+++ b/src/utils/analogy/Makefile.am
@@ -1,6 +1,6 @@
sbin_PROGRAMS = analogy_config
-bin_PROGRAMS = cmd_read cmd_write insn_read insn_write
+bin_PROGRAMS = cmd_read cmd_write insn_read insn_write insn_bits
CPPFLAGS = \
@XENO_USER_CFLAGS@ \
@@ -26,3 +26,6 @@ insn_read_LDADD = -lanalogy -lnative -lrtdm
insn_write_SOURCES = insn_write.c
insn_write_LDADD = -lanalogy -lnative -lrtdm
+
+insn_bits_SOURCES = insn_bits.c
+insn_bits_LDADD = -lanalogy -lrtdm
diff --git a/src/utils/analogy/Makefile.in b/src/utils/analogy/Makefile.in
index a4d1c82..1d2c428 100644
--- a/src/utils/analogy/Makefile.in
+++ b/src/utils/analogy/Makefile.in
@@ -35,7 +35,7 @@ host_triplet = @host@
target_triplet = @target@
sbin_PROGRAMS = analogy_config$(EXEEXT)
bin_PROGRAMS = cmd_read$(EXEEXT) cmd_write$(EXEEXT) insn_read$(EXEEXT) \
- insn_write$(EXEEXT)
+ insn_write$(EXEEXT) insn_bits$(EXEEXT)
subdir = src/utils/analogy
DIST_COMMON = $(srcdir)/Makefile.am $(srcdir)/Makefile.in
ACLOCAL_M4 = $(top_srcdir)/aclocal.m4
@@ -65,6 +65,9 @@ cmd_read_DEPENDENCIES =
am_cmd_write_OBJECTS = cmd_write.$(OBJEXT)
cmd_write_OBJECTS = $(am_cmd_write_OBJECTS)
cmd_write_DEPENDENCIES =
+am_insn_bits_OBJECTS = insn_bits.$(OBJEXT)
+insn_bits_OBJECTS = $(am_insn_bits_OBJECTS)
+insn_bits_DEPENDENCIES =
am_insn_read_OBJECTS = insn_read.$(OBJEXT)
insn_read_OBJECTS = $(am_insn_read_OBJECTS)
insn_read_DEPENDENCIES =
@@ -84,10 +87,10 @@ LINK = $(LIBTOOL) --tag=CC $(AM_LIBTOOLFLAGS)
$(LIBTOOLFLAGS) \
--mode=link $(CCLD) $(AM_CFLAGS) $(CFLAGS) $(AM_LDFLAGS) \
$(LDFLAGS) -o $@
SOURCES = $(analogy_config_SOURCES) $(cmd_read_SOURCES) \
- $(cmd_write_SOURCES) $(insn_read_SOURCES) \
+ $(cmd_write_SOURCES) $(insn_bits_SOURCES) $(insn_read_SOURCES) \
$(insn_write_SOURCES)
DIST_SOURCES = $(analogy_config_SOURCES) $(cmd_read_SOURCES) \
- $(cmd_write_SOURCES) $(insn_read_SOURCES) \
+ $(cmd_write_SOURCES) $(insn_bits_SOURCES) $(insn_read_SOURCES) \
$(insn_write_SOURCES)
ETAGS = etags
CTAGS = ctags
@@ -269,6 +272,8 @@ insn_read_SOURCES = insn_read.c
insn_read_LDADD = -lanalogy -lnative -lrtdm
insn_write_SOURCES = insn_write.c
insn_write_LDADD = -lanalogy -lnative -lrtdm
+insn_bits_SOURCES = insn_bits.c
+insn_bits_LDADD = -lanalogy -lrtdm
all: all-am
.SUFFIXES:
@@ -367,6 +372,9 @@ cmd_read$(EXEEXT): $(cmd_read_OBJECTS)
$(cmd_read_DEPENDENCIES)
cmd_write$(EXEEXT): $(cmd_write_OBJECTS) $(cmd_write_DEPENDENCIES)
@rm -f cmd_write$(EXEEXT)
$(LINK) $(cmd_write_OBJECTS) $(cmd_write_LDADD) $(LIBS)
+insn_bits$(EXEEXT): $(insn_bits_OBJECTS) $(insn_bits_DEPENDENCIES)
+ @rm -f insn_bits$(EXEEXT)
+ $(LINK) $(insn_bits_OBJECTS) $(insn_bits_LDADD) $(LIBS)
insn_read$(EXEEXT): $(insn_read_OBJECTS) $(insn_read_DEPENDENCIES)
@rm -f insn_read$(EXEEXT)
$(LINK) $(insn_read_OBJECTS) $(insn_read_LDADD) $(LIBS)
@@ -383,6 +391,7 @@ distclean-compile:
@AMDEP_TRUE@@am__include@ @am__qu...@./$(DEPDIR)/analogy_config...@am__quote@
@AMDEP_TRUE@@am__include@ @am__qu...@./$(DEPDIR)/cmd_read...@am__quote@
@AMDEP_TRUE@@am__include@ @am__qu...@./$(DEPDIR)/cmd_write...@am__quote@
+...@amdep_true@@am__include@ @am__qu...@./$(DEPDIR)/insn_bits...@am__quote@
@AMDEP_TRUE@@am__include@ @am__qu...@./$(DEPDIR)/insn_read...@am__quote@
@AMDEP_TRUE@@am__include@ @am__qu...@./$(DEPDIR)/insn_write...@am__quote@
diff --git a/src/utils/analogy/insn_bits.c b/src/utils/analogy/insn_bits.c
new file mode 100644
index 0000000..d7a8e1b
--- /dev/null
+++ b/src/utils/analogy/insn_bits.c
@@ -0,0 +1,204 @@
+/**
+ * @file
+ * Analogy for Linux, instruction write test program
+ *
+ * @note Copyright (C) 1997-2000 David A. Schleef <d...@schleef.org>
+ * @note Copyright (C) 2008 Alexis Berlemont <alexis.berlem...@free.fr>
+ *
+ * Xenomai 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.
+ *
+ * Xenomai 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 Xenomai; if not, write to the Free Software Foundation,
+ * Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
+ */
+
+#include <stdint.h>
+#include <stdio.h>
+#include <stdlib.h>
+#include <sys/mman.h>
+#include <errno.h>
+#include <getopt.h>
+
+#include <analogy/analogy.h>
+
+#define FILENAME "analogy0"
+
+static char *filename = FILENAME;
+static int verbose;
+static int idx_subd = -1;
+
+struct option insn_bits_opts[] = {
+ {"verbose", no_argument, NULL, 'v'},
+ {"device", required_argument, NULL, 'd'},
+ {"subdevice", required_argument, NULL, 's'},
+ {"help", no_argument, NULL, 'h'},
+ {0},
+};
+
+void do_print_usage(void)
+{
+ fprintf(stdout, "usage:\tinsn_bits [OPTS] <bits_values> <mask>\n");
+ fprintf(stdout, "\tOPTS:\t -v, --verbose: verbose output\n");
+ fprintf(stdout,
+ "\t\t -d, --device: device filename (analogy0, analogy1,
...)\n");
+ fprintf(stdout, "\t\t -s, --subdevice: subdevice index\n");
+ fprintf(stdout, "\t\t -h, --help: print this help\n");
+}
+
+int main(int argc, char *argv[])
+{
+ int i = 0, err = 0;
+ a4l_desc_t dsc = { .sbdata = NULL };
+ a4l_sbinfo_t *sbinfo;
+ int scan_size, value, mask;
+
+ /* Compute arguments */
+ while ((err = getopt_long(argc,
+ argv,
+ "vd:s:h", insn_bits_opts,
+ NULL)) >= 0) {
+ switch (err) {
+ case 'v':
+ verbose = 1;
+ break;
+ case 'd':
+ filename = optarg;
+ break;
+ case 's':
+ idx_subd = strtoul(optarg, NULL, 0);
+ break;
+ case 'h':
+ default:
+ do_print_usage();
+ return 0;
+ }
+ }
+
+ value = (argc - optind > 0) ? strtoul(argv[optind], NULL, 0) : 0;
+ mask = (argc - optind > 1) ? strtoul(argv[optind + 1], NULL, 0) : 0;
+
+ /* Open the device */
+ err = a4l_open(&dsc, filename);
+ if (err < 0) {
+ fprintf(stderr,
+ "insn_bits: a4l_open %s failed (err=%d)\n",
+ filename, err);
+ return err;
+ }
+
+ if (verbose != 0) {
+ printf("insn_bits: device %s opened (fd=%d)\n", filename,
+ dsc.fd);
+ printf("insn_bits: basic descriptor retrieved\n");
+ printf("\t subdevices count = %d\n", dsc.nb_subd);
+ printf("\t read subdevice index = %d\n", dsc.idx_read_subd);
+ printf("\t write subdevice index = %d\n", dsc.idx_write_subd);
+ }
+
+ /* Allocate a buffer so as to get more info (subd, chan, rng) */
+ dsc.sbdata = malloc(dsc.sbsize);
+ if (dsc.sbdata == NULL) {
+ err = -ENOMEM;
+ fprintf(stderr, "insn_bits: info buffer allocation failed\n");
+ goto out_insn_bits;
+ }
+
+ /* Get this data */
+ err = a4l_fill_desc(&dsc);
+ if (err < 0) {
+ fprintf(stderr,
+ "insn_bits: a4l_fill_desc failed (err=%d)\n", err);
+ goto out_insn_bits;
+ }
+
+ if (verbose != 0)
+ printf("insn_bits: complex descriptor retrieved\n");
+
+ /* If no subdevice index was set, choose for the first digital
+ subdevice found */
+ while (idx_subd == -1 && i < dsc.nb_subd) {
+
+ err = a4l_get_subdinfo(&dsc, i, &sbinfo);
+ if (err < 0) {
+ fprintf(stderr,
+ "insn_bits: get_sbinfo(%d) failed (err = %d)\n",
+ i, err);
+ goto out_insn_bits;
+ }
+
+ if ((sbinfo->flags & A4L_SUBD_TYPES) == A4L_SUBD_DIO ||
+ (sbinfo->flags & A4L_SUBD_TYPES) == A4L_SUBD_DI ||
+ (sbinfo->flags & A4L_SUBD_TYPES) == A4L_SUBD_DO) {
+ idx_subd = i;
+ }
+
+ i++;
+ }
+
+ if (idx_subd == -1) {
+ fprintf(stderr, "insn_bits: no digital subdevice available\n");
+ err = -EINVAL;
+ goto out_insn_bits;
+ }
+
+ if (verbose != 0)
+ printf("insn_bits: selected subdevice index = %d\n", idx_subd);
+
+ /* Set the data size to read / write */
+ scan_size = a4l_sizeof_subd(sbinfo);
+
+ if ((sbinfo->flags & A4L_SUBD_TYPES) != A4L_SUBD_DI) {
+ printf("insn_bits: mask = 0x%x\n", mask);
+ printf("insn_bits: value = 0x%x\n", value);
+ }
+
+ /* Handle little endian case with scan size < 32 */
+ if (scan_size == sizeof(uint8_t)) {
+ mask *= 0x01010101;
+ value *= 0x01010101;
+ }
+ else if (scan_size == sizeof(uint16_t)) {
+ mask *= 0x00010001;
+ value *= 0x00010001;
+ }
+
+ /* Perform the synchronous operation */
+ err = a4l_sync_dio(&dsc, idx_subd, &mask, &value);
+
+ if (err < 0) {
+ fprintf(stderr,
+ "insn_bits: a4l_sync_dio() failed (err=%d)\n", err);
+ goto out_insn_bits;
+ }
+
+ if (scan_size == sizeof(uint8_t)) {
+ value = *((uint8_t *)&value);
+ }
+ else if (scan_size == sizeof(uint16_t)) {
+ value = *((uint16_t *)&value);
+ }
+
+ if ((sbinfo->flags & A4L_SUBD_TYPES) != A4L_SUBD_DO)
+ printf("insn_bits: result = 0x%x\n", value);
+ else
+ printf("insn_bits: operation succeeded\n");
+
+out_insn_bits:
+
+ /* Free the information buffer */
+ if (dsc.sbdata != NULL)
+ free(dsc.sbdata);
+
+ /* Release the file descriptor */
+ a4l_close(&dsc);
+
+ return err;
+}
_______________________________________________
Xenomai-git mailing list
Xenomai-git@gna.org
https://mail.gna.org/listinfo/xenomai-git
