examples/timing.c: add example for controlling AFC timing event code

81e9fd83 · João Brito · 9b00c780 · 81e9fd83
Commit 81e9fd83 authored Aug 10, 2016 by João Brito
Hide whitespace changes
Inline Side-by-side

Showing with 138 additions and 0 deletions

timing.c examples/timing.c +138 -0

No files found.
--- a/examples/timing.c
+++ b/examples/timing.c
+/*
+ * Controlling the AFC Timing board
+ */
+
+#include <inttypes.h>
+#include <bpm_client.h>
+
+#define DFLT_BIND_FOLDER            "/tmp/bpm"
+
+#define DFLT_BPM_NUMBER             0
+#define MAX_BPM_NUMBER              1
+
+#define DFLT_BOARD_NUMBER           0
+
+void print_help (char *program_name)
+{
+    printf( "Usage: %s [options]\n"
+            "\t-h This help message\n"
+            "\t-v Verbose output\n"
+            "\t-b <broker_endpoint> Broker endpoint\n"
+            "\t-board <AMC board = [0|1|2|3|4|5]>\n"
+            "\t-bpm <BPM number = [0|1]>\n", program_name);
+}
+
+int main (int argc, char *argv [])
+{
+    int verbose = 0;
+    char *broker_endp = NULL;
+    char *board_number_str = NULL;
+    char *bpm_number_str = NULL;
+    char **str_p = NULL;
+
+    if (argc < 2) {
+        print_help (argv[0]);
+        exit (1);
+    }
+
+    /* FIXME: This is rather buggy! */
+    /* Simple handling of command-line options. This should be done
+     * with getopt, for instance*/
+    int i;
+    for (i = 1; i < argc; i++)
+    {
+        if (streq(argv[i], "-v")) {
+            verbose = 1;
+        }
+        else if (streq(argv[i], "-h"))
+        {
+            print_help (argv [0]);
+            exit (1);
+        }
+        else if (streq(argv[i], "-board"))
+        {
+            str_p = &board_number_str;
+        }
+        else if (streq(argv[i], "-bpm"))
+        {
+            str_p = &bpm_number_str;
+        }
+        else if (streq (argv[i], "-b")) {
+            str_p = &broker_endp;
+        }
+        /* Fallout for options with parameters */
+        else {
+            *str_p = strdup (argv[i]);
+        }
+    }
+
+    /* Set default broker address */
+    if (broker_endp == NULL) {
+        broker_endp = strdup ("ipc://"DFLT_BIND_FOLDER);
+    }
+
+    /* Set default board number */
+    uint32_t board_number;
+    if (board_number_str == NULL) {
+        fprintf (stderr, "[client:timing]: Setting default value to BOARD number: %u\n",
+                DFLT_BOARD_NUMBER);
+        board_number = DFLT_BOARD_NUMBER;
+    }
+    else {
+        board_number = strtoul (board_number_str, NULL, 10);
+    }
+
+    /* Set default bpm number */
+    uint32_t bpm_number;
+    if (bpm_number_str == NULL) {
+        fprintf (stderr, "[client:timing]: Setting default value to BPM number: %u\n",
+                DFLT_BPM_NUMBER);
+        bpm_number = DFLT_BPM_NUMBER;
+    }
+    else {
+        bpm_number = strtoul (bpm_number_str, NULL, 10);
+
+        if (bpm_number > MAX_BPM_NUMBER) {
+            fprintf (stderr, "[client:timing]: BPM number too big! Defaulting to: %u\n",
+                    MAX_BPM_NUMBER);
+            bpm_number = MAX_BPM_NUMBER;
+        }
+    }
+
+    char service [50];
+    snprintf (service, sizeof (service), "BPM%u:DEVIO:LNLS_AFC_TIMING%u",
+            board_number, bpm_number);
+
+    bpm_client_t *bpm_client = bpm_client_new (broker_endp, verbose, NULL);
+    if (bpm_client == NULL) {
+        fprintf (stderr, "[client:timing]: bpm_client could be created\n");
+        goto err_bpm_client_new;
+    }
+
+    uint32_t data = 0;
+    bpm_client_err_e err = afc_timing_set_evt_code_0 (bpm_client, service, data);
+    err |= afc_timing_set_evt_code_1 (bpm_client, service, data);
+    err |= afc_timing_set_evt_code_2 (bpm_client, service, data);
+    err |= afc_timing_set_evt_code_3 (bpm_client, service, data);
+    err |= afc_timing_set_evt_code_4 (bpm_client, service, data);
+    err |= afc_timing_set_evt_code_5 (bpm_client, service, data);
+    err |= afc_timing_set_evt_code_6 (bpm_client, service, data);
+    if (err != BPM_CLIENT_SUCCESS){
+        fprintf (stderr, "[client:timing]: afc_timing_set_evt_code_X failed\n");
+        goto err_afc_timing;
+    }
+
+err_bpm_client_new:
+err_afc_timing:
+    bpm_client_destroy (&bpm_client);
+    str_p = &broker_endp;
+    free (*str_p);
+    broker_endp = NULL;
+    str_p = &board_number_str;
+    free (*str_p);
+    board_number_str = NULL;
+    str_p = &bpm_number_str;
+    free (*str_p);
+    bpm_number_str = NULL;
+    return 0;
+}