tdc: initial lib version.

Contains init and exit functions, and also a test program. Signed-off-by: Miguel Gómez <magomez@igalia.com>

tdc: initial lib version.
Contains init and exit functions, and also a test program. Signed-off-by: Miguel Gómez <magomez@igalia.com>
b0cd095f · Miguel Gómez Sexto · 3b33bfb0 · b0cd095f · b0cd095f · b0cd095f
Commit b0cd095f authored Sep 06, 2012 by Miguel Gómez Sexto
Hide whitespace changes
Inline Side-by-side

Showing with 169 additions and 3 deletions

Makefile lib/Makefile +17 -3

libtdc.c lib/libtdc.c +96 -0

libtdc.h lib/libtdc.h +28 -0

test.c lib/test.c +28 -0

No files found.
--- a/lib/Makefile
+++ b/lib/Makefile
-all:
+LIB = libtdc.a
+LOBJ := libtdc.o

-.PHONY: all
+CFLAGS = -Wall -ggdb -O2 -I..
+LDFLAGS = -L. -ltdc
+
+modules all: lib test
+
+lib: $(LIB)
+
+%: %.c $(LIB)
+	$(CC) $(CFLAGS) $*.c $(LDFLAGS) -o $@
+
+$(LIB): $(LOBJ)
+	ar r $@ $^
+
+test: test.o

 clean:
-	$(RM) *.a *.o
+	rm -f $(LIB) *.o *~ test
--- a/lib/libtdc.c
+++ b/lib/libtdc.c
+#include <glob.h>
+#include <unistd.h>
+#include <assert.h>
+#include <stdio.h>
+#include <string.h>
+#include <stdlib.h>
+#include "libtdc.h"
+
+#define ARRAY_SIZE(x) (sizeof(x) / sizeof((x)[0]))
+
+static int tdc_nboards;
+static struct tdc_board *tdc_boards;
+
+int tdc_init(void)
+{
+	glob_t glob_dev, glob_sys;
+	struct tdc_board *b;
+	int i, j;
+
+	/* Look for boards in /dev: old and new pathnames: only one matches */
+	glob("/dev/tdc-*-0-0-ctrl", 0, NULL, &glob_dev);
+	glob("/dev/zio/tdc-*-0-0-ctrl", GLOB_APPEND, NULL, &glob_dev);
+
+	/* And look in /sys as well */
+        glob("/sys/bus/zio/devices/tdc-*",0 , NULL, &glob_sys);
+	assert(glob_dev.gl_pathc == glob_sys.gl_pathc);
+
+	/* Allocate as needed */
+	tdc_nboards = glob_dev.gl_pathc;
+	if (!tdc_nboards) {
+		tdc_boards = NULL;
+		return 0;
+	}
+	tdc_boards = calloc(glob_dev.gl_pathc, sizeof(tdc_boards[0]));
+	if (!tdc_boards) {
+		globfree(&glob_dev);
+		globfree(&glob_sys);
+		return -1;
+	}
+
+	for (i = 0, b = tdc_boards; i < tdc_nboards; i++, b++) {
+		b->sysbase = strdup(glob_sys.gl_pathv[i]);
+		b->devbase = strdup(glob_dev.gl_pathv[i]);
+		/* trim the "-0-0-ctrl" at the end */
+		b->devbase[strlen(b->devbase) - strlen("-0-0-ctrl")] = '\0';
+		/* extract dev_id */
+		sscanf(b->sysbase, "%*[^f]tdc-%x", &b->dev_id);
+		for (j = 0; j < ARRAY_SIZE(b->ctrl); j++) {
+			b->ctrl[j] = -1;
+			b->data[j] = -1;
+		}
+		printf("Initialized device %s", b->sysbase);
+	}
+	globfree(&glob_dev);
+	globfree(&glob_sys);
+
+	return tdc_nboards;
+}
+
+void tdc_exit(void)
+{
+	struct tdc_board *b;
+	int i, j, err;
+
+	for (i = 0, err = 0, b = tdc_boards; i < tdc_nboards; i++, b++) {
+		for (j = 0; j < ARRAY_SIZE(b->ctrl); j++) {
+			if (b->ctrl[j] >= 0) {
+				close(b->ctrl[j]);
+				b->ctrl[j] = -1;
+				err++;
+			}
+			if (b->data[j] >= 0) {
+				close(b->data[j]);
+				b->data[j] = -1;
+				err++;
+			}
+		}
+		if (err)
+			fprintf(stderr, "%s: device %s was still open\n",
+				__func__, b->devbase);
+		free(b->sysbase);
+		free(b->devbase);
+	}
+	if(tdc_nboards)
+		free(tdc_boards);
+}
+
+struct tdc_board *tdc_open(int offset, int dev_id)
+{
+	return NULL;
+}
+
+extern int tdc_close(struct tdc_board *b)
+{
+	return 0;
+}
--- a/lib/libtdc.h
+++ b/lib/libtdc.h
+#ifndef __TDC_LIB_H__
+#define __TDC_LIB_H__
+
+#include <stdint.h>
+
+struct tdc_board {
+	int dev_id;
+	char *devbase;
+	char *sysbase;
+	int ctrl[5]; /* The 5 control channels */
+	int data[5]; /* The 5 data channels */
+};
+
+struct tdc_time {
+	uint64_t utc;
+	uint32_t coarse;
+	uint32_t frac;
+	uint32_t channel;
+};
+
+
+extern int tdc_init(void);
+extern void tdc_exit(void);
+
+extern struct tdc_board *tdc_open(int offset, int dev_id);
+extern int tdc_close(struct tdc_board *);
+
+#endif
--- a/lib/test.c
+++ b/lib/test.c
+#include <stdio.h>
+#include <stdlib.h>
+#include <string.h>
+#include <errno.h>
+#include "libtdc.h"
+
+int main(int argc, char **argv)
+{
+	int i;
+
+	i = tdc_init();
+	if (i < 0) {
+		fprintf(stderr, "%s: tdc_init(): %s\n", argv[0],
+			strerror(errno));
+		exit(1);
+	}
+	if (i == 0) {
+		fprintf(stderr, "%s: no boards found\n", argv[0]);
+		exit(1);
+	}
+	if (i != 1) {
+		fprintf(stderr, "%s: found %i boards",
+			argv[0], i);
+	}
+
+	tdc_exit();
+	return 0;
+}