# HG changeset patch
# User Daniele Nicolodi <daniele.nicolodi@obspm.fr>
# Date 1396278218 -7200
# Node ID c700a2d38fb84b37614ab0593630558b50dbf0b5
# Parent  31093786d41d029eaf806cb93a3a11bd4132b58c
New AD9956 interface

diff -r 31093786d41d -r c700a2d38fb8 ad9956.c
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/ad9956.c	Mon Mar 31 17:03:38 2014 +0200
@@ -0,0 +1,151 @@
+#ifdef _CVI_
+#include <winsock2.h>
+#include <ansi_c.h>
+#include <toolbox.h>
+#else
+#include <stdio.h>
+#include <stdlib.h>
+#include <unistd.h>
+#include <errno.h>
+#include <string.h>
+#include <sys/types.h>
+#include <sys/socket.h>
+#include <netinet/in.h>
+#include <arpa/inet.h>
+#include <netdb.h>
+#include <ctype.h>
+#include <stdarg.h>
+#endif
+
+#include "dds.h"
+#include "ad9956.h"
+
+
+int ad9956_init(struct ad9956 *d, const char *hostname, double clock)
+{
+	int sock, n, r;
+	char buffer[256];
+	struct sockaddr_in addr;
+	struct hostent* host;	
+
+#ifdef _CVI_
+	WSADATA wsdata;
+	WSAStartup(MAKEWORD(2,2), &wsdata);	
+#endif
+	
+	d->hostname = strdup(hostname);
+	d->port = 1234;
+	d->profile = 0;
+	d->clock = clock;
+
+	host = gethostbyname(hostname);
+	if (host == NULL)
+		return -1;
+  
+	sock = socket(AF_INET, SOCK_STREAM, 0);
+	if (sock < 0)
+		return -2;
+
+	addr.sin_family = host->h_addrtype;
+	memcpy(&addr.sin_addr.s_addr, host->h_addr_list[0], host->h_length);
+	addr.sin_port = htons(d->port);
+
+	r = connect(sock, (struct sockaddr*)&addr, sizeof(addr));
+	if (r < 0)
+		return -3;
+
+	d->fd = sock;
+
+	/* check compatibility */
+	n = snprintf(buffer, sizeof(buffer), "REVISION");
+	r = msend(d->fd, buffer, n);
+	if (r < 0)
+		return r;
+	r = mrecv(d->fd, buffer, sizeof(buffer));
+	if (r < 0)
+		return r;
+	if (atoi(buffer) != REVISION)
+		return -EINVAL;
+
+	return 0;
+}
+
+
+int ad9956_set_frequency(struct ad9956 *d, double f)
+{
+	int r;
+	uint64 value = ftw(d->clock, f);
+
+	r = command(d->fd, "SET PCR%d 0x%llX", d->profile, value);
+	if (r < 0)
+		return r;
+
+	d->frequency = freq(d->clock, value);
+     
+	return 0;
+}
+
+
+int ad9956_get_frequency(struct ad9956 *d, double *f)
+{
+	int r, n;
+	uint64 value;
+	char buffer[256];
+
+	n = snprintf(buffer, sizeof(buffer), "GET PCR%d", d->profile);
+
+	r = msend(d->fd, buffer, n);
+	if (r < 0)
+		return r;
+
+	r = mrecv(d->fd, buffer, sizeof(buffer));
+	if (r < 0)
+		return r;
+
+	r = strtouint64(buffer, &value);
+	if (r < 0)
+		return r;
+
+	d->frequency = freq(d->clock, value);
+	if (f)
+		*f = d->frequency;
+
+	return 0;
+}
+     
+
+int ad9956_set_sweep_rate(struct ad9956 *d, double rate)
+{
+	int r;
+	uint64 value = ftw(d->clock, rate);
+	
+	r = command(d->fd, "SWEEP SET DFTW %lld", d->profile, value);
+	if (r < 0)
+		return r;
+
+	return 0;
+}
+
+
+int ad9956_sweep_start(struct ad9956 *d)
+{
+	int r;
+
+	r = command(d->fd, "SWEEP START");
+	if (r < 0)
+		return r;
+
+	return 0;
+}
+
+
+int ad9956_sweep_stop(struct ad9956 *d)
+{
+	int r;
+
+	r = command(d->fd, "SWEEP STOP");
+	if (r < 0)
+		return r;
+
+	return 0;
+}
diff -r 31093786d41d -r c700a2d38fb8 ad9956.h
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/ad9956.h	Mon Mar 31 17:03:38 2014 +0200
@@ -0,0 +1,22 @@
+#ifndef __AD9956_H__
+#define __AD9956_H__
+
+#define REVISION 1
+
+struct ad9956 {
+	char *hostname;
+	int port;
+	int profile;
+	int fd;
+	double clock;
+	double frequency;
+};
+
+int ad9956_init(struct ad9956 *d, const char *hostname, double clock);
+int ad9956_get_frequency(struct ad9956 *d, double *f);
+int ad9956_set_frequency(struct ad9956 *d, double f);
+int ad9956_set_sweep_rate(struct ad9956 *d, double rate);
+int ad9956_sweep_start(struct ad9956 *d);
+int ad9956_sweep_stop(struct ad9956 *d);
+
+#endif
diff -r 31093786d41d -r c700a2d38fb8 dds.c
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/dds.c	Mon Mar 31 17:03:38 2014 +0200
@@ -0,0 +1,76 @@
+#ifdef _CVI_
+#include <winsock2.h>
+#include <ansi_c.h>
+#else
+#include <stdio.h>
+#include <stdlib.h>
+#include <unistd.h>
+#include <errno.h>
+#include <string.h>
+#include <sys/types.h>
+#include <sys/socket.h>
+#include <netinet/in.h>
+#include <arpa/inet.h>
+#include <netdb.h>
+#include <ctype.h>
+#include <math.h>
+#include <stdarg.h>
+#endif
+
+#include "dds.h"
+
+int msend(int fd, char *buffer, int n)
+{
+	int r;
+
+	buffer[n++] = '\r';
+	buffer[n++] = '\n';
+
+	r = send(fd, buffer, n, 0);
+	if (r < 0)
+		return r;     
+
+	return 0;
+}
+
+
+int mrecv(int fd, char *buffer, int len)
+{
+	int n;
+
+	n = recv(fd, buffer, len, 0);
+	if (n < 0)
+		return n;
+
+	if ((buffer[--n] != '\n') || (buffer[--n] != '\r'))
+		return -1;
+
+	buffer[n] = '\0';
+
+	return n;
+}
+
+
+int command(int fd, char *frmt, ...)
+{
+	int r, n;
+	char buffer[1024];
+	va_list v;
+
+	va_start(v, frmt);
+	n = vsnprintf(buffer, sizeof(buffer) - 2, frmt, v);
+	va_end(v);
+
+	r = msend(fd, buffer, n);
+	if (r < 0)
+		return r;
+
+	r = mrecv(fd, buffer, sizeof(buffer));
+	if (r < 0)
+		return r;
+
+	if (! streq(buffer, "OK"))
+		return -1;
+
+	return 0;
+}
diff -r 31093786d41d -r c700a2d38fb8 dds.h
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/dds.h	Mon Mar 31 17:03:38 2014 +0200
@@ -0,0 +1,36 @@
+#ifndef __FXANALYSE_DDS_H__
+#define __FXANALYSE_DDS_H__
+
+#define usleep(t) Delay((t) / 1000000.0)
+#define strdup(s) StrDup(s)
+#define streq(x, y) (strcmp((x), (y)) == 0)
+
+typedef unsigned long long uint64;
+
+static inline uint64 ftw(double clock, double freq)
+{
+	uint64 ftw = freq * ((double)(1ULL << 48) / clock);
+	return ftw;
+}
+
+static inline double freq(double clock, uint64 ftw)
+{
+	double freq = (double)ftw * (clock / (double)(1ULL << 48));
+	return freq;
+}
+
+static inline int strtouint64(const char *str, uint64 *v)
+{
+	char *end;
+	*v = strtoull(str, &end, 0);
+	if (*end != '\0')
+		return -1;
+	return 0;
+}
+
+int msend(int fd, char *buffer, int n);
+int mrecv(int fd, char *buffer, int len);
+int command(int fd, char *frmt, ...);
+
+#endif
+