Skip to content

wattsworth / ethstream

Go to a project
Commit 0ed2935d by zacharyc
Options

Better command structure using hton, ntoh, and friends 

Altered command structure to support full 20 bit period


git-svn-id: https://bucket.mit.edu/svn/nilm/acquisition/ethstream@7282 ddd99763-3ecb-0310-9145-efcb8ce7c51f
parent 1a2ed51d
Inline Side-by-side
Showing with 64 additions and 27 deletions
ethstream.c
...@@ -360,26 +360,26 @@ int nerdDoStream(const char *address, int *channel_list, int channel_count, int ...@@ -360,26 +360,26 @@ int nerdDoStream(const char *address, int *channel_list, int channel_count, int
int fd_data; int fd_data;
static int first_call = 1; static int first_call = 1;
static int started = 0; static int started = 0;
char command[14]; getPacket command;
static unsigned short currentcount = 0; static unsigned short currentcount = 0;
usleep(1000000); //usleep(1000000);
if(first_call) { if(first_call) {
if (nerd_generate_command(command, channel_list, channel_count, precision, period) < 0) { if (nerd_generate_command(&command, channel_list, channel_count, precision, period) < 0) {
info("Failed to create configuration command\n"); info("Failed to create configuration command\n");
goto out; goto out;
} }
if (nerd_send_command(address,"STOP") < 0) { if (nerd_send_command(address,"STOP", 4) < 0) {
if (first_call) if (first_call)
retval = -ENOTCONN; retval = -ENOTCONN;
info("Failed to send STOP command\n"); info("Failed to send STOP command\n");
goto out; goto out;
} }
if (nerd_send_command(address,command) < 0) { if (nerd_send_command(address,&command, sizeof(command)) < 0) {
info("Failed to send GET command\n"); info("Failed to send GET command\n");
goto out; goto out;
} }
...@@ -392,7 +392,7 @@ int nerdDoStream(const char *address, int *channel_list, int channel_count, int ...@@ -392,7 +392,7 @@ int nerdDoStream(const char *address, int *channel_list, int channel_count, int
if(started == 1) { if(started == 1) {
char cmdbuf[10]; char cmdbuf[10];
sprintf(cmdbuf,"SETC%05hd",currentcount); sprintf(cmdbuf,"SETC%05hd",currentcount);
if (nerd_send_command(address,cmdbuf) < 0) { if (nerd_send_command(address,cmdbuf,strlen(cmdbuf)) < 0) {
info("Failed to send SETC command\n"); info("Failed to send SETC command\n");
goto out; goto out;
} }
......
nerdjack.c
...@@ -33,6 +33,16 @@ typedef struct { ...@@ -33,6 +33,16 @@ typedef struct {
int * destlist; int * destlist;
} deststruct; } deststruct;
typedef struct __attribute__((__packed__)) {
unsigned char headerone;
unsigned char headertwo;
unsigned short packetNumber;
unsigned long lwipmemoryused;
unsigned short adcused;
unsigned short packetsready;
signed short data[NERDJACK_NUM_SAMPLES];
} dataPacket;
/* Choose the best ScanConfig and ScanInterval parameters for the /* Choose the best ScanConfig and ScanInterval parameters for the
desired scanrate. Returns -1 if no valid config found */ desired scanrate. Returns -1 if no valid config found */
int nerdjack_choose_scan(double desired_rate, double *actual_rate, int *period) int nerdjack_choose_scan(double desired_rate, double *actual_rate, int *period)
...@@ -126,7 +136,7 @@ int nerdjack_detect(char * ipAddress) { ...@@ -126,7 +136,7 @@ int nerdjack_detect(char * ipAddress) {
return 0; return 0;
} }
int nerd_send_command(const char * address, char * command) int nerd_send_command(const char * address, void * command, int length)
{ {
int ret,fd_command; int ret,fd_command;
char buf[3]; char buf[3];
...@@ -137,9 +147,9 @@ int nerd_send_command(const char * address, char * command) ...@@ -137,9 +147,9 @@ int nerd_send_command(const char * address, char * command)
} }
/* Send request */ /* Send request */
ret = send_all_timeout(fd_command, command, strlen(command), 0, ret = send_all_timeout(fd_command, command, length, 0,
& (struct timeval) { .tv_sec = NERDJACK_TIMEOUT }); & (struct timeval) { .tv_sec = NERDJACK_TIMEOUT });
if (ret < 0 || ret != strlen(command)) { if (ret < 0 || ret != length) {
verb("short send %d\n", (int)ret); verb("short send %d\n", (int)ret);
return -1; return -1;
} }
...@@ -209,11 +219,12 @@ return numDuplicates; ...@@ -209,11 +219,12 @@ return numDuplicates;
int nerd_data_stream(int data_fd, int numChannels, int *channel_list, int precision, int convert, int lines, int showmem, unsigned short * currentcount) int nerd_data_stream(int data_fd, int numChannels, int *channel_list, int precision, int convert, int lines, int showmem, unsigned short * currentcount)
{ {
//Variables that should persist across retries //Variables that should persist across retries
static unsigned char buf[NERDJACK_PACKET_SIZE]; static dataPacket buf;
static int linesleft = 0; static int linesleft = 0;
static int linesdumped = 0; static int linesdumped = 0;
int index = 0; int index = 0;
int charsprocessed = 0;
int alignment = 0; int alignment = 0;
signed short datapoint = 0; signed short datapoint = 0;
unsigned short dataline[NERDJACK_CHANNELS]; unsigned short dataline[NERDJACK_CHANNELS];
...@@ -247,7 +258,7 @@ int nerd_data_stream(int data_fd, int numChannels, int *channel_list, int precis ...@@ -247,7 +258,7 @@ int nerd_data_stream(int data_fd, int numChannels, int *channel_list, int precis
//Loop forever to grab data //Loop forever to grab data
while((charsread = recv_all_timeout(data_fd,buf,NERDJACK_PACKET_SIZE,0, while((charsread = recv_all_timeout(data_fd,&buf,NERDJACK_PACKET_SIZE,0,
& (struct timeval) { .tv_sec = NERDJACK_TIMEOUT }))){ & (struct timeval) { .tv_sec = NERDJACK_TIMEOUT }))){
//We want a complete packet, so take the chars so far and keep waiting //We want a complete packet, so take the chars so far and keep waiting
...@@ -259,13 +270,14 @@ int nerd_data_stream(int data_fd, int numChannels, int *channel_list, int precis ...@@ -259,13 +270,14 @@ int nerd_data_stream(int data_fd, int numChannels, int *channel_list, int precis
} }
//First check the header info //First check the header info
if(buf[0] != 0xF0 || buf[1] != 0xAA) { if(buf.headerone != 0xF0 || buf.headertwo != 0xAA) {
info("No Header info\n"); info("No Header info\n");
return -1; return -1;
} }
//Check counter info to make sure not out of order //Check counter info to make sure not out of order
tempshort = (buf[2] << 8) | buf[3]; tempshort = ntohs(buf.packetNumber);
//tempshort = (buf[2] << 8) | buf[3];
if(tempshort != *currentcount ){ if(tempshort != *currentcount ){
info("Count wrong. Expected %hd but got %hd\n", *currentcount, tempshort); info("Count wrong. Expected %hd but got %hd\n", *currentcount, tempshort);
return -1; return -1;
...@@ -275,10 +287,13 @@ int nerd_data_stream(int data_fd, int numChannels, int *channel_list, int precis ...@@ -275,10 +287,13 @@ int nerd_data_stream(int data_fd, int numChannels, int *channel_list, int precis
*currentcount = *currentcount + 1; *currentcount = *currentcount + 1;
//Process the rest of the header and update the index value to be pointing after it //Process the rest of the header and update the index value to be pointing after it
index = 12; charsprocessed = 12;
memused = (buf[4] << 24) | (buf[5] << 16) | (buf[6] << 8) | (buf[7]); memused = ntohl(buf.lwipmemoryused);
adcused = (buf[8] << 8) | (buf[9]); //memused = (buf[4] << 24) | (buf[5] << 16) | (buf[6] << 8) | (buf[7]);
packetsready = (buf[10] << 8) | (buf[11]); adcused = ntohs(buf.adcused);
//adcused = (buf[8] << 8) | (buf[9]);
packetsready = ntohs(buf.packetsready);
//packetsready = (buf[10] << 8) | (buf[11]);
alignment = 0; alignment = 0;
numgroups = 0; numgroups = 0;
...@@ -287,10 +302,12 @@ int nerd_data_stream(int data_fd, int numChannels, int *channel_list, int precis ...@@ -287,10 +302,12 @@ int nerd_data_stream(int data_fd, int numChannels, int *channel_list, int precis
continue; continue;
} }
index = 0;
//While there is still more data in the packet, process it //While there is still more data in the packet, process it
//use the destination structure to load the line before printing //use the destination structure to load the line before printing
while(charsread > index) { while(charsread > charsprocessed) {
datapoint = (buf[index] << 8 | buf[index+1]); datapoint = ntohs(buf.data[index]);
//datapoint = (buf[index] << 8 | buf[index+1]);
switch(convert) { switch(convert) {
case CONVERT_VOLTS: case CONVERT_VOLTS:
if(alignment <= 5) { if(alignment <= 5) {
...@@ -313,7 +330,8 @@ int nerd_data_stream(int data_fd, int numChannels, int *channel_list, int precis ...@@ -313,7 +330,8 @@ int nerd_data_stream(int data_fd, int numChannels, int *channel_list, int precis
} }
//Each point is two bytes, so increment index and total bytes read //Each point is two bytes, so increment index and total bytes read
index++; charsprocessed++;
charsprocessed++;
index++; index++;
alignment++; alignment++;
//totalread++; //totalread++;
...@@ -368,6 +386,7 @@ int nerd_data_stream(int data_fd, int numChannels, int *channel_list, int precis ...@@ -368,6 +386,7 @@ int nerd_data_stream(int data_fd, int numChannels, int *channel_list, int precis
} }
} }
index = 0; index = 0;
charsprocessed = 0;
} }
return 0; return 0;
...@@ -425,17 +444,27 @@ int nerd_open(const char *address,int port) { ...@@ -425,17 +444,27 @@ int nerd_open(const char *address,int port) {
} }
//Generate an appropriate sample initiation command //Generate an appropriate sample initiation command
int nerd_generate_command(char * command, int * channel_list, int channel_count, int precision, int nerd_generate_command(getPacket * command, int * channel_list, int channel_count, int precision,
unsigned short period) { unsigned long period) {
int channelbit = 0; short channelbit = 0;
int i; int i;
for( i = 0; i < channel_count; i++) { for( i = 0; i < channel_count; i++) {
channelbit = channelbit | (0x1 << channel_list[i]); channelbit = channelbit | (0x1 << channel_list[i]);
} }
sprintf(command,"GETD%3.3X%d%5.5d", channelbit,precision,period); //command->word = "GETD";
command->word[0] = 'G';
command->word[1] = 'E';
command->word[2] = 'T';
command->word[3] = 'D';
command->channelbit = htons(channelbit);
command->precision = precision;
command->period = htonl(period);
command->prescaler = 0;
//sprintf(command,"GETD%3.3X%d%5.5d", channelbit,precision,period);
return 0; return 0;
......
nerdjack.h
...@@ -24,16 +24,24 @@ ...@@ -24,16 +24,24 @@
#define NERDJACK_PACKET_SIZE 1460 #define NERDJACK_PACKET_SIZE 1460
#define NERDJACK_NUM_SAMPLES 724 #define NERDJACK_NUM_SAMPLES 724
typedef struct __attribute__((__packed__)) {
char word[4];
unsigned short channelbit;
unsigned char precision;
unsigned long period;
unsigned char prescaler;
} getPacket;
/* Open/close TCP/IP connection to the NerdJack */ /* Open/close TCP/IP connection to the NerdJack */
int nerd_open(const char *address,int port); int nerd_open(const char *address,int port);
int nerd_close_conn(int data_fd); int nerd_close_conn(int data_fd);
/* Generate the command word for the NerdJack */ /* Generate the command word for the NerdJack */
int nerd_generate_command(char * command, int * channel_list, int channel_count, int precision, int nerd_generate_command(getPacket * command, int * channel_list, int channel_count, int precision,
unsigned short period); unsigned long period);
/* Send given command to NerdJack */ /* Send given command to NerdJack */
int nerd_send_command(const char * address, char * command); int nerd_send_command(const char * address, void * command, int length);
/* Stream data out of the NerdJack */ /* Stream data out of the NerdJack */
int nerd_data_stream(int data_fd, int numChannels, int * channel_list, int precision, int convert, int lines, int showmem, unsigned short * currentcount); int nerd_data_stream(int data_fd, int numChannels, int * channel_list, int precision, int convert, int lines, int showmem, unsigned short * currentcount);
......
Markdown is supported
0% or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or sign in to comment