#2

1 files changed, 94 insertions, 0 deletions

diff --git a/plugins/baycom/baycom_modem.c b/plugins/baycom/baycom_modem.c
new file mode 100644
index 0000000..e4e332f
--- /dev/null
+++ b/plugins/baycom/baycom_modem.c
@@ -0,0 +1,94 @@
+#include "baycom_modem.h"
+#include "baycom_kernel.h"
+#include "baycom_kiss.h"
+
+#include <stdlib.h>
+
+struct baycom_modem {
+    hybbx_baycom_backend_t backend;
+    baycom_kernel_modem_t *kernel;
+    baycom_kiss_modem_t *kiss;
+};
+
+hybbx_result_t baycom_modem_open(baycom_modem_t **out,
+                                 const hybbx_baycom_config_t *cfg,
+                                 baycom_modem_frame_cb cb, void *userdata)
+{
+    baycom_modem_t *modem;
+    hybbx_result_t rc;
+
+    if (out == NULL || cfg == NULL) {
+        return HYBBX_ERR_INVALID;
+    }
+
+    *out = NULL;
+    modem = calloc(1, sizeof(*modem));
+    if (modem == NULL) {
+        return HYBBX_ERR_NOMEM;
+    }
+
+    modem->backend = cfg->backend;
+
+    if (cfg->backend == HYBBX_BAYCOM_BACKEND_KISS) {
+        rc = baycom_kiss_open(&modem->kiss, cfg, cb, userdata);
+    } else {
+        rc = baycom_kernel_open(&modem->kernel, cfg, cb, userdata);
+    }
+
+    if (rc != HYBBX_OK) {
+        baycom_modem_close(modem);
+        return rc;
+    }
+
+    *out = modem;
+    return HYBBX_OK;
+}
+
+void baycom_modem_close(baycom_modem_t *modem)
+{
+    if (modem == NULL) {
+        return;
+    }
+
+    if (modem->kernel != NULL) {
+        baycom_kernel_close(modem->kernel);
+    }
+    if (modem->kiss != NULL) {
+        baycom_kiss_close(modem->kiss);
+    }
+
+    free(modem);
+}
+
+hybbx_result_t baycom_modem_poll(baycom_modem_t *modem)
+{
+    if (modem == NULL) {
+        return HYBBX_ERR_INVALID;
+    }
+
+    if (modem->kiss != NULL) {
+        return baycom_kiss_poll(modem->kiss);
+    }
+    if (modem->kernel != NULL) {
+        return baycom_kernel_poll(modem->kernel);
+    }
+
+    return HYBBX_ERR_IO;
+}
+
+hybbx_result_t baycom_modem_send_frame(baycom_modem_t *modem,
+                                       const uint8_t *frame, size_t len)
+{
+    if (modem == NULL) {
+        return HYBBX_ERR_INVALID;
+    }
+
+    if (modem->kiss != NULL) {
+        return baycom_kiss_send_frame(modem->kiss, frame, len);
+    }
+    if (modem->kernel != NULL) {
+        return baycom_kernel_send_frame(modem->kernel, frame, len);
+    }
+
+    return HYBBX_ERR_IO;
+}