Add serial port instrument support

1 files changed, 480 insertions, 0 deletions

diff --git a/servers/gpib_server_lin/src/scope_functions.cpp b/servers/gpib_server_lin/src/scope_functions.cpp
new file mode 100644
index 0000000..2d12f9b
--- /dev/null
+++ b/servers/gpib_server_lin/src/scope_functions.cpp
@@ -0,0 +1,480 @@
+/*
+ * Remote Laboratory Instrumentation Server
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 3 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License along
+ * with this program; if not, write to the Free Software Foundation, Inc.,
+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
+ *
+ * (c) 2009 Timothy Pearson
+ * Raptor Engineering
+ * http://www.raptorengineeringinc.com
+ */
+
+#include <ctype.h>
+#include <errno.h>
+#include <stdio.h>
+#include <unistd.h>
+#include <stdlib.h>
+#include <stdint.h>
+#include <string.h>
+#include <getopt.h>
+#include "parameters.h"
+#include "gpib_functions.h"
+#include "gpib/ib.h"
+
+#include <tqimage.h>
+
+extern char falpha[1024];
+unsigned char scope_raw_screenshot_data[4194304];
+
+unsigned long scopeScreenWidth (char * scopeType) {
+	if (strcmp("HP54600OS", scopeType) == 0) {
+		return 512;
+	}
+	else if (strcmp("TDS744AOS", scopeType) == 0) {
+		return 640;
+	}
+	else {
+		return 1;
+	}
+}
+
+unsigned long scopeScreenHeight (char * scopeType) {
+	if (strcmp("HP54600OS", scopeType) == 0) {
+		return 280;
+	}
+	else if (strcmp("TDS744AOS", scopeType) == 0) {
+		return 480;
+	}
+	else {
+		return 1;
+	}
+}
+
+unsigned long scopeScreenSize (char * scopeType) {
+	if (strcmp("HP54600OS", scopeType) == 0) {
+		return scopeScreenWidth(scopeType)*scopeScreenHeight(scopeType)*3;
+	}
+	else if (strcmp("TDS744AOS", scopeType) == 0) {
+		return scopeScreenWidth(scopeType)*scopeScreenHeight(scopeType)*3;
+	}
+	else {
+		return 1;
+	}
+}
+
+int gpib_read_binblock(int ud, int max_num_bytes, char * scopeType)
+{
+	char segarray[4194304];
+	long array_pointer;
+	long ai;
+
+	int x;
+	int y;
+
+	array_pointer = 0;
+
+	#ifdef ENABLE_EXTRA_DEBUGGING
+	printf("[DEBG] Trying to read %i bytes from GPIB device...\n", max_num_bytes);
+	#endif
+
+	ibtmo(ud, T30s);
+	ibeos(ud, 0x0);
+
+	ai = gpib_read_array(ud, max_num_bytes, segarray);
+	if (ai == -1) {
+		return 1;
+	}
+	else {
+		if (strcmp("HP54600OS", scopeType) == 0) {
+			ai = 0;
+			for (x=0;x<scopeScreenWidth(scopeType);x++) {
+				for (y=0;y<scopeScreenHeight(scopeType);y++) {
+					if ((x & 0x7) == 0) scope_raw_screenshot_data[y+(x*scopeScreenHeight(scopeType))] = (segarray[((x >> 3)+(y*(560/8)))+17] & 0x80) << 0;
+					if ((x & 0x7) == 1) scope_raw_screenshot_data[y+(x*scopeScreenHeight(scopeType))] = (segarray[((x >> 3)+(y*(560/8)))+17] & 0x40) << 1;
+					if ((x & 0x7) == 2) scope_raw_screenshot_data[y+(x*scopeScreenHeight(scopeType))] = (segarray[((x >> 3)+(y*(560/8)))+17] & 0x20) << 2;
+					if ((x & 0x7) == 3) scope_raw_screenshot_data[y+(x*scopeScreenHeight(scopeType))] = (segarray[((x >> 3)+(y*(560/8)))+17] & 0x10) << 3;
+					if ((x & 0x7) == 4) scope_raw_screenshot_data[y+(x*scopeScreenHeight(scopeType))] = (segarray[((x >> 3)+(y*(560/8)))+17] & 0x08) << 4;
+					if ((x & 0x7) == 5) scope_raw_screenshot_data[y+(x*scopeScreenHeight(scopeType))] = (segarray[((x >> 3)+(y*(560/8)))+17] & 0x04) << 5;
+					if ((x & 0x7) == 6) scope_raw_screenshot_data[y+(x*scopeScreenHeight(scopeType))] = (segarray[((x >> 3)+(y*(560/8)))+17] & 0x02) << 6;
+					if ((x & 0x7) == 7) scope_raw_screenshot_data[y+(x*scopeScreenHeight(scopeType))] = (segarray[((x >> 3)+(y*(560/8)))+17] & 0x01) << 7;
+					if (scope_raw_screenshot_data[y+(x*scopeScreenHeight(scopeType))] == 0x0) scope_raw_screenshot_data[y+(x*scopeScreenHeight(scopeType))] = 255;
+					if (scope_raw_screenshot_data[y+(x*scopeScreenHeight(scopeType))] == 0x80) scope_raw_screenshot_data[y+(x*scopeScreenHeight(scopeType))] = 0;
+				}
+			}
+		}
+		else {
+			return 2;
+		}
+	}
+
+	ibtmo(ud, T10s);
+
+	#ifdef ENABLE_EXTRA_DEBUGGING
+	printf("[DEBG] Read %li bytes from GPIB device\n", array_pointer);
+	#endif
+
+	return 0;
+}
+
+int scope_get_screenshot_stage2(char * scopeType, int gpibDevice) {
+	long bytestosend;
+	int k;
+	int m;
+
+	if ((strcmp("HP54600OS", scopeType) == 0) || (strcmp("TDS744AOS", scopeType) == 0)) {
+		printf("[INFO] Getting scope screenshot [Stage 2]\n\r");
+		if (strcmp("HP54600OS", scopeType) == 0) {
+			if (gpib_read_binblock(gpibDevice, 19768, scopeType) == 0) {
+				return 0;
+			}
+			else {
+				return 1;
+			}
+		}
+		else if (strcmp("TDS744AOS", scopeType) == 0) {
+			gpib_read_binary(gpibDevice, scopeScreenSize(scopeType));
+
+			int bpp;
+			TQImage bmp;
+			bmp.load("/tmp/current_scope_screenshot.bmp");
+			if (bmp.isNull()) {
+				printf("[WARN] Unable to load screenshot bitmap\n\r");
+				return 1;
+			}
+			bpp = bmp.depth();
+			#ifdef ENABLE_EXTRA_DEBUGGING
+			printf("[DEBG] Found BPP of %d\n\r", bpp);
+			#endif
+			bytestosend = 0;
+			for (m=0;m<scopeScreenWidth(scopeType);m++) {
+				for (k=0;k<scopeScreenHeight(scopeType);k++) {
+					TQRgb pixel = bmp.pixel(m, k);
+					scope_raw_screenshot_data[bytestosend] = tqRed(pixel);
+					bytestosend = bytestosend + 1;
+					scope_raw_screenshot_data[bytestosend] = tqGreen(pixel);
+					bytestosend = bytestosend + 1;
+					scope_raw_screenshot_data[bytestosend] = tqBlue(pixel);
+					bytestosend = bytestosend + 1;
+				}
+			}
+			return 0;
+		}
+	}
+	return 1;
+}
+
+
+int scope_get_screenshot(char * scopeType, int gpibDevice) {
+	if ((strcmp("HP54600OS", scopeType) == 0) || (strcmp("TDS744AOS", scopeType) == 0)) {
+		printf("[INFO] Getting scope screenshot [Stage 1]\n\r");
+		if (strcmp("HP54600OS", scopeType) == 0) {
+			sprintf(falpha, "PRINT?");
+			#ifdef ENABLE_EXTRA_DEBUGGING
+			printf("[DEBG] Writing: %s\n\r", falpha);
+			#endif
+			if (gpib_write(gpibDevice, falpha) == 0) {
+				return 0;
+			}
+			else {
+				return 2;
+			}
+		}
+		else if (strcmp("TDS744AOS", scopeType) == 0) {
+			sprintf(falpha, "HARDCOPY:FORMAT BMPCOLOR");
+			if (gpib_write(gpibDevice, falpha) == 0) {
+				#ifdef ENABLE_EXTRA_DEBUGGING
+				printf("[DEBG] Wrote: %s\n\r", falpha);
+				#endif
+				sprintf(falpha, "HARDCOPY:LAYOUT PORTRAIT");
+				if (gpib_write(gpibDevice, falpha) == 0) {
+					#ifdef ENABLE_EXTRA_DEBUGGING
+					printf("[DEBG] Wrote: %s\n\r", falpha);
+					#endif
+					sprintf(falpha, "HARDCOPY:PALETTE HARDCOPY");
+					if (gpib_write(gpibDevice, falpha) == 0) {
+						#ifdef ENABLE_EXTRA_DEBUGGING
+						printf("[DEBG] Wrote: %s\n\r", falpha);
+						#endif
+						sprintf(falpha, "HARDCOPY:PORT GPIB");
+						if (gpib_write(gpibDevice, falpha) == 0) {
+							#ifdef ENABLE_EXTRA_DEBUGGING
+							printf("[DEBG] Wrote: %s\n\r", falpha);
+							#endif
+							sprintf(falpha, "HARDCOPY START");
+							if (gpib_write(gpibDevice, falpha) == 0) {
+								#ifdef ENABLE_EXTRA_DEBUGGING
+								printf("[DEBG] Wrote: %s\n\r", falpha);
+								#endif
+								return 0;
+							}
+						}
+					}
+				}
+			}
+		}
+	}
+	return 1;
+}
+
+int scope_set_timebase(float desired_timebase, char * scopeType, int gpibDevice) {
+	if ((strcmp("HP54600OS", scopeType) == 0) || (strcmp("TDS744AOS", scopeType) == 0)) {
+		printf("[INFO] Setting scope timebase to %E\n\r", desired_timebase);
+		if (strcmp("HP54600OS", scopeType) == 0) {
+			sprintf(falpha, "TIM:RANG %E", desired_timebase);
+			#ifdef ENABLE_EXTRA_DEBUGGING
+			printf("[DEBG] Writing: %s\n\r", falpha);
+			#endif
+			if (gpib_write(gpibDevice, falpha) == 0) {
+				return 0;
+			}
+			else {
+				return 2;
+			}
+		}
+		else if (strcmp("TDS744AOS", scopeType) == 0) {
+			sprintf(falpha, "HORIZONTAL:MAIN:SCALE %E", desired_timebase/10);
+			#ifdef ENABLE_EXTRA_DEBUGGING
+			printf("[DEBG] Writing: %s\n\r", falpha);
+			#endif
+			if (gpib_write(gpibDevice, falpha) == 0) {
+				return 0;
+			}
+			else {
+				return 2;
+			}
+		}
+	}
+	else {
+		return 1;
+	}
+}
+
+int scope_set_volts_div(int desired_channel, float desired_volts, char * scopeType, int gpibDevice) {
+	if ((strcmp("HP54600OS", scopeType) == 0) || (strcmp("TDS744AOS", scopeType) == 0)) {
+		printf("[INFO] Setting scope volts/div on channel %d to %f\n\r", desired_channel, desired_volts/8);
+		if (strcmp("HP54600OS", scopeType) == 0) {
+			sprintf(falpha, "CHAN%d:RANG %E", desired_channel, desired_volts);
+			#ifdef ENABLE_EXTRA_DEBUGGING
+			printf("[DEBG] Writing: %s\n\r", falpha);
+			#endif
+			if (gpib_write(gpibDevice, falpha) == 0) {
+				return 0;
+			}
+			else {
+				return 2;
+			}
+		}
+		else if (strcmp("TDS744AOS", scopeType) == 0) {
+			sprintf(falpha, "CH%d:SCALE %f", desired_channel, desired_volts/8);
+			#ifdef ENABLE_EXTRA_DEBUGGING
+			printf("[DEBG] Writing: %s\n\r", falpha);
+			#endif
+			if (gpib_write(gpibDevice, falpha) == 0) {
+				return 0;
+			}
+			else {
+				return 2;
+			}
+		}
+	}
+	else {
+		return 1;
+	}
+}
+
+int scope_set_acquisition(int status, char * scopeType, int gpibDevice) {
+	if ((strcmp("HP54600OS", scopeType) == 0) || (strcmp("TDS744AOS", scopeType) == 0)) {
+		printf("[INFO] Setting scope run status to %d\n\r", status);
+		if (strcmp("HP54600OS", scopeType) == 0) {
+			if (status == 0) {
+				sprintf(falpha, "STOP");
+			}
+			else {
+				sprintf(falpha, "RUN");
+			}
+			#ifdef ENABLE_EXTRA_DEBUGGING
+			printf("[DEBG] Writing: %s\n\r", falpha);
+			#endif
+			if (gpib_write(gpibDevice, falpha) == 0) {
+				return 0;
+			}
+			else {
+				return 2;
+			}
+		}
+		else if (strcmp("TDS744AOS", scopeType) == 0) {
+			sprintf(falpha, "ACQUIRE:STATE %d", status);
+			#ifdef ENABLE_EXTRA_DEBUGGING
+			printf("[DEBG] Writing: %s\n\r", falpha);
+			#endif
+			if (gpib_write(gpibDevice, falpha) == 0) {
+				return 0;
+			}
+			else {
+				return 2;
+			}
+		}
+	}
+	else {
+		return 1;
+	}
+}
+
+int scope_set_channel_state(int desired_channel, int status, char * scopeType, int gpibDevice) {
+	if ((strcmp("HP54600OS", scopeType) == 0) || (strcmp("TDS744AOS", scopeType) == 0)) {
+		printf("[INFO] Setting channel %d state to %i\n\r", desired_channel, status);
+		if (strcmp("HP54600OS", scopeType) == 0) {
+			if (status == 0) {
+				sprintf(falpha, "BLAN CHAN%d", desired_channel);
+			}
+			else if (status == 1) {
+				sprintf(falpha, "VIEW CHAN%d", desired_channel);
+			}
+			else {
+				return 2;
+			}
+			#ifdef ENABLE_EXTRA_DEBUGGING
+			printf("[DEBG] Writing: %s\n\r", falpha);
+			#endif
+			if (gpib_write(gpibDevice, falpha) == 0) {
+				return 0;
+			}
+			else {
+				return 2;
+			}
+		}
+		else if (strcmp("TDS744AOS", scopeType) == 0) {
+			if (status == 0) {
+				sprintf(falpha, "SELECT:CH%d OFF", desired_channel);
+			}
+			else if (status == 1) {
+				sprintf(falpha, "SELECT:CH%d ON", desired_channel);
+			}
+			else {
+				return 2;
+			}
+			#ifdef ENABLE_EXTRA_DEBUGGING
+			printf("[DEBG] Writing: %s\n\r", falpha);
+			#endif
+			if (gpib_write(gpibDevice, falpha) == 0) {
+				return 0;
+			}
+			else {
+				return 2;
+			}
+		}
+	}
+	else {
+		return 1;
+	}
+}
+
+int scope_set_trigger_channel(int desired_channel, char * scopeType, int gpibDevice) {
+	if ((strcmp("HP54600OS", scopeType) == 0) || (strcmp("TDS744AOS", scopeType) == 0)) {
+		printf("[INFO] Setting scope trigger channel to %d\n\r", desired_channel);
+		if (strcmp("HP54600OS", scopeType) == 0) {
+			sprintf(falpha, "TRIG:SOUR CHAN%d", desired_channel);
+			#ifdef ENABLE_EXTRA_DEBUGGING
+			printf("[DEBG] Writing: %s\n\r", falpha);
+			#endif
+			if (gpib_write(gpibDevice, falpha) == 0) {
+				return 0;
+			}
+			else {
+				return 2;
+			}
+		}
+		else if (strcmp("TDS744AOS", scopeType) == 0) {
+			sprintf(falpha, "TRIGGER:MAIN:EDGE:SOURCE CH%d", desired_channel);
+			#ifdef ENABLE_EXTRA_DEBUGGING
+			printf("[DEBG] Writing: %s\n\r", falpha);
+			#endif
+			if (gpib_write(gpibDevice, falpha) == 0) {
+				return 0;
+			}
+			else {
+				return 2;
+			}
+		}
+	}
+	else {
+		return 1;
+	}
+}
+
+int scope_set_trigger_level(float desired_level, char * scopeType, int gpibDevice) {
+	if ((strcmp("HP54600OS", scopeType) == 0) || (strcmp("TDS744AOS", scopeType) == 0)) {
+		printf("[INFO] Setting scope trigger level to %f\n\r", desired_level);
+		if (strcmp("HP54600OS", scopeType) == 0) {
+			sprintf(falpha, "TRIG:LEV %E", desired_level);
+			#ifdef ENABLE_EXTRA_DEBUGGING
+			printf("[DEBG] Writing: %s\n\r", falpha);
+			#endif
+			if (gpib_write(gpibDevice, falpha) == 0) {
+				return 0;
+			}
+			else {
+				return 2;
+			}
+		}
+		else if (strcmp("TDS744AOS", scopeType) == 0) {
+			sprintf(falpha, "TRIGGER:MAIN:LEVEL %f", desired_level);
+			#ifdef ENABLE_EXTRA_DEBUGGING
+			printf("[DEBG] Writing: %s\n\r", falpha);
+			#endif
+			if (gpib_write(gpibDevice, falpha) == 0) {
+				return 0;
+			}
+			else {
+				return 2;
+			}
+		}
+	}
+	else {
+		return 1;
+	}
+}
+
+int scope_set_channel_position(int desired_channel, float desired_level, char * scopeType, int gpibDevice) {
+	if ((strcmp("HP54600OS", scopeType) == 0) || (strcmp("TDS744AOS", scopeType) == 0)) {
+		printf("[INFO] Setting scope channel %d level to %f\n\r", desired_channel, desired_level);
+		if (strcmp("HP54600OS", scopeType) == 0) {
+			sprintf(falpha, "CHAN%d:OFFS %E", desired_channel, desired_level);
+			#ifdef ENABLE_EXTRA_DEBUGGING
+			printf("[DEBG] Writing: %s\n\r", falpha);
+			#endif
+			if (gpib_write(gpibDevice, falpha) == 0) {
+				return 0;
+			}
+			else {
+				return 2;
+			}
+		}
+		else if (strcmp("TDS744AOS", scopeType) == 0) {
+			sprintf(falpha, "CH%d:POSITION %f", desired_channel, desired_level);
+			#ifdef ENABLE_EXTRA_DEBUGGING
+			printf("[DEBG] Writing: %s\n\r", falpha);
+			#endif
+			if (gpib_write(gpibDevice, falpha) == 0) {
+				return 0;
+			}
+			else {
+				return 2;
+			}
+		}
+	}
+	else {
+		return 1;
+	}
+}