[rigol] / rigol.c

/*
Sprite_tms hack to communicate with a Rigol DS1000-series scope using Linux. 
This code is licensed under the GPL V3.

Warning: This code can in theory fubar the communications with the scope to a
point where the Linux USB-stack seems to get confused. Do a 
rmmod uhci_hcd; modprobe uhci_hcd
(or alternately: use ohci_hcd) if that happens and you should be fine.
*/

#include <usb.h>
#include <stdlib.h>
#include <stdio.h>
#include <string.h>
#include <sys/stat.h>
#include <fcntl.h>
#include <unistd.h>

#include <readline/readline.h>
#include <readline/history.h>


unsigned char seq=0;

//This routine locates a scope by VID/PID and returns an opened handle to it.
usb_dev_handle *find_scope() {
    struct usb_bus *bus;
    struct usb_device *dev=NULL;
    usb_find_busses();
    usb_find_devices();
    for (bus=usb_busses; bus; bus=bus->next) {
	for (dev=bus->devices; dev; dev=dev->next) {
//	    fprintf(stderr,"Prod/dev: %04X:%04X\n",dev->descriptor.idVendor,dev->descriptor.idProduct);
	    if (dev->descriptor.idVendor==0x400 && dev->descriptor.idProduct==0x5dc) {
		return usb_open(dev);
	    }
	}
    }
    return NULL;
}

//Helper-routine: Convert a little-endian 4-byte word to an int
void int2chars(unsigned char *buff,unsigned int a) {
    buff[3]=(a>>24)&0xff;
    buff[2]=(a>>16)&0xff;
    buff[1]=(a>>8)&0xff;
    buff[0]=(a)&0xff;
}

//Helper-routine: Convert an int to  little-endian 4-byte word
unsigned int chars2int(unsigned char *buff) {
    unsigned int a;
    a=buff[3]<<24;
    a+=buff[2]<<16;
    a+=buff[1]<<8;
    a+=buff[0];
    return a;
}

#define MIN(a,b) (((a)<(b))?(a):(b))

inline char printable (char ch)
{
  if (ch < ' ') return '.';
  if (ch > '~') return '.';
  return ch;
}

//Debugging: Print a buffers contents in hex
void printb (unsigned char *pkt, int len)
{
  int i, j;

  for (i=0;i<len;i+= 16) {
    printf ("%04x:  ", i);
    for (j=0;j < MIN(len-i, 16);j++) {
      printf (" %02x", pkt[i+j]);
      if (j == 7) printf ("  ");
    }
    if (j < 7) printf ("  ");
    for (;j<17;j++)
      printf ("   ");

    for (j=0;j < MIN(len-i, 16);j++) {
      printf ("%c", printable (pkt[i+j]));
    }
    printf ("\n");
  }
}

//Send a scpi-command to the scope. The response goes into the buffer
//called resp, with a size of resplen. If resp==NULL, no response
//is requested.
int sendscpi(usb_dev_handle *dev, char* cmd, 
             unsigned char *resp, int resplen) {
    unsigned char *buff;
    int len,r,i;
    int cmdlen = strlen(cmd);

    buff=malloc(0x40);
    seq++;
    buff[0]=1; //func
    buff[1]=seq; buff[2]=~seq; //nseq
    buff[3]=0;
    int2chars(buff+4, cmdlen);
    buff[8]=1;
    buff[9]=0x37;
    buff[10]=0x39;
    buff[11]=0x39;
    //    fprintf(stderr,"Writing header len=%d\n", cmdlen);
//    printb(buff,12);
    r=usb_bulk_write(dev, 1, (char*)buff, 12, 1000);
//    fprintf(stderr,"%i bytes written. Writing cmd\n",r);
//    printb(cmd, cmdlen);
    r=usb_bulk_write(dev, 1, cmd, cmdlen, 1000);
//    fprintf(stderr,"%i bytes written.\n",r);
    if (resp != NULL && resplen != 0) {
	//send read command
	buff[0]=2; //func
	seq++;
	buff[1]=seq; buff[2]=~seq; //nseq
	int2chars(buff+4,0x40);
	buff[8]=1;
	buff[9]=0xA;
	buff[10]=0;
	buff[11]=0;
//	fprintf(stderr,"Writing resp req header\n");
//	printb(buff,12);
	r=usb_bulk_write(dev, 1, (char*)buff, 12, 1000);
//	fprintf(stderr,"%i bytes written. Reading response hdr\n",r);
	r=usb_bulk_read(dev, 2, (char*)buff, 0x40, 1000);
//	printb(buff,r);
	len=chars2int(buff+4);
	//	fprintf(stderr,"%i bytes read. Resplen=%i\n",r,len);
	for (i=0; i<(r-12); i++) {
	    if (i<resplen) resp[i] = buff[i+12];
	}
//	printb(resp,r-12);
	if (len > 0x40-12) {
//	    fprintf(stderr," Reading response:\n");
	    if (resplen<len) len=resplen;
	    r=usb_bulk_read(dev, 2, (char*)resp+(0x40-12), len-(0x40-12),1000);
	    //	    fprintf(stderr,"%i bytes read, wanted %i.\n", r, len-(0x40-12));
	    return r+(0x40-12);
	}
	return len;
    }
    return 0;
}

//Initialize the scope.
void initscope(usb_dev_handle *dev) {
    int r;
    unsigned char buff[10];
    usb_claim_interface(dev,0);
    //The following code isn't really necessary, the program works
    //OK without it too.
    r=usb_control_msg(dev, 0xC8, 9, 0, 0, (char*)buff, 4, 1000);
    if (r < 0) {
        fprintf (stderr, "Error %d sending init message: %s\n", 
		r, strerror (-r));
        fprintf (stderr, "Do you have permission on the USB device?\n");
	exit (1);
    }
    if (chars2int(buff)!=0x40004dc) {
	fprintf(stderr,"Init: buff[%i]=%x\n",r,chars2int(buff));
    }
    return;
}

#define HAVE_READLINE
#ifndef HAVE_READLINE

char *readline (prompt)
{
  char *buf;

  printf (prompt); 
  fflush (stdout); 
  buf = malloc (1024); 
  
  if (fgets (buf, 1023, stdin) == NULL) {
    free (buf); 
    return NULL; 
  }
  l = strlen (buf); 
  if (buf[l-1] == '\n') {
    buf[l] = 0;
  }
  return buf; 
}

void add_history (char *buf)
{
}
#endif


void do_plot (struct usb_dev_handle *sc)
{
  unsigned char ch1[1024], ch2[1024];
  int i, l;

  static FILE *gnuplot=NULL;
  FILE *fp;

  l = sendscpi(sc, ":WAV:DATA? CHANEL1", ch1, 1024);

  if (l != 1024) {
    printf ("hmm. didnt' get 1024 bytes. \n"); 
  }

  l = sendscpi(sc, ":WAV:DATA? CHANNEL2", ch2, 1024);

  if (l != 1024) {
    printf ("hmm. didnt' get 1024 bytes. \n"); 
  }

  if (!gnuplot) {
    gnuplot = popen ("gnuplot", "w"); 
  }

  fp = fopen ("temp.dat", "w");
  for (i=0xd4;i<0x32c;i++)
    //  for (i=0;i<0x400;i++)
    fprintf (fp, "%d %d\n", 255 - ch1[i], 255 - ch2[i]);
  fclose (fp); 

  fprintf (gnuplot, "plot 'temp.dat' using 1 with lines, 'temp.dat' using 2 with lines\n");
  fflush (gnuplot);
}


#define ERROR -1e100

double get_float_from_scope (struct usb_dev_handle *sc, char *var)
{
  unsigned char buf[1024];
  double temp;
  int l;

  l = sendscpi(sc, var, buf, 1024);
  if (l > 0) {
    sscanf ((char*)buf, "%lf", &temp); 
    return temp;
  }
  return ERROR;
}


void do_get_buf (struct usb_dev_handle *sc)
{
  FILE *fp;
  int i, j, l, bp;
  char buf[1024];
  unsigned char ch1[1024];
  unsigned char data[512*1024];
  double sampfreq;

  sendscpi (sc, ":STOP", NULL, 0); 

  sampfreq = get_float_from_scope (sc, ":ACQ:SAMP?");

  printf ("Got sampling freq: %g\n", sampfreq);  

  sprintf (buf, ":TIM:SCAL %.15f", 50 / sampfreq);
  printf ("sending scale cmd: %s\n", buf); 
  sendscpi (sc, buf, NULL, 0);

  sleep (1);

  bp=0;
  for (i=-254*1024;i< 254*1024;i += 600) {
    sprintf (buf, ":TIM:OFFSET %.15f", i / sampfreq);
    printf ("Sending offset cmd:  %s\n", buf); 
    sendscpi (sc, buf, NULL, 0);

    l = sendscpi(sc, ":WAV:DATA? CHANEL1", ch1, 1024);

    if (l != 1024) {
      printf ("hmm. didnt' get 1024 bytes. \n"); 
    }
    
    for (j=0;j<600;j++)
      data[bp++] = ch1[j+0xd4];
  }
  printf ("Got %d bytes of data. \n", bp);

  fp = fopen ("ch1.dump", "w");
  fwrite (data, bp, 1, fp);
  fclose (fp); 

  sendscpi (sc, ":TIM:OFFSET 0", NULL, 0);
}


int main(int argc, char **argv) 
{
  struct usb_dev_handle *sc;
  char *scpi;
  unsigned char *buff;
  int l;
  //Init libusb
  usb_init();
  //Locate and open the scope
  sc=find_scope();
  if (!sc) {
    printf("No scope found.\n");
    exit(1);
  } else {
    printf("Scope found.\n");
  }
  //Initialize scope
  initscope(sc);
  buff = malloc (1024*1024); 
  while (1) {
    scpi = readline ("> ");

    if (!scpi) break;
    if (strlen (scpi) == 0) {
      free (scpi); 
      continue;
    }
    
    add_history (scpi); 

    if (strncmp (scpi, "quit", 4) == 0) break;
    if (strncmp (scpi, "plot", 4) == 0) {
      do_plot (sc);
      continue;
    }
    if (strncmp (scpi, "databuf", 4) == 0) {
      do_get_buf (sc);
      continue;
    }

    l = strlen (scpi); 
    //       printf ("got buf(%d): ", l); 
    //       printb (scpi, l+2); 
    if (strchr (scpi, '?')) {
      //	printf ("Expecting reply\n");
      l = sendscpi(sc, scpi, buff, 1024*1024);
      //          printf ("Got replylen = %d.\n", l); 
      buff[l] = 0; //zero-terminate
      printb (buff, l);
    } else {
      //	printf ("No reply expected\n");
      l=sendscpi(sc,scpi,NULL,0);
    }
    free (scpi);
  }
  //Disable keylock, so the user doesn't have to press the 'force'-button
  l=sendscpi(sc, ":KEY:LOCK DISABLE",NULL,0); 
  
  //Free up and exit
  usb_release_interface(sc,0);
  usb_close(sc);
  return 0;
}
Commit	Line	Data
037166c1 MG	1	/*
	2	Sprite_tms hack to communicate with a Rigol DS1000-series scope using Linux.
	3	This code is licensed under the GPL V3.
	4
	5	Warning: This code can in theory fubar the communications with the scope to a
	6	point where the Linux USB-stack seems to get confused. Do a
	7	rmmod uhci_hcd; modprobe uhci_hcd
	8	(or alternately: use ohci_hcd) if that happens and you should be fine.
	9	*/
	10
	11	#include <usb.h>
	12	#include <stdlib.h>
	13	#include <stdio.h>
	14	#include <string.h>
	15	#include <sys/stat.h>
	16	#include <fcntl.h>
	17	#include <unistd.h>
	18
	19	#include <readline/readline.h>
	20	#include <readline/history.h>
	21
	22
	23	unsigned char seq=0;
	24
	25	//This routine locates a scope by VID/PID and returns an opened handle to it.
	26	usb_dev_handle *find_scope() {
	27	struct usb_bus *bus;
	28	struct usb_device *dev=NULL;
	29	usb_find_busses();
	30	usb_find_devices();
	31	for (bus=usb_busses; bus; bus=bus->next) {
	32	for (dev=bus->devices; dev; dev=dev->next) {
	33	// fprintf(stderr,"Prod/dev: %04X:%04X\n",dev->descriptor.idVendor,dev->descriptor.idProduct);
	34	if (dev->descriptor.idVendor==0x400 && dev->descriptor.idProduct==0x5dc) {
	35	return usb_open(dev);
	36	}
	37	}
	38	}
	39	return NULL;
	40	}
	41
	42	//Helper-routine: Convert a little-endian 4-byte word to an int
	43	void int2chars(unsigned char *buff,unsigned int a) {
	44	buff[3]=(a>>24)&0xff;
	45	buff[2]=(a>>16)&0xff;
	46	buff[1]=(a>>8)&0xff;
	47	buff[0]=(a)&0xff;
	48	}
	49
	50	//Helper-routine: Convert an int to little-endian 4-byte word
	51	unsigned int chars2int(unsigned char *buff) {
	52	unsigned int a;
	53	a=buff[3]<<24;
	54	a+=buff[2]<<16;
	55	a+=buff[1]<<8;
	56	a+=buff[0];
	57	return a;
	58	}
	59
	60	#define MIN(a,b) (((a)<(b))?(a):(b))
	61
	62	inline char printable (char ch)
	63	{
	64	if (ch < ' ') return '.';
65	if (ch > '~') return '.';
66	return ch;
67	}
68
69	//Debugging: Print a buffers contents in hex
70	void printb (unsigned char *pkt, int len)
71	{
72	int i, j;
73
74	for (i=0;i<len;i+= 16) {
75	printf ("%04x: ", i);
76	for (j=0;j < MIN(len-i, 16);j++) {
77	printf (" %02x", pkt[i+j]);
78	if (j == 7) printf (" ");
79	}
80	if (j < 7) printf (" ");
81	for (;j<17;j++)
82	printf (" ");
83
84	for (j=0;j < MIN(len-i, 16);j++) {
85	printf ("%c", printable (pkt[i+j]));
86	}
87	printf ("\n");
88	}
89	}
90
91	//Send a scpi-command to the scope. The response goes into the buffer
92	//called resp, with a size of resplen. If resp==NULL, no response
93	//is requested.
1c832d05	94	int sendscpi(usb_dev_handle dev, char cmd,
037166c1	95	unsigned char *resp, int resplen) {
1c832d05	96	unsigned char *buff;
037166c1	97	int len,r,i;
1c832d05 MG	98	int cmdlen = strlen(cmd);
1c832d05 MG	99
037166c1 MG	100	buff=malloc(0x40);
	101	seq++;
	102	buff[0]=1; //func
	103	buff[1]=seq; buff[2]=~seq; //nseq
	104	buff[3]=0;
1c832d05	105	int2chars(buff+4, cmdlen);
037166c1 MG	106	buff[8]=1;
	107	buff[9]=0x37;
	108	buff[10]=0x39;
	109	buff[11]=0x39;
1c832d05	110	// fprintf(stderr,"Writing header len=%d\n", cmdlen);
037166c1	111	// printb(buff,12);
1c832d05	112	r=usb_bulk_write(dev, 1, (char*)buff, 12, 1000);
037166c1	113	// fprintf(stderr,"%i bytes written. Writing cmd\n",r);
1c832d05 MG	114	// printb(cmd, cmdlen);
1c832d05 MG	115	r=usb_bulk_write(dev, 1, cmd, cmdlen, 1000);
037166c1 MG	116	// fprintf(stderr,"%i bytes written.\n",r);
	117	if (resp != NULL && resplen != 0) {
	118	//send read command
	119	buff[0]=2; //func
	120	seq++;
	121	buff[1]=seq; buff[2]=~seq; //nseq
	122	int2chars(buff+4,0x40);
	123	buff[8]=1;
	124	buff[9]=0xA;
	125	buff[10]=0;
	126	buff[11]=0;
	127	// fprintf(stderr,"Writing resp req header\n");
	128	// printb(buff,12);
1c832d05	129	r=usb_bulk_write(dev, 1, (char*)buff, 12, 1000);
037166c1	130	// fprintf(stderr,"%i bytes written. Reading response hdr\n",r);
1c832d05	131	r=usb_bulk_read(dev, 2, (char*)buff, 0x40, 1000);
037166c1 MG	132	// printb(buff,r);
	133	len=chars2int(buff+4);
	134	// fprintf(stderr,"%i bytes read. Resplen=%i\n",r,len);
	135	for (i=0; i<(r-12); i++) {
	136	if (i<resplen) resp[i] = buff[i+12];
	137	}
	138	// printb(resp,r-12);
	139	if (len > 0x40-12) {
	140	// fprintf(stderr," Reading response:\n");
	141	if (resplen<len) len=resplen;
1c832d05	142	r=usb_bulk_read(dev, 2, (char*)resp+(0x40-12), len-(0x40-12),1000);
037166c1 MG	143	// fprintf(stderr,"%i bytes read, wanted %i.\n", r, len-(0x40-12));
	144	return r+(0x40-12);
	145	}
	146	return len;
	147	}
	148	return 0;
	149	}
	150
	151	//Initialize the scope.
	152	void initscope(usb_dev_handle *dev) {
	153	int r;
1c832d05	154	unsigned char buff[10];
037166c1 MG	155	usb_claim_interface(dev,0);
	156	//The following code isn't really necessary, the program works
	157	//OK without it too.
1c832d05	158	r=usb_control_msg(dev, 0xC8, 9, 0, 0, (char*)buff, 4, 1000);
037166c1 MG	159	if (r < 0) {
	160	fprintf (stderr, "Error %d sending init message: %s\n",
	161	r, strerror (-r));
	162	fprintf (stderr, "Do you have permission on the USB device?\n");
	163	exit (1);
	164	}
	165	if (chars2int(buff)!=0x40004dc) {
	166	fprintf(stderr,"Init: buff[%i]=%x\n",r,chars2int(buff));
	167	}
	168	return;
	169	}
	170
	171	#define HAVE_READLINE
	172	#ifndef HAVE_READLINE
	173
	174	char *readline (prompt)
	175	{
	176	char *buf;
	177
	178	printf (prompt);
	179	fflush (stdout);
	180	buf = malloc (1024);
	181
	182	if (fgets (buf, 1023, stdin) == NULL) {
	183	free (buf);
	184	return NULL;
	185	}
	186	l = strlen (buf);
	187	if (buf[l-1] == '\n') {
	188	buf[l] = 0;
	189	}
	190	return buf;
	191	}
	192
	193	void add_history (char *buf)
	194	{
	195	}
	196	#endif
	197
	198
	199	void do_plot (struct usb_dev_handle *sc)
	200	{
	201	unsigned char ch1[1024], ch2[1024];
	202	int i, l;
	203
	204	static FILE *gnuplot=NULL;
	205	FILE *fp;
	206
	207	l = sendscpi(sc, ":WAV:DATA? CHANEL1", ch1, 1024);
	208
	209	if (l != 1024) {
	210	printf ("hmm. didnt' get 1024 bytes. \n");
	211	}
	212
	213	l = sendscpi(sc, ":WAV:DATA? CHANNEL2", ch2, 1024);
	214
	215	if (l != 1024) {
	216	printf ("hmm. didnt' get 1024 bytes. \n");
	217	}
	218
	219	if (!gnuplot) {
	220	gnuplot = popen ("gnuplot", "w");
	221	}
	222
223	fp = fopen ("temp.dat", "w");
224	for (i=0xd4;i<0x32c;i++)
225	// for (i=0;i<0x400;i++)
226	fprintf (fp, "%d %d\n", 255 - ch1[i], 255 - ch2[i]);
227	fclose (fp);
228
229	fprintf (gnuplot, "plot 'temp.dat' using 1 with lines, 'temp.dat' using 2 with lines\n");
230	fflush (gnuplot);
231	}
232
233
234	#define ERROR -1e100
235
236	double get_float_from_scope (struct usb_dev_handle sc, char var)
237	{
238	unsigned char buf[1024];
239	double temp;
240	int l;
241
242	l = sendscpi(sc, var, buf, 1024);
243	if (l > 0) {
1c832d05	244	sscanf ((char*)buf, "%lf", &temp);
037166c1 MG	245	return temp;
	246	}
	247	return ERROR;
	248	}
	249
	250
	251	void do_get_buf (struct usb_dev_handle *sc)
	252	{
	253	FILE *fp;
	254	int i, j, l, bp;
1c832d05 MG	255	char buf[1024];
1c832d05 MG	256	unsigned char ch1[1024];
037166c1 MG	257	unsigned char data[512*1024];
	258	double sampfreq;
	259
	260	sendscpi (sc, ":STOP", NULL, 0);
	261
	262	sampfreq = get_float_from_scope (sc, ":ACQ:SAMP?");
	263
	264	printf ("Got sampling freq: %g\n", sampfreq);
	265
	266	sprintf (buf, ":TIM:SCAL %.15f", 50 / sampfreq);
	267	printf ("sending scale cmd: %s\n", buf);
	268	sendscpi (sc, buf, NULL, 0);
	269
	270	sleep (1);
	271
	272	bp=0;
	273	for (i=-2541024;i< 2541024;i += 600) {
	274	sprintf (buf, ":TIM:OFFSET %.15f", i / sampfreq);
	275	printf ("Sending offset cmd: %s\n", buf);
	276	sendscpi (sc, buf, NULL, 0);
	277
	278	l = sendscpi(sc, ":WAV:DATA? CHANEL1", ch1, 1024);
	279
	280	if (l != 1024) {
	281	printf ("hmm. didnt' get 1024 bytes. \n");
	282	}
	283
	284	for (j=0;j<600;j++)
	285	data[bp++] = ch1[j+0xd4];
	286	}
	287	printf ("Got %d bytes of data. \n", bp);
	288
	289	fp = fopen ("ch1.dump", "w");
	290	fwrite (data, bp, 1, fp);
	291	fclose (fp);
	292
	293	sendscpi (sc, ":TIM:OFFSET 0", NULL, 0);
	294	}
	295
	296
	297
	298	int main(int argc, char **argv)
	299	{
	300	struct usb_dev_handle *sc;
1c832d05 MG	301	char *scpi;
1c832d05 MG	302	unsigned char *buff;
037166c1 MG	303	int l;
	304	//Init libusb
	305	usb_init();
	306	//Locate and open the scope
	307	sc=find_scope();
	308	if (!sc) {
	309	printf("No scope found.\n");
	310	exit(1);
	311	} else {
	312	printf("Scope found.\n");
	313	}
	314	//Initialize scope
	315	initscope(sc);
	316	buff = malloc (1024*1024);
	317	while (1) {
	318	scpi = readline ("> ");
	319
	320	if (!scpi) break;
	321	if (strlen (scpi) == 0) {
	322	free (scpi);
	323	continue;
	324	}
	325
	326	add_history (scpi);
	327
	328	if (strncmp (scpi, "quit", 4) == 0) break;
	329	if (strncmp (scpi, "plot", 4) == 0) {
	330	do_plot (sc);
	331	continue;
	332	}
	333	if (strncmp (scpi, "databuf", 4) == 0) {
	334	do_get_buf (sc);
	335	continue;
	336	}
	337
	338	l = strlen (scpi);
	339	// printf ("got buf(%d): ", l);
	340	// printb (scpi, l+2);
	341	if (strchr (scpi, '?')) {
	342	// printf ("Expecting reply\n");
	343	l = sendscpi(sc, scpi, buff, 1024*1024);
	344	// printf ("Got replylen = %d.\n", l);
	345	buff[l] = 0; //zero-terminate
	346	printb (buff, l);
	347	} else {
	348	// printf ("No reply expected\n");
	349	l=sendscpi(sc,scpi,NULL,0);
	350	}
	351	free (scpi);
	352	}
	353	//Disable keylock, so the user doesn't have to press the 'force'-button
	354	l=sendscpi(sc, ":KEY:LOCK DISABLE",NULL,0);
	355
	356	//Free up and exit
	357	usb_release_interface(sc,0);
	358	usb_close(sc);
	359	return 0;
	360	}