summaryrefslogtreecommitdiffstats
path: root/bindings/radio
diff options
context:
space:
mode:
Diffstat (limited to 'bindings/radio')
-rw-r--r--bindings/radio/CMakeLists.txt17
-rw-r--r--bindings/radio/export.map1
-rw-r--r--bindings/radio/radio-api.c376
-rw-r--r--bindings/radio/radio-api.h49
-rw-r--r--bindings/radio/radio-rtlsdr.c427
-rw-r--r--bindings/radio/radio-rtlsdr.h100
6 files changed, 970 insertions, 0 deletions
diff --git a/bindings/radio/CMakeLists.txt b/bindings/radio/CMakeLists.txt
new file mode 100644
index 00000000..4df7adb2
--- /dev/null
+++ b/bindings/radio/CMakeLists.txt
@@ -0,0 +1,17 @@
+INCLUDE(FindPkgConfig)
+PKG_CHECK_MODULES(librtlsdr librtlsdr>=0.5.0)
+
+IF(librtlsdr_FOUND)
+
+ MESSAGE(STATUS "librtlsdr found ; will compile Radio binding... (binding)")
+ INCLUDE_DIRECTORIES(${include_dirs} ${librtlsdr_INCLUDE_DIRS})
+ ADD_LIBRARY(radio-api MODULE radio-api.c radio-rtlsdr.c)
+ SET_TARGET_PROPERTIES(radio-api PROPERTIES
+ PREFIX ""
+ LINK_FLAGS "-Wl,--version-script=${CMAKE_CURRENT_SOURCE_DIR}/export.map"
+ )
+ TARGET_LINK_LIBRARIES(radio-api ${link_libraries} ${librtlsdr_LIBRARIES} -lm)
+ INSTALL(TARGETS radio-api
+ LIBRARY DESTINATION ${binding_install_dir})
+
+ENDIF(librtlsdr_FOUND)
diff --git a/bindings/radio/export.map b/bindings/radio/export.map
new file mode 100644
index 00000000..0ef1ac79
--- /dev/null
+++ b/bindings/radio/export.map
@@ -0,0 +1 @@
+{ global: afbBindingV1Register; local: *; };
diff --git a/bindings/radio/radio-api.c b/bindings/radio/radio-api.c
new file mode 100644
index 00000000..0ed60e1c
--- /dev/null
+++ b/bindings/radio/radio-api.c
@@ -0,0 +1,376 @@
+/*
+ * Copyright (C) 2015, 2016 "IoT.bzh"
+ * Author "Manuel Bachmann"
+ *
+ * Licensed under the Apache License, Version 2.0 (the "License");
+ * you may not use this file except in compliance with the License.
+ * You may obtain a copy of the License at
+ *
+ * http://www.apache.org/licenses/LICENSE-2.0
+ *
+ * Unless required by applicable law or agreed to in writing, software
+ * distributed under the License is distributed on an "AS IS" BASIS,
+ * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+ * See the License for the specific language governing permissions and
+ * limitations under the License.
+ */
+
+#define _GNU_SOURCE
+#include <strings.h>
+#include <json-c/json.h>
+
+#include "radio-api.h"
+#include "radio-rtlsdr.h"
+
+#include <afb/afb-plugin.h>
+#include <afb/afb-req-itf.h>
+
+/* ********************************************************
+
+ FULUP integration proposal with client session context
+
+ ******************************************************** */
+
+/* ------ LOCAL HELPER FUNCTIONS --------- */
+
+static pluginHandleT *the_radio = NULL;
+
+/* detect new radio devices */
+void updateRadioDevList(pluginHandleT *handle) {
+
+ int idx;
+
+ // loop on existing radio if any
+ for (idx = 0; idx < _radio_dev_count(); idx++) {
+ if (idx == MAX_RADIO) break;
+ handle->radios[idx] = calloc(1, sizeof(radioDevT)); /* use calloc to set "used" to FALSE */
+ handle->radios[idx]->name = (char *) _radio_dev_name(idx);
+ }
+ handle->devCount = _radio_dev_count();
+}
+
+/* global plugin context creation ; at loading time [radio devices might not be visible] */
+static void initRadioPlugin() {
+
+ pluginHandleT *handle;
+
+ handle = calloc (1, sizeof(pluginHandleT));
+ updateRadioDevList (handle);
+ the_radio = handle;
+}
+
+/* private client context creation ; default values */
+static radioCtxHandleT* initRadioCtx () {
+
+ radioCtxHandleT *ctx;
+
+ ctx = malloc (sizeof(radioCtxHandleT));
+ ctx->radio = NULL;
+ ctx->idx = -1;
+ ctx->mode = FM;
+ ctx->freq = 100.0;
+ ctx->mute = 0;
+ ctx->is_playing = 0;
+
+ return ctx;
+}
+
+/* reserve a radio device for requesting client, power it on */
+unsigned char reserveRadio (pluginHandleT *handle, radioCtxHandleT *ctx) {
+
+ unsigned int idx;
+
+ /* loop on all devices, find an unused one */
+ for (idx = 0; idx < _radio_dev_count(); idx++) {
+ if (idx == MAX_RADIO) break;
+ if (handle->radios[idx]->used == FALSE) goto found_radio; /* found one */
+ }
+ return 0;
+
+ found_radio:
+ /* try to power it on, passing client context info such as frequency... */
+
+ _radio_on (idx, ctx);
+ /* TODO : try to re-iterate from the next ones if it failed ! */
+
+ /* globally mark it as reserved */
+ handle->radios[idx]->used = TRUE;
+
+ /* store relevant info to client context (direct pointer, index) */
+ ctx->radio = handle->radios[idx];
+ ctx->idx = idx;
+
+ return 1;
+}
+
+/* free a radio device from requesting client, power it off */
+unsigned char releaseRadio (pluginHandleT *handle, radioCtxHandleT *ctx) {
+
+ /* stop playing if it was doing this (blocks otherwise) */
+ if (ctx->is_playing) {
+ ctx->is_playing = 0;
+ _radio_stop (ctx->idx);
+ }
+
+ /* power it off */
+ _radio_off (ctx->idx);
+
+ /* globally mark it as free */
+ handle->radios[ctx->idx]->used = FALSE;
+
+ /* clean client context */
+ ctx->radio = NULL;
+ ctx->idx = -1;
+
+ return 1;
+}
+
+/* called when client session dies [e.g. client quits for more than 15mns] */
+static void freeRadio (void *context) {
+
+ releaseRadio (the_radio, context);
+ free (context);
+}
+
+
+/* ------ PUBLIC PLUGIN FUNCTIONS --------- */
+
+static void init (struct afb_req request) { /* AFB_SESSION_CHECK */
+
+ radioCtxHandleT *ctx = afb_req_context_get (request);
+ json_object *jresp;
+
+ /* create a global plugin handle */
+ if (!the_radio)
+ initRadioPlugin();
+
+ /* create a private client context */
+ if (!ctx) {
+ ctx = initRadioCtx();
+ afb_req_context_set (request, ctx, free);
+ }
+
+ jresp = json_object_new_object();
+ json_object_object_add(jresp, "init", json_object_new_string ("success"));
+ afb_req_success (request, jresp, "Radio initialized");
+}
+
+static void power (struct afb_req request) { /* AFB_SESSION_CHECK */
+
+ pluginHandleT *handle = the_radio;
+ radioCtxHandleT *ctx = afb_req_context_get (request);
+ const char *value = afb_req_value (request, "value");
+ json_object *jresp;
+
+ if (!ctx) {
+ afb_req_fail (request, "failed", "you must call 'init' first");
+ return;
+ }
+ jresp = json_object_new_object();
+
+ /* no "?value=" parameter : return current state */
+ if (!value) {
+ ctx->radio ?
+ json_object_object_add (jresp, "power", json_object_new_string ("on"))
+ : json_object_object_add (jresp, "power", json_object_new_string ("off"));
+ afb_req_success (request, jresp, "Radio - Power status obtained");
+ return;
+ }
+
+ /* "?value=" parameter is "1" or "true" */
+ else if ( atoi(value) == 1 || !strcasecmp(value, "true") ) {
+ if (!ctx->radio) {
+ if (!reserveRadio (handle, ctx)) {
+ afb_req_fail (request, "failed", "no more radio devices available");
+ return;
+ }
+ }
+ json_object_object_add (jresp, "power", json_object_new_string ("on"));
+ }
+
+ /* "?value=" parameter is "0" or "false" */
+ else if ( atoi(value) == 0 || !strcasecmp(value, "false") ) {
+ if (ctx->radio) {
+ if (!releaseRadio (handle, ctx)) {
+ afb_req_fail (request, "failed", "Unable to release radio device");
+ return;
+ }
+ }
+ json_object_object_add (jresp, "power", json_object_new_string ("off"));
+ }
+ else
+ jresp = NULL;
+
+ afb_req_success (request, jresp, "Radio - Power set");
+}
+
+static void mode (struct afb_req request) { /* AFB_SESSION_CHECK */
+
+ radioCtxHandleT *ctx = afb_req_context_get (request);
+ const char *value = afb_req_value (request, "value");
+ json_object *jresp;
+
+ if (!ctx) {
+ afb_req_fail (request, "failed", "you must call 'init' first");
+ return;
+ }
+ jresp = json_object_new_object();
+
+ /* no "?value=" parameter : return current state */
+ if (!value || !ctx->radio) {
+ ctx->mode ?
+ json_object_object_add (jresp, "mode", json_object_new_string ("AM"))
+ : json_object_object_add (jresp, "mode", json_object_new_string ("FM"));
+ }
+
+ /* "?value=" parameter is "1" or "AM" */
+ else if ( atoi(value) == 1 || !strcasecmp(value, "AM") ) {
+ ctx->mode = AM;
+ _radio_set_mode (ctx->idx, ctx->mode);
+ json_object_object_add (jresp, "mode", json_object_new_string ("AM"));
+ }
+
+ /* "?value=" parameter is "0" or "FM" */
+ else if ( atoi(value) == 0 || !strcasecmp(value, "FM") ) {
+ ctx->mode = FM;
+ _radio_set_mode (ctx->idx, ctx->mode);
+ json_object_object_add (jresp, "mode", json_object_new_string ("FM"));
+ }
+
+ afb_req_success (request, jresp, "Radio - Mode set");
+}
+
+static void freq (struct afb_req request) { /* AFB_SESSION_CHECK */
+
+ radioCtxHandleT *ctx = afb_req_context_get (request);
+ const char *value = afb_req_value (request, "value");
+ json_object *jresp;
+ double freq;
+ char freq_str[256];
+
+ if (!ctx) {
+ afb_req_fail (request, "failed", "you must call 'init' first");
+ return;
+ }
+ jresp = json_object_new_object();
+
+ /* no "?value=" parameter : return current state */
+ if (!value || !ctx->radio) {
+ snprintf (freq_str, sizeof(freq_str), "%f", ctx->freq);
+ json_object_object_add (jresp, "freq", json_object_new_string (freq_str));
+ }
+
+ /* "?value=" parameter, set frequency */
+ else {
+ freq = strtod (value, NULL);
+ _radio_set_freq (ctx->idx, freq);
+ ctx->freq = (float)freq;
+
+ snprintf (freq_str, sizeof(freq_str), "%f", ctx->freq);
+ json_object_object_add (jresp, "freq", json_object_new_string (freq_str));
+ }
+
+ afb_req_success (request, jresp, "Radio - Frequency Set");
+}
+
+static void mute (struct afb_req request) { /* AFB_SESSION_CHECK */
+
+ radioCtxHandleT *ctx = afb_req_context_get (request);
+ const char *value = afb_req_value (request, "value");
+ json_object *jresp = json_object_new_object();
+
+ if (!ctx) {
+ afb_req_fail (request, "failed", "you must call 'init' first");
+ return;
+ }
+
+ /* no "?value=" parameter : return current state */
+ if (!value || !ctx->radio) {
+ ctx->mute ?
+ json_object_object_add (jresp, "mute", json_object_new_string ("on"))
+ : json_object_object_add (jresp, "mute", json_object_new_string ("off"));
+ }
+
+ /* "?value=" parameter is "1" or "true" */
+ else if ( atoi(value) == 1 || !strcasecmp(value, "true") ) {
+ ctx->mute = 1;
+ _radio_set_mute (ctx->idx, ctx->mute);
+ json_object_object_add (jresp, "mute", json_object_new_string ("on"));
+ }
+
+ /* "?value=" parameter is "0" or "false" */
+ else if ( atoi(value) == 0 || !strcasecmp(value, "off") ) {
+ ctx->mute = 0;
+ _radio_set_mute (ctx->idx, ctx->mute);
+ json_object_object_add (jresp, "mute", json_object_new_string ("off"));
+ }
+
+ afb_req_success (request, jresp, "Radio - Mute set");
+}
+
+static void play (struct afb_req request) { /* AFB_SESSION_CHECK */
+
+ radioCtxHandleT *ctx = afb_req_context_get (request);
+ const char *value = afb_req_value (request, "value");
+ json_object *jresp = json_object_new_object();
+
+ if (!ctx) {
+ afb_req_fail (request, "failed", "you must call 'init' first");
+ return;
+ }
+
+ /* no "?value=" parameter : return current state */
+ if (!value || !ctx->radio) {
+ ctx->is_playing ?
+ json_object_object_add (jresp, "play", json_object_new_string ("on"))
+ : json_object_object_add (jresp, "play", json_object_new_string ("off"));
+ }
+
+ /* "?value=" parameter is "1" or "true" */
+ else if ( atoi(value) == 1 || !strcasecmp(value, "true") ) {
+ /* radio playback */
+ ctx->is_playing = 1;
+ _radio_play (ctx->idx);
+ json_object_object_add (jresp, "play", json_object_new_string ("on"));
+ }
+
+ /* "?value=" parameter is "0" or "false" */
+ else if ( atoi(value) == 0 || !strcasecmp(value, "false") ) {
+ /* radio stop */
+ ctx->is_playing = 0;
+ _radio_stop (ctx->idx);
+ json_object_object_add (jresp, "play", json_object_new_string ("off"));
+ }
+
+ afb_req_success (request, jresp, "Radio - Play succeeded");
+}
+
+static void ping (struct afb_req request) { /* AFB_SESSION_NONE */
+ afb_req_success (request, NULL, "Radio - Ping succeeded");
+}
+
+
+static const struct AFB_verb_desc_v1 verbs[] = {
+ {"init" , AFB_SESSION_CHECK, init , "Radio API - init"},
+ {"power" , AFB_SESSION_CHECK, power , "Radio API - power"},
+ {"mode" , AFB_SESSION_CHECK, mode , "Radio API - mode"},
+ {"freq" , AFB_SESSION_CHECK, freq , "Radio API - freq"},
+ {"mute" , AFB_SESSION_CHECK, mute , "Radio API - mute"},
+ {"play" , AFB_SESSION_CHECK, play , "Radio API - play"},
+ {"ping" , AFB_SESSION_NONE, ping , "Radio API - ping"},
+ {NULL}
+};
+
+static const struct AFB_plugin pluginDesc = {
+ .type = AFB_PLUGIN_VERSION_1,
+ .v1 = {
+ .info = "Application Framework Binder - Radio plugin",
+ .prefix = "radio",
+ .verbs = verbs
+ }
+};
+
+const struct AFB_plugin *pluginAfbV1Register (const struct AFB_interface *itf)
+{
+ return &pluginDesc;
+}
diff --git a/bindings/radio/radio-api.h b/bindings/radio/radio-api.h
new file mode 100644
index 00000000..9b91ec69
--- /dev/null
+++ b/bindings/radio/radio-api.h
@@ -0,0 +1,49 @@
+/*
+ * Copyright (C) 2015, 2016 "IoT.bzh"
+ * Author "Manuel Bachmann"
+ *
+ * Licensed under the Apache License, Version 2.0 (the "License");
+ * you may not use this file except in compliance with the License.
+ * You may obtain a copy of the License at
+ *
+ * http://www.apache.org/licenses/LICENSE-2.0
+ *
+ * Unless required by applicable law or agreed to in writing, software
+ * distributed under the License is distributed on an "AS IS" BASIS,
+ * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+ * See the License for the specific language governing permissions and
+ * limitations under the License.
+ */
+
+#ifndef RADIO_API_H
+#define RADIO_API_H
+
+/* -------------- PLUGIN DEFINITIONS ----------------- */
+
+#define MAX_RADIO 10
+typedef enum { FM, AM } Mode;
+
+/* structure holding one radio device with current usage status */
+typedef struct {
+ int idx;
+ char *name;
+ int used;
+} radioDevT;
+
+/* global plugin handle, should store everything we may need */
+typedef struct {
+ radioDevT *radios[MAX_RADIO]; // pointer to existing radio
+ unsigned int devCount;
+} pluginHandleT;
+
+/* private client context [will be destroyed when client leaves] */
+typedef struct {
+ radioDevT *radio; /* pointer to client radio */
+ int idx; /* radio index within global array */
+ Mode mode; /* radio mode: AM/FM */
+ float freq; /* radio frequency (Mhz) */
+ unsigned char mute; /* radio muted: 0(false)/1(true) */
+ unsigned char is_playing; /* radio is playing: 0(false)/1(true) */
+} radioCtxHandleT;
+
+#endif /* RADIO_API_H */
diff --git a/bindings/radio/radio-rtlsdr.c b/bindings/radio/radio-rtlsdr.c
new file mode 100644
index 00000000..7f76306e
--- /dev/null
+++ b/bindings/radio/radio-rtlsdr.c
@@ -0,0 +1,427 @@
+/*
+ * Copyright (C) 2015, 2016 "IoT.bzh"
+ * Author "Manuel Bachmann"
+ *
+ * Licensed under the Apache License, Version 2.0 (the "License");
+ * you may not use this file except in compliance with the License.
+ * You may obtain a copy of the License at
+ *
+ * http://www.apache.org/licenses/LICENSE-2.0
+ *
+ * Unless required by applicable law or agreed to in writing, software
+ * distributed under the License is distributed on an "AS IS" BASIS,
+ * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+ * See the License for the specific language governing permissions and
+ * limitations under the License.
+ */
+
+#include <stdio.h>
+#include <stdlib.h>
+#include <string.h>
+#include <unistd.h>
+
+#include "radio-api.h"
+#include "radio-rtlsdr.h"
+
+static void* _dongle_thread_fn (void *);
+static void* _demod_thread_fn (void *);
+static void* _output_thread_fn (void *);
+
+static unsigned int init_dev_count = 0;
+static struct dev_ctx **dev_ctx = NULL;
+
+/* ------------- RADIO RTLSDR IMPLEMENTATION ---------------- */
+
+/* --- PUBLIC FUNCTIONS --- */
+
+/* Radio initialization should be done only when user start the radio and not at plugin initialization
+ Making this call too early would impose to restart the binder to detect a radio */
+unsigned char _radio_on (unsigned int num, radioCtxHandleT *ctx) {
+
+ if (num >= _radio_dev_count())
+ return 0;
+
+ if (init_dev_count < _radio_dev_count()) {
+ init_dev_count = _radio_dev_count();
+ dev_ctx = (dev_ctx_T**) realloc (dev_ctx, init_dev_count * sizeof(dev_ctx_T*));
+ }
+
+ dev_ctx[num] = (dev_ctx_T*) malloc (sizeof(dev_ctx_T));
+ dev_ctx[num]->dev = NULL;
+ dev_ctx[num]->mode = ctx->mode;
+ dev_ctx[num]->freq = ctx->freq;
+ dev_ctx[num]->mute = ctx->mute;
+ dev_ctx[num]->should_run = 0;
+ dev_ctx[num]->dongle = NULL;
+ dev_ctx[num]->demod = NULL;
+ dev_ctx[num]->output = NULL;
+ _radio_dev_init (dev_ctx[num], num);
+
+ return 1;
+}
+
+void _radio_off (unsigned int num) {
+
+ if (num >= _radio_dev_count())
+ return;
+
+ if (dev_ctx[num]) {
+ _radio_dev_free (dev_ctx[num]);
+ free (dev_ctx[num]);
+ }
+
+ /* free(dev_ctx); */
+}
+
+void _radio_set_mode (unsigned int num, Mode mode) {
+ if (!dev_ctx || !dev_ctx[num])
+ return;
+
+ dev_ctx[num]->mode = mode;
+ _radio_apply_params (dev_ctx[num]);
+}
+
+void _radio_set_freq (unsigned int num, double freq) {
+ if (!dev_ctx || !dev_ctx[num])
+ return;
+
+ dev_ctx[num]->freq = (float)freq;
+ _radio_apply_params (dev_ctx[num]);
+}
+
+void _radio_set_mute (unsigned int num, unsigned char mute) {
+ if (!dev_ctx || !dev_ctx[num])
+ return;
+
+ dev_ctx[num]->mute = mute;
+ _radio_apply_params (dev_ctx[num]);
+}
+
+void _radio_play (unsigned int num) {
+ if (!dev_ctx || !dev_ctx[num])
+ return;
+
+ _radio_start_threads (dev_ctx[num]);
+}
+
+void _radio_stop (unsigned int num) {
+ if (!dev_ctx || !dev_ctx[num])
+ return;
+
+ _radio_stop_threads (dev_ctx[num]);
+}
+
+unsigned int _radio_dev_count () {
+ return rtlsdr_get_device_count();
+}
+
+const char* _radio_dev_name (unsigned int num) {
+ return rtlsdr_get_device_name (num);
+}
+
+
+/* --- LOCAL HELPER FUNCTIONS --- */
+
+unsigned char _radio_dev_init (dev_ctx_T *dev_ctx, unsigned int num) {
+ rtlsdr_dev_t *dev = dev_ctx->dev;
+
+ if (rtlsdr_open (&dev, num) < 0)
+ return 0;
+
+ rtlsdr_set_tuner_gain_mode (dev, 0);
+
+ if (rtlsdr_reset_buffer (dev) < 0)
+ return 0;
+
+ dev_ctx->dev = dev;
+
+ _radio_apply_params (dev_ctx);
+
+ return 1;
+}
+
+unsigned char _radio_dev_free (dev_ctx_T *dev_ctx) {
+ rtlsdr_dev_t *dev = dev_ctx->dev;
+
+ if (rtlsdr_close (dev) < 0)
+ return 0;
+ dev = NULL;
+
+ dev_ctx->dev = dev;
+
+ return 1;
+}
+
+void _radio_apply_params (dev_ctx_T *dev_ctx) {
+ rtlsdr_dev_t *dev = dev_ctx->dev;
+ Mode mode = dev_ctx->mode;
+ float freq = dev_ctx->freq;
+ int rate;
+
+ freq *= 1000000;
+ rate = ((1000000 / 200000) + 1) * 200000;
+
+ if (mode == FM)
+ freq += 16000;
+ freq += rate / 4;
+
+ rtlsdr_set_center_freq (dev, freq);
+ rtlsdr_set_sample_rate (dev, rate);
+
+ dev_ctx->dev = dev;
+}
+
+void _radio_start_threads (dev_ctx_T *dev_ctx) {
+ dev_ctx->dongle = (dongle_ctx*) malloc (sizeof(dongle_ctx));
+ dev_ctx->demod = (demod_ctx*) malloc (sizeof(demod_ctx));
+ dev_ctx->output = (output_ctx*) malloc (sizeof(output_ctx));
+
+ dongle_ctx *dongle = dev_ctx->dongle;
+ demod_ctx *demod = dev_ctx->demod;
+ output_ctx *output = dev_ctx->output;
+
+ pthread_rwlock_init (&demod->lck, NULL);
+ pthread_cond_init (&demod->ok, NULL);
+ pthread_mutex_init (&demod->ok_m, NULL);
+ pthread_rwlock_init (&output->lck, NULL);
+ pthread_cond_init (&output->ok, NULL);
+ pthread_mutex_init (&output->ok_m, NULL);
+
+ dev_ctx->should_run = 1;
+
+ /* dongle thread */
+ dongle->thr_finished = 0;
+ pthread_create (&dongle->thr, NULL, _dongle_thread_fn, (void*)dev_ctx);
+
+ /* demod thread */
+ demod->pre_r = demod->pre_j = 0;
+ demod->now_r = demod->now_j = 0;
+ demod->index = demod->pre_index = demod->now_index = 0;
+ demod->thr_finished = 0;
+ pthread_create (&demod->thr, NULL, _demod_thread_fn, (void*)dev_ctx);
+
+ /* output thread */
+ output->thr_finished = 0;
+ pthread_create (&output->thr, NULL, _output_thread_fn, (void*)dev_ctx);
+}
+
+void _radio_stop_threads (dev_ctx_T *dev_ctx) {
+ rtlsdr_dev_t *dev = dev_ctx->dev;
+ dongle_ctx *dongle = dev_ctx->dongle;
+ demod_ctx *demod = dev_ctx->demod;
+ output_ctx *output = dev_ctx->output;
+
+ if (!dongle || !demod || !output)
+ return;
+
+ /* stop each "while" loop in threads */
+ dev_ctx->should_run = 0;
+
+ rtlsdr_cancel_async (dev);
+ pthread_signal (&demod->ok, &demod->ok_m);
+ pthread_signal (&output->ok, &output->ok_m);
+
+ while (!dongle->thr_finished ||
+ !demod->thr_finished ||
+ !output->thr_finished)
+ usleep (100000);
+
+ pthread_join (dongle->thr, NULL);
+ pthread_join (demod->thr, NULL);
+ pthread_join (output->thr, NULL);
+ pthread_rwlock_destroy (&demod->lck);
+ pthread_cond_destroy (&demod->ok);
+ pthread_mutex_destroy (&demod->ok_m);
+ pthread_rwlock_destroy (&output->lck);
+ pthread_cond_destroy (&output->ok);
+ pthread_mutex_destroy (&output->ok_m);
+
+ free (dongle); dev_ctx->dongle = NULL;
+ free (demod); dev_ctx->demod = NULL;
+ free (output); dev_ctx->output = NULL;
+}
+
+ /* ---- LOCAL THREADED FUNCTIONS ---- */
+
+static void _rtlsdr_callback (unsigned char *buf, uint32_t len, void *ctx) {
+ dev_ctx_T *dev_ctx = (dev_ctx_T *)ctx;
+ dongle_ctx *dongle = dev_ctx->dongle;
+ demod_ctx *demod = dev_ctx->demod;
+ unsigned char tmp;
+ int i;
+
+ if (!dev_ctx->should_run)
+ return;
+
+ /* rotate 90° */
+ for (i = 0; i < (int)len; i += 8) {
+ tmp = 255 - buf[i+3];
+ buf[i+3] = buf[i+2];
+ buf[i+2] = tmp;
+
+ buf[i+4] = 255 - buf[i+4];
+ buf[i+5] = 255 - buf[i+5];
+
+ tmp = 255 - buf[i+6];
+ buf[i+6] = buf[i+7];
+ buf[i+7] = tmp;
+ }
+
+ /* write data */
+ for (i = 0; i < (int)len; i++)
+ dongle->buf[i] = (int16_t)buf[i] - 127;
+
+ /* lock demod thread, write to it, unlock */
+ pthread_rwlock_wrlock (&demod->lck);
+ memcpy (demod->buf, dongle->buf, 2 * len);
+ demod->buf_len = len;
+ pthread_rwlock_unlock (&demod->lck);
+ pthread_signal (&demod->ok, &demod->ok_m);
+}
+ /**/
+static void* _dongle_thread_fn (void *ctx) {
+ dev_ctx_T *dev_ctx = (dev_ctx_T *)ctx;
+ dongle_ctx *dongle = dev_ctx->dongle;
+
+ rtlsdr_read_async (dev_ctx->dev, _rtlsdr_callback, dev_ctx, 0, 0);
+
+ dongle->thr_finished = 1;
+ return 0;
+}
+
+static void _lowpass_demod (void *ctx) {
+ demod_ctx *demod = (demod_ctx *)ctx;
+ int i=0, i2=0;
+
+ while (i < demod->buf_len) {
+ demod->now_r += demod->buf[i];
+ demod->now_j += demod->buf[i+1];
+ i += 2;
+ demod->index++;
+ if (demod->index < ((1000000 / 200000) + 1))
+ continue;
+ demod->buf[i2] = demod->now_r;
+ demod->buf[i2+1] = demod->now_j;
+ demod->index = 0;
+ demod->now_r = demod->now_j = 0;
+ i2 += 2;
+ }
+ demod->buf_len = i2;
+}
+ /**/
+static void _lowpassreal_demod (void *ctx) {
+ demod_ctx *demod = (demod_ctx *)ctx;
+ int i=0, i2=0;
+ int fast = 200000;
+ int slow = 48000;
+
+ while (i < demod->res_len) {
+ demod->now_index += demod->res[i];
+ i++;
+ demod->pre_index += slow;
+ if (demod->pre_index < fast)
+ continue;
+ demod->res[i2] = (int16_t)(demod->now_index / (fast/slow));
+ demod->pre_index -= fast;
+ demod->now_index = 0;
+ i2 += 1;
+ }
+ demod->res_len = i2;
+}
+ /**/
+static void _multiply (int ar, int aj, int br, int bj, int *cr, int *cj) {
+ *cr = ar*br - aj*bj;
+ *cj = aj*br + ar*bj;
+}
+ /**/
+static int _polar_discriminant (int ar, int aj, int br, int bj) {
+ int cr, cj;
+ double angle;
+ _multiply (ar, aj, br, -bj, &cr, &cj);
+ angle = atan2 ((double)cj, (double)cr);
+ return (int)(angle / 3.14159 * (1<<14));
+}
+ /**/
+static void _fm_demod (void *ctx) {
+ demod_ctx *demod = (demod_ctx *)ctx;
+ int16_t *buf = demod->buf;
+ int buf_len = demod->buf_len;
+ int pcm, i;
+
+ pcm = _polar_discriminant (buf[0], buf[1], demod->pre_r, demod->pre_j);
+ demod->res[0] = (int16_t)pcm;
+
+ for (i = 2; i < (buf_len-1); i += 2) {
+ pcm = _polar_discriminant (buf[i], buf[i+1], buf[i-2], buf[i-1]);
+ demod->res[i/2] = (int16_t)pcm;
+ }
+ demod->pre_r = buf[buf_len - 2];
+ demod->pre_j = buf[buf_len - 1];
+ demod->res_len = buf_len/2;
+}
+ /**/
+static void _am_demod (void *ctx) {
+ demod_ctx *demod = (demod_ctx *)ctx;
+ int16_t *buf = demod->buf;
+ int buf_len = demod->buf_len;
+ int pcm, i;
+
+ for (i = 0; i < buf_len; i += 2) {
+ pcm = buf[i] * buf[i];
+ pcm += buf[i+1] * buf[i+1];
+ demod->res[i/2] = (int16_t)sqrt(pcm);
+ }
+ demod->res_len = buf_len/2;
+}
+ /**/
+static void* _demod_thread_fn (void *ctx) {
+ dev_ctx_T *dev_ctx = (dev_ctx_T *)ctx;
+ demod_ctx *demod = dev_ctx->demod;
+ output_ctx *output = dev_ctx->output;
+
+ while(dev_ctx->should_run) {
+ pthread_wait (&demod->ok, &demod->ok_m);
+ pthread_rwlock_wrlock (&demod->lck);
+ _lowpass_demod (demod);
+ if (dev_ctx->mode == FM)
+ _fm_demod (demod);
+ else
+ _am_demod (demod);
+ _lowpassreal_demod (demod);
+ pthread_rwlock_unlock (&demod->lck);
+
+ /* lock demod thread, write to it, unlock */
+ pthread_rwlock_wrlock (&output->lck);
+ memcpy (output->buf, demod->res, 2 * demod->res_len);
+ output->buf_len = demod->res_len;
+ pthread_rwlock_unlock (&output->lck);
+ pthread_signal (&output->ok, &output->ok_m);
+ }
+
+ demod->thr_finished = 1;
+ return 0;
+}
+
+static void* _output_thread_fn (void *ctx) {
+ dev_ctx_T *dev_ctx = (dev_ctx_T *)ctx;
+ output_ctx *output = dev_ctx->output;
+ FILE *file;
+
+ file = fopen (AUDIO_BUFFER, "wb");
+
+ while (dev_ctx->should_run) {
+ pthread_wait (&output->ok, &output->ok_m);
+ pthread_rwlock_rdlock (&output->lck);
+ if (!dev_ctx->mute && file) {
+ fwrite (output->buf, 2, output->buf_len, file);
+ fflush (file);
+ fseek (file, 0, SEEK_SET);
+ }
+ pthread_rwlock_unlock (&output->lck);
+ }
+ if (file) fclose(file);
+ unlink (AUDIO_BUFFER);
+
+ output->thr_finished = 1;
+ return 0;
+}
diff --git a/bindings/radio/radio-rtlsdr.h b/bindings/radio/radio-rtlsdr.h
new file mode 100644
index 00000000..2308f27e
--- /dev/null
+++ b/bindings/radio/radio-rtlsdr.h
@@ -0,0 +1,100 @@
+/*
+ * Copyright (C) 2015, 2016 "IoT.bzh"
+ * Author "Manuel Bachmann"
+ *
+ * Licensed under the Apache License, Version 2.0 (the "License");
+ * you may not use this file except in compliance with the License.
+ * You may obtain a copy of the License at
+ *
+ * http://www.apache.org/licenses/LICENSE-2.0
+ *
+ * Unless required by applicable law or agreed to in writing, software
+ * distributed under the License is distributed on an "AS IS" BASIS,
+ * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+ * See the License for the specific language governing permissions and
+ * limitations under the License.
+ */
+
+#ifndef RADIO_RTLSDR_H
+#define RADIO_RTLSDR_H
+
+/* -------------- RADIO RTLSDR DEFINITIONS ------------------ */
+
+#include <math.h>
+#include <pthread.h>
+#include <rtl-sdr.h>
+
+#include "radio-api.h"
+
+#define pthread_signal(n, m) pthread_mutex_lock(m); pthread_cond_signal(n); pthread_mutex_unlock(m)
+#define pthread_wait(n, m) pthread_mutex_lock(m); pthread_cond_wait(n, m); pthread_mutex_unlock(m)
+#define BUF_LEN 16*16384
+#define AUDIO_BUFFER "/tmp/audio_buf"
+
+typedef struct dongle_ctx dongle_ctx;
+typedef struct demod_ctx demod_ctx;
+typedef struct output_ctx output_ctx;
+typedef struct dev_ctx dev_ctx_T;
+
+struct dongle_ctx {
+ pthread_t thr;
+ unsigned char thr_finished;
+ uint16_t buf[BUF_LEN];
+ uint32_t buf_len;
+};
+
+struct demod_ctx {
+ pthread_t thr;
+ unsigned char thr_finished;
+ pthread_rwlock_t lck;
+ pthread_cond_t ok;
+ pthread_mutex_t ok_m;
+ int pre_r, pre_j, now_r, now_j, index;
+ int pre_index, now_index;
+ int16_t buf[BUF_LEN];
+ int buf_len;
+ int16_t res[BUF_LEN];
+ int res_len;
+};
+
+struct output_ctx {
+ pthread_t thr;
+ unsigned char thr_finished;
+ pthread_rwlock_t lck;
+ pthread_cond_t ok;
+ pthread_mutex_t ok_m;
+ int16_t buf[BUF_LEN];
+ int buf_len;
+};
+
+struct dev_ctx {
+ int used; /* TODO: radio is free ??? */
+ rtlsdr_dev_t* dev;
+ Mode mode;
+ float freq;
+ unsigned char mute;
+ unsigned char should_run;
+ /* thread contexts */
+ dongle_ctx *dongle;
+ demod_ctx *demod;
+ output_ctx *output;
+};
+
+unsigned int _radio_dev_count (void);
+const char* _radio_dev_name (unsigned int);
+
+unsigned char _radio_on (unsigned int, radioCtxHandleT *);
+void _radio_off (unsigned int);
+void _radio_stop (unsigned int);
+void _radio_play (unsigned int);
+void _radio_set_mode (unsigned int, Mode);
+void _radio_set_freq (unsigned int, double);
+void _radio_set_mute (unsigned int, unsigned char);
+
+unsigned char _radio_dev_init (struct dev_ctx *, unsigned int);
+unsigned char _radio_dev_free (struct dev_ctx *);
+void _radio_apply_params (struct dev_ctx *);
+void _radio_start_threads (struct dev_ctx *);
+void _radio_stop_threads (struct dev_ctx *);
+
+#endif /* RADIO_RTLSDR_H */