1 files changed, 241 insertions, 0 deletions

diff --git a/lcmtype/path_ctrl_t.c b/lcmtype/path_ctrl_t.c
new file mode 100644
index 0000000..2298a56
--- /dev/null
+++ b/lcmtype/path_ctrl_t.c
@@ -0,0 +1,241 @@
+// THIS IS AN AUTOMATICALLY GENERATED FILE.  DO NOT MODIFY
+// BY HAND!!
+//
+// Generated by lcm-gen
+
+#include <string.h>
+#include "path_ctrl_t.h"
+
+static int __path_ctrl_t_hash_computed;
+static uint64_t __path_ctrl_t_hash;
+
+uint64_t __path_ctrl_t_hash_recursive(const __lcm_hash_ptr *p)
+{
+    const __lcm_hash_ptr *fp;
+    for (fp = p; fp != NULL; fp = fp->parent)
+        if (fp->v == __path_ctrl_t_get_hash)
+            return 0;
+
+    __lcm_hash_ptr cp;
+    cp.parent =  p;
+    cp.v = (void*)__path_ctrl_t_get_hash;
+    (void) cp;
+
+    uint64_t hash = (uint64_t)0x5cf946463c463b9eLL
+         + __int8_t_hash_recursive(&cp)
+         + __int8_t_hash_recursive(&cp)
+        ;
+
+    return (hash<<1) + ((hash>>63)&1);
+}
+
+int64_t __path_ctrl_t_get_hash(void)
+{
+    if (!__path_ctrl_t_hash_computed) {
+        __path_ctrl_t_hash = (int64_t)__path_ctrl_t_hash_recursive(NULL);
+        __path_ctrl_t_hash_computed = 1;
+    }
+
+    return __path_ctrl_t_hash;
+}
+
+int __path_ctrl_t_encode_array(void *buf, int offset, int maxlen, const path_ctrl_t *p, int elements)
+{
+    int pos = 0, element;
+    int thislen;
+
+    for (element = 0; element < elements; element++) {
+
+        thislen = __int8_t_encode_array(buf, offset + pos, maxlen - pos, &(p[element].cmd), 1);
+        if (thislen < 0) return thislen; else pos += thislen;
+
+        thislen = __int8_t_encode_array(buf, offset + pos, maxlen - pos, &(p[element].speed), 1);
+        if (thislen < 0) return thislen; else pos += thislen;
+
+    }
+    return pos;
+}
+
+int path_ctrl_t_encode(void *buf, int offset, int maxlen, const path_ctrl_t *p)
+{
+    int pos = 0, thislen;
+    int64_t hash = __path_ctrl_t_get_hash();
+
+    thislen = __int64_t_encode_array(buf, offset + pos, maxlen - pos, &hash, 1);
+    if (thislen < 0) return thislen; else pos += thislen;
+
+    thislen = __path_ctrl_t_encode_array(buf, offset + pos, maxlen - pos, p, 1);
+    if (thislen < 0) return thislen; else pos += thislen;
+
+    return pos;
+}
+
+int __path_ctrl_t_encoded_array_size(const path_ctrl_t *p, int elements)
+{
+    int size = 0, element;
+    for (element = 0; element < elements; element++) {
+
+        size += __int8_t_encoded_array_size(&(p[element].cmd), 1);
+
+        size += __int8_t_encoded_array_size(&(p[element].speed), 1);
+
+    }
+    return size;
+}
+
+int path_ctrl_t_encoded_size(const path_ctrl_t *p)
+{
+    return 8 + __path_ctrl_t_encoded_array_size(p, 1);
+}
+
+int __path_ctrl_t_decode_array(const void *buf, int offset, int maxlen, path_ctrl_t *p, int elements)
+{
+    int pos = 0, thislen, element;
+
+    for (element = 0; element < elements; element++) {
+
+        thislen = __int8_t_decode_array(buf, offset + pos, maxlen - pos, &(p[element].cmd), 1);
+        if (thislen < 0) return thislen; else pos += thislen;
+
+        thislen = __int8_t_decode_array(buf, offset + pos, maxlen - pos, &(p[element].speed), 1);
+        if (thislen < 0) return thislen; else pos += thislen;
+
+    }
+    return pos;
+}
+
+int __path_ctrl_t_decode_array_cleanup(path_ctrl_t *p, int elements)
+{
+    int element;
+    for (element = 0; element < elements; element++) {
+
+        __int8_t_decode_array_cleanup(&(p[element].cmd), 1);
+
+        __int8_t_decode_array_cleanup(&(p[element].speed), 1);
+
+    }
+    return 0;
+}
+
+int path_ctrl_t_decode(const void *buf, int offset, int maxlen, path_ctrl_t *p)
+{
+    int pos = 0, thislen;
+    int64_t hash = __path_ctrl_t_get_hash();
+
+    int64_t this_hash;
+    thislen = __int64_t_decode_array(buf, offset + pos, maxlen - pos, &this_hash, 1);
+    if (thislen < 0) return thislen; else pos += thislen;
+    if (this_hash != hash) return -1;
+
+    thislen = __path_ctrl_t_decode_array(buf, offset + pos, maxlen - pos, p, 1);
+    if (thislen < 0) return thislen; else pos += thislen;
+
+    return pos;
+}
+
+int path_ctrl_t_decode_cleanup(path_ctrl_t *p)
+{
+    return __path_ctrl_t_decode_array_cleanup(p, 1);
+}
+
+int __path_ctrl_t_clone_array(const path_ctrl_t *p, path_ctrl_t *q, int elements)
+{
+    int element;
+    for (element = 0; element < elements; element++) {
+
+        __int8_t_clone_array(&(p[element].cmd), &(q[element].cmd), 1);
+
+        __int8_t_clone_array(&(p[element].speed), &(q[element].speed), 1);
+
+    }
+    return 0;
+}
+
+path_ctrl_t *path_ctrl_t_copy(const path_ctrl_t *p)
+{
+    path_ctrl_t *q = (path_ctrl_t*) malloc(sizeof(path_ctrl_t));
+    __path_ctrl_t_clone_array(p, q, 1);
+    return q;
+}
+
+void path_ctrl_t_destroy(path_ctrl_t *p)
+{
+    __path_ctrl_t_decode_array_cleanup(p, 1);
+    free(p);
+}
+
+int path_ctrl_t_publish(lcm_t *lc, const char *channel, const path_ctrl_t *p)
+{
+      int max_data_size = path_ctrl_t_encoded_size (p);
+      uint8_t *buf = (uint8_t*) malloc (max_data_size);
+      if (!buf) return -1;
+      int data_size = path_ctrl_t_encode (buf, 0, max_data_size, p);
+      if (data_size < 0) {
+          free (buf);
+          return data_size;
+      }
+      int status = lcm_publish (lc, channel, buf, data_size);
+      free (buf);
+      return status;
+}
+
+struct _path_ctrl_t_subscription_t {
+    path_ctrl_t_handler_t user_handler;
+    void *userdata;
+    lcm_subscription_t *lc_h;
+};
+static
+void path_ctrl_t_handler_stub (const lcm_recv_buf_t *rbuf,
+                            const char *channel, void *userdata)
+{
+    int status;
+    path_ctrl_t p;
+    memset(&p, 0, sizeof(path_ctrl_t));
+    status = path_ctrl_t_decode (rbuf->data, 0, rbuf->data_size, &p);
+    if (status < 0) {
+        fprintf (stderr, "error %d decoding path_ctrl_t!!!\n", status);
+        return;
+    }
+
+    path_ctrl_t_subscription_t *h = (path_ctrl_t_subscription_t*) userdata;
+    h->user_handler (rbuf, channel, &p, h->userdata);
+
+    path_ctrl_t_decode_cleanup (&p);
+}
+
+path_ctrl_t_subscription_t* path_ctrl_t_subscribe (lcm_t *lcm,
+                    const char *channel,
+                    path_ctrl_t_handler_t f, void *userdata)
+{
+    path_ctrl_t_subscription_t *n = (path_ctrl_t_subscription_t*)
+                       malloc(sizeof(path_ctrl_t_subscription_t));
+    n->user_handler = f;
+    n->userdata = userdata;
+    n->lc_h = lcm_subscribe (lcm, channel,
+                                 path_ctrl_t_handler_stub, n);
+    if (n->lc_h == NULL) {
+        fprintf (stderr,"couldn't reg path_ctrl_t LCM handler!\n");
+        free (n);
+        return NULL;
+    }
+    return n;
+}
+
+int path_ctrl_t_subscription_set_queue_capacity (path_ctrl_t_subscription_t* subs,
+                              int num_messages)
+{
+    return lcm_subscription_set_queue_capacity (subs->lc_h, num_messages);
+}
+
+int path_ctrl_t_unsubscribe(lcm_t *lcm, path_ctrl_t_subscription_t* hid)
+{
+    int status = lcm_unsubscribe (lcm, hid->lc_h);
+    if (0 != status) {
+        fprintf(stderr,
+           "couldn't unsubscribe path_ctrl_t_handler %p!\n", hid);
+        return -1;
+    }
+    free (hid);
+    return 0;
+}
+