Mercurial > hg > fxanalyse
diff ad9912.c @ 196:87dae6d62a61
New AD9912 client code to communicate with improved server code
author | Daniele Nicolodi <daniele.nicolodi@obspm.fr> |
---|---|
date | Mon, 31 Mar 2014 17:03:32 +0200 |
parents | |
children | f8118b90490e |
line wrap: on
line diff
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/ad9912.c Mon Mar 31 17:03:32 2014 +0200 @@ -0,0 +1,242 @@ +#ifdef _CVI_ +#include <ansi_c.h> +#include <toolbox.h> +#include <tcpsupp.h> +#define TIMEOUT 0 +#define send(fd, buf, len, f) ClientTCPWrite(fd, buf, len, TIMEOUT) +#define recv(fd, buf, len, f) ClientTCPRead(fd, buf, len, TIMEOUT) +#define usleep(t) Delay(t / 1000000.0) +#define strdup(s) StrDup(s) +#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 "ad9912.h" + +#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)(1 << 48) / clock); + ftw = ftw & ~1ULL; + 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; +} + + +static 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; +} + + +static 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; +} + + +static 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; +} + + +int ad9912_init(struct ad9912 *d, const char *hostname, double clock) +{ + int n, r; + char buffer[256]; + + d->hostname = StrDup(hostname); + d->port = 1234; + d->clock = clock; + +#ifdef _CVI_ + unsigned int sock; + r = ConnectToTCPServer(&sock, d->port, d->hostname, NULL, NULL, TIMEOUT); + if (r < 0) + return -1; +#else + int sock; + struct sockaddr_in addr; + struct hostent* host; + + 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(port); + + r = connect(sock, (struct sockaddr*)&addr, sizeof(addr)); + if (r < 0) + return -3; +#endif + + 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 -1; + + return 0; +} + + +int ad9912_set_frequency(struct ad9912 *d, unsigned channel, double f) +{ + int r; + uint64 value = ftw(d->clock, f); + + r = command(d->fd, "SET CH%d:FTW0 0x%llX", channel, f); + if (r < 0) + return r; + + d->frequency[channel] = freq(d->clock, value); + + return 0; +} + + +int ad9912_get_frequency(struct ad9912 *d, unsigned channel, double *f) +{ + int r, n; + uint64 value; + char buffer[256]; + + n = snprintf(buffer, sizeof(buffer), "GET CH%d:FTW0", channel); + + 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[channel] = freq(d->clock, value); + if (f) + *f = d->frequency[channel]; + + return 0; +} + + +/** + * Ramp DDS frequency from @f1 to @f2 in steps @fstep with 0.01 + * seconds delay after each step. + */ +int ad9912_ramp_frequency2(struct ad9912 *d, unsigned channel, double f1, double f2, double fstep) +{ + const int delay = 10000; + + /* f2 > f1 */ + while ((f2 - f1) > fstep) { + f1 += fstep; + ad9912_set_frequency(d, channel, f1); + usleep(delay); + } + + /* f2 < f1 */ + while ((f1 - f2) > fstep) { + f1 -= fstep; + ad9912_set_frequency(d, channel, f1); + usleep(delay); + } + + /* final adjustment */ + ad9912_set_frequency(d, channel, f2); + return 0; +} + + +int ad9912_ramp_frequency(struct ad9912 *d, unsigned channel, double f, double fstep) +{ + return ad9912_ramp_frequency2(d, channel, d->frequency[channel], f, fstep); +}