diff rvinterf/etmsync/piradccal.c @ 323:886f65760d09

fc-tmsync: added pirelli-vbat-cal command to read Pirelli's ADC calibration
author Mychaela Falconia <falcon@freecalypso.org>
date Mon, 18 Dec 2017 21:00:46 +0000
parents
children
line wrap: on
line diff
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/rvinterf/etmsync/piradccal.c	Mon Dec 18 21:00:46 2017 +0000
@@ -0,0 +1,32 @@
+/*
+ * This module is linked into fc-tmsync and implements a command for
+ * retrieving Pirelli's VBAT ADC calibration.
+ */
+
+#include <sys/types.h>
+#include <stdio.h>
+#include <stdlib.h>
+#include <string.h>
+#include <strings.h>
+#include "localtypes.h"
+#include "exitcodes.h"
+
+get_pirelli_vbat_cal()
+{
+	u_char bytes[2];
+	int a, b;
+	int rc;
+
+	rc = do_memory_read(0x027F06E5, bytes, 2);
+	if (rc)
+		return(rc);
+	a = bytes[0] | (bytes[1] << 8);
+	rc = do_memory_read(0x027F06F7, bytes, 2);
+	if (rc)
+		return(rc);
+	b = bytes[0] | (bytes[1] << 8);
+	if (b >= 32768)
+		b -= 65536;
+	printf("A=%d B=%d\n", a, b);
+	return(0);
+}