#include <getopt.h>
#include <string.h>
#include <stdbool.h>
+#include <ctype.h>
#include "ao-elf.h"
#include "ccdbg.h"
#include "cc-usb.h"
{ .name = "device", .has_arg = 1, .val = 'D' },
{ .name = "raw", .has_arg = 0, .val = 'r' },
{ .name = "verbose", .has_arg = 1, .val = 'v' },
+ { .name = "rplus", .has_arg = 1, .val = 'a' },
+ { .name = "rminus", .has_arg = 1, .val = 'b' },
+ { .name = "adcmax", .has_arg = 1, .val = 'm' },
{ 0, 0, 0, 0},
};
static void usage(char *program)
{
- fprintf(stderr, "usage: %s [--verbose=<verbose>] [--device=<device>] [-tty=<tty>] main|drogue\n", program);
+ fprintf(stderr, "usage: %s [--verbose=<verbose>] [--device=<device>] [--tty=<tty>] [--rplus=val] [--rminus=val] [--adcmax=val] main|drogue\n", program);
exit(1);
}
-void
+static void
done(struct cc_usb *cc, int code)
{
/* cc_usb_printf(cc, "a\n"); */
exit (code);
}
-static int
-ends_with(char *whole, char *suffix)
-{
- int whole_len = strlen(whole);
- int suffix_len = strlen(suffix);
-
- if (suffix_len > whole_len)
- return 0;
- return strcmp(whole + whole_len - suffix_len, suffix) == 0;
-}
-
-static int
-starts_with(char *whole, char *prefix)
-{
- int whole_len = strlen(whole);
- int prefix_len = strlen(prefix);
-
- if (prefix_len > whole_len)
- return 0;
- return strncmp(whole, prefix, prefix_len) == 0;
-}
-
struct igniter {
struct igniter *next;
char name[512];
char status[512];
+ int adc;
};
+static bool
+map_igniter_name(char *adc_name, char *igniter_name)
+{
+ char *colon = strchr(adc_name, ':');
+ if (!colon)
+ return false;
+ *colon = '\0';
+ if (strlen(adc_name) == 1 && isupper(adc_name[0])) {
+ igniter_name[0] = '0' + adc_name[0] - 'A';
+ igniter_name[1] = '\0';
+ } else {
+ strcpy(igniter_name, adc_name);
+ }
+ return true;
+}
+
+static const char *
+other_igniter_name(const char *name)
+{
+ if (!strcmp(name, "drogue"))
+ return "apogee";
+ if (!strcmp(name, "apogee"))
+ return "drogue";
+ return name;
+}
+
static struct igniter *
igniters(struct cc_usb *usb)
{
struct igniter *head = NULL, **tail = &head;
- cc_usb_printf(usb, "t\nv\n");
+ cc_usb_printf(usb, "t\na\nv\n");
for (;;) {
char line[512];
char name[512];
char status[512];
+ char adc_name[512];
+ char igniter_name[512];
cc_usb_getline(usb, line, sizeof (line));
if (strstr(line, "software-version"))
break;
- if (sscanf(line, "Igniter: %s Status: %s", &name, &status) == 2) {
- struct igniter *i = malloc (sizeof (struct igniter));
+ if (sscanf(line, "Igniter: %s Status: %s", name, status) == 2) {
+ struct igniter *i = calloc (1, sizeof (struct igniter));
strcpy(i->name, name);
strcpy(i->status, status);
i->next = NULL;
*tail = i;
tail = &i->next;
}
+ if (strncmp(line, "tick:", 5) == 0) {
+ char *tok;
+ char *l = line;
+ bool found_igniter = false;
+
+ while ((tok = strtok(l, " ")) != NULL) {
+ l = NULL;
+ if (found_igniter) {
+ struct igniter *i;
+ for (i = head; i; i = i->next)
+ if (!strcmp(i->name, igniter_name) ||
+ !strcmp(i->name, other_igniter_name(igniter_name)))
+ {
+ i->adc = atoi(tok);
+ break;
+ }
+ found_igniter = false;
+ } else {
+ strcpy(adc_name, tok);
+ found_igniter = map_igniter_name(adc_name, igniter_name);
+ }
+ }
+ }
}
return head;
}
find_igniter(struct igniter *i, char *name)
{
for (; i; i = i->next)
- if (strcmp(i->name, name) == 0)
+ if (strcmp(i->name, name) == 0) {
+ printf("igniter %s adc %d\n", i->name, i->adc);
return i;
+ }
+ return NULL;
+}
+
+static const double ref_volts = 3.3;
+
+static double
+compute_voltage(int adc, double rplus, double rminus, int adc_max)
+{
+ return (double) adc / (double) adc_max * ref_volts * (rplus + rminus) / rminus;
}
static int
-do_igniter(struct cc_usb *usb, char *name)
+do_igniter(struct cc_usb *usb, char *name, double rplus, double rminus, int adc_max)
{
struct igniter *all = igniters(usb);
struct igniter *this = find_igniter(all, name);
+ double volts = -1;
if (!this) {
struct igniter *i;
- printf("no igniter %s found in");
+ printf("no igniter %s found in", name);
for (i = all; i; i = i->next)
printf(" %s", i->name);
printf("\n");
free_igniters(all);
return 0;
}
+ if (rplus && rminus && adc_max) {
+ volts = compute_voltage(this->adc, rplus, rminus, adc_max);
+ if (volts < 1 || volts > 4) {
+ printf("igniter %s voltage is %f, not in range of 1-4 volts\n", this->name, volts);
+ free_igniters(all);
+ return 0;
+ }
+ }
if (strcmp(this->status, "ready") != 0) {
printf("igniter %s status is %s\n", this->name, this->status);
free_igniters(all);
main (int argc, char **argv)
{
char *device = NULL;
- char *filename;
- Elf *e;
- unsigned int s;
int i;
int c;
- int tries;
struct cc_usb *cc = NULL;
char *tty = NULL;
- int success;
int verbose = 0;
int ret = 0;
+ double rplus = 0.0;
+ double rminus = 0.0;
+ int adcmax = 0;
- while ((c = getopt_long(argc, argv, "rT:D:c:s:v:", options, NULL)) != -1) {
+ while ((c = getopt_long(argc, argv, "rT:D:c:s:v:a:b:m:", options, NULL)) != -1) {
switch (c) {
case 'T':
tty = optarg;
case 'v':
verbose++;
break;
+ case 'a':
+ rplus = strtod(optarg, NULL);
+ break;
+ case 'b':
+ rminus = strtod(optarg, NULL);
+ break;
+ case 'm':
+ adcmax = strtol(optarg, NULL, 0);
+ break;
default:
usage(argv[0]);
break;
for (i = optind; i < argc; i++) {
char *name = argv[i];
- if (!do_igniter(cc, name))
+ if (!do_igniter(cc, name, rplus, rminus, adcmax))
ret++;
}
done(cc, ret);