Mercurial > hg > fxanalyse
view ad9912.c @ 240:7fd5cb857d07
Add data pubblication through ZMQ socket
author | Daniele Nicolodi <daniele.nicolodi@obspm.fr> |
---|---|
date | Thu, 12 Feb 2015 19:46:54 +0100 |
parents | 9e0c3541104b |
children | 5296f3bcd160 |
line wrap: on
line source
#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 "ad9912.h" int ad9912_init(struct ad9912 *d, const char *hostname, double clock) { int n, r; char buffer[256]; int sock; 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->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 -1; return 0; } int ad9912_set_frequency(struct ad9912 *d, unsigned channel, double f) { int r; uint64 value = ftw(d->clock, f); /* ad9912 ignores ftw last bit */ value = value & ~1ULL; r = command(d->fd, "SET CH%d:FTW0 0x%llX", channel, value); 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); }