direwolf/rdq.c

454 lines
9.7 KiB
C
Raw Permalink Normal View History

Version 1.0 - Initial commit Changes to be committed: new file: .gitattributes new file: .gitignore new file: APRStt-Implementation-Notes.pdf new file: CHANGES.txt new file: LICENSE-dire-wolf.txt new file: LICENSE-other.txt new file: Makefile.linux new file: Makefile.win new file: Quick-Start-Guide-Windows.pdf new file: Raspberry-Pi-APRS.pdf new file: User-Guide.pdf new file: aclients.c new file: aprs_tt.c new file: aprs_tt.h new file: atest.c new file: audio.c new file: audio.h new file: audio_win.c new file: ax25_pad.c new file: ax25_pad.h new file: beacon.c new file: beacon.h new file: config.c new file: config.h new file: decode_aprs.c new file: decode_aprs.h new file: dedupe.c new file: dedupe.h new file: demod.c new file: demod.h new file: demod_9600.c new file: demod_9600.h new file: demod_afsk.c new file: demod_afsk.h new file: digipeater.c new file: digipeater.h new file: direwolf.c new file: direwolf.conf new file: direwolf.desktop new file: direwolf.h new file: dsp.c new file: dsp.h new file: dtmf.c new file: dtmf.h new file: dw-icon.ico new file: dw-icon.png new file: dw-icon.rc new file: dw-start.sh new file: dwgps.c new file: dwgps.h new file: encode_aprs.c new file: encode_aprs.h new file: fcs_calc.c new file: fcs_calc.h new file: fsk_demod_agc.h new file: fsk_demod_state.h new file: fsk_filters.h new file: fsk_gen_filter.h new file: gen_packets.c new file: gen_tone.c new file: gen_tone.h new file: hdlc_rec.c new file: hdlc_rec.h new file: hdlc_rec2.c new file: hdlc_rec2.h new file: hdlc_send.c new file: hdlc_send.h new file: igate.c new file: igate.h new file: kiss.c new file: kiss.h new file: kiss_frame.c new file: kiss_frame.h new file: kissnet.c new file: kissnet.h new file: latlong.c new file: latlong.h new file: ll2utm.c new file: misc/README-dire-wolf.txt new file: misc/strcasestr.c new file: misc/strsep.c new file: misc/strtok_r.c new file: morse.c new file: multi_modem.c new file: multi_modem.h new file: ptt.c new file: ptt.h new file: pttest.c new file: rdq.c new file: rdq.h new file: redecode.c new file: redecode.h new file: regex/COPYING new file: regex/INSTALL new file: regex/LICENSES new file: regex/NEWS new file: regex/README new file: regex/README-dire-wolf.txt new file: regex/re_comp.h new file: regex/regcomp.c new file: regex/regex.c new file: regex/regex.h new file: regex/regex_internal.c new file: regex/regex_internal.h new file: regex/regexec.c new file: rrbb.c new file: rrbb.h new file: server.c new file: server.h new file: symbols-new.txt new file: symbols.c new file: symbols.h new file: symbolsX.txt new file: textcolor.c new file: textcolor.h new file: tocalls.txt new file: tq.c new file: tq.h new file: tt_text.c new file: tt_text.h new file: tt_user.c new file: tt_user.h new file: tune.h new file: udp_test.c new file: utm/LatLong-UTMconversion.c new file: utm/LatLong-UTMconversion.h new file: utm/README.txt new file: utm/SwissGrid.cpp new file: utm/UTMConversions.cpp new file: utm/constants.h new file: utm2ll.c new file: version.h new file: xmit.c new file: xmit.h
2015-07-27 00:35:07 +00:00
//
// This file is part of Dire Wolf, an amateur radio packet TNC.
//
// Copyright (C) 2011,2012 John Langner, WB2OSZ
//
// This program is free software: you can redistribute it and/or modify
// it under the terms of the GNU General Public License as published by
// the Free Software Foundation, either version 2 of the License, or
// (at your option) any later version.
//
// This program is distributed in the hope that it will be useful,
// but WITHOUT ANY WARRANTY; without even the implied warranty of
// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
// GNU General Public License for more details.
//
// You should have received a copy of the GNU General Public License
// along with this program. If not, see <http://www.gnu.org/licenses/>.
//
/*------------------------------------------------------------------
*
* Module: rdq.c
*
* Purpose: Retry later decode queue for frames with bad FCS.
*
* Description:
*
*---------------------------------------------------------------*/
#include <stdio.h>
#include <unistd.h>
#include <stdlib.h>
#include <assert.h>
#include <string.h>
#include "direwolf.h"
#include "ax25_pad.h"
#include "textcolor.h"
#include "audio.h"
#include "rdq.h"
#include "dedupe.h"
static rrbb_t queue_head; /* Head of linked list for queue. */
#if __WIN32__
static CRITICAL_SECTION rdq_cs; /* Critical section for updating queues. */
static HANDLE wake_up_event; /* Notify try decode again thread when queue not empty. */
#else
static pthread_mutex_t rdq_mutex; /* Critical section for updating queues. */
static pthread_cond_t wake_up_cond; /* Notify try decode again thread when queue not empty. */
static pthread_mutex_t wake_up_mutex; /* Required by cond_wait. */
#endif
/*-------------------------------------------------------------------
*
* Name: rdq_init
*
* Purpose: Initialize the receive decode again queue.
*
* Inputs: None. Only single queue for all channels.
*
* Outputs:
*
* Description: Initialize the queue to be empty and set up other
* mechanisms for sharing it between different threads.
*
*--------------------------------------------------------------------*/
void rdq_init (void)
{
//int c, p;
#if __WIN32__
#else
int err;
#endif
#if DEBUG
text_color_set(DW_COLOR_DEBUG);
dw_printf ("rdq_init ( )\n");
dw_printf ("rdq_init: pthread_mutex_init...\n");
#endif
#if __WIN32__
InitializeCriticalSection (&rdq_cs);
#else
err = pthread_mutex_init (&wake_up_mutex, NULL);
err = pthread_mutex_init (&rdq_mutex, NULL);
if (err != 0) {
text_color_set(DW_COLOR_ERROR);
dw_printf ("rdq_init: pthread_mutex_init err=%d", err);
perror ("");
exit (1);
}
#endif
#if DEBUG
text_color_set(DW_COLOR_DEBUG);
dw_printf ("rdq_init: pthread_cond_init...\n");
#endif
#if __WIN32__
wake_up_event = CreateEvent (NULL, 0, 0, NULL);
if (wake_up_event == NULL) {
text_color_set(DW_COLOR_ERROR);
dw_printf ("rdq_init: pthread_cond_init: can't create decode wake up event");
exit (1);
}
#else
err = pthread_cond_init (&wake_up_cond, NULL);
#if DEBUG
text_color_set(DW_COLOR_DEBUG);
dw_printf ("rdq_init: pthread_cond_init returns %d\n", err);
#endif
if (err != 0) {
text_color_set(DW_COLOR_ERROR);
dw_printf ("rdq_init: pthread_cond_init err=%d", err);
perror ("");
exit (1);
}
#endif
} /* end rdq_init */
/*-------------------------------------------------------------------
*
* Name: rdq_append
*
* Purpose: Add a packet to the end of the queue.
*
* Inputs: pp - Address of raw received bit buffer.
* Caller should NOT make any references to
* it after this point because it could
* be deleted at any time.
*
* Outputs:
*
* Description: Add buffer to end of linked list.
* Signal the decode thread if the queue was formerly empty.
*
*--------------------------------------------------------------------*/
void rdq_append (rrbb_t rrbb)
{
//int was_empty;
rrbb_t plast;
rrbb_t pnext;
#ifndef __WIN32__
int err;
#endif
#if DEBUG
text_color_set(DW_COLOR_DEBUG);
dw_printf ("rdq_append (rrbb=%p)\n", rrbb);
dw_printf ("rdq_append: enter critical section\n");
#endif
#if __WIN32__
EnterCriticalSection (&rdq_cs);
#else
err = pthread_mutex_lock (&rdq_mutex);
if (err != 0) {
text_color_set(DW_COLOR_ERROR);
dw_printf ("rdq_append: pthread_mutex_lock err=%d", err);
perror ("");
exit (1);
}
#endif
//was_empty = 1;
//if (queue_head != NULL) {
//was_empty = 0;
//}
if (queue_head == NULL) {
queue_head = rrbb;
}
else {
plast = queue_head;
while ((pnext = rrbb_get_nextp(plast)) != NULL) {
plast = pnext;
}
rrbb_set_nextp (plast, rrbb);
}
#if __WIN32__
LeaveCriticalSection (&rdq_cs);
#else
err = pthread_mutex_unlock (&rdq_mutex);
if (err != 0) {
text_color_set(DW_COLOR_ERROR);
dw_printf ("rdq_append: pthread_mutex_unlock err=%d", err);
perror ("");
exit (1);
}
#endif
#if DEBUG
text_color_set(DW_COLOR_DEBUG);
dw_printf ("rdq_append: left critical section\n");
dw_printf ("rdq_append (): about to wake up retry decode thread.\n");
#endif
#if __WIN32__
SetEvent (wake_up_event);
#else
err = pthread_mutex_lock (&wake_up_mutex);
if (err != 0) {
text_color_set(DW_COLOR_ERROR);
dw_printf ("rdq_append: pthread_mutex_lock wu err=%d", err);
perror ("");
exit (1);
}
err = pthread_cond_signal (&wake_up_cond);
if (err != 0) {
text_color_set(DW_COLOR_ERROR);
dw_printf ("rdq_append: pthread_cond_signal err=%d", err);
perror ("");
exit (1);
}
err = pthread_mutex_unlock (&wake_up_mutex);
if (err != 0) {
text_color_set(DW_COLOR_ERROR);
dw_printf ("rdq_append: pthread_mutex_unlock wu err=%d", err);
perror ("");
exit (1);
}
#endif
}
/*-------------------------------------------------------------------
*
* Name: rdq_wait_while_empty
*
* Purpose: Sleep while the queue is empty rather than
* polling periodically.
*
* Inputs: None.
*
*--------------------------------------------------------------------*/
void rdq_wait_while_empty (void)
{
int is_empty;
#ifndef __WIN32__
int err;
#endif
#if DEBUG
text_color_set(DW_COLOR_DEBUG);
dw_printf ("rdq_wait_while_empty () : enter critical section\n");
#endif
#if __WIN32__
EnterCriticalSection (&rdq_cs);
#else
err = pthread_mutex_lock (&rdq_mutex);
if (err != 0) {
text_color_set(DW_COLOR_ERROR);
dw_printf ("rdq_wait_while_empty: pthread_mutex_lock err=%d", err);
perror ("");
exit (1);
}
#endif
#if DEBUG
//text_color_set(DW_COLOR_DEBUG);
//dw_printf ("rdq_wait_while_empty (): after pthread_mutex_lock\n");
#endif
is_empty = 1;
if (queue_head != NULL)
is_empty = 0;
#if __WIN32__
LeaveCriticalSection (&rdq_cs);
#else
err = pthread_mutex_unlock (&rdq_mutex);
if (err != 0) {
text_color_set(DW_COLOR_ERROR);
dw_printf ("rdq_wait_while_empty: pthread_mutex_unlock err=%d", err);
perror ("");
exit (1);
}
#endif
#if DEBUG
text_color_set(DW_COLOR_DEBUG);
dw_printf ("rdq_wait_while_empty () : left critical section\n");
#endif
#if DEBUG
text_color_set(DW_COLOR_DEBUG);
dw_printf ("rdq_wait_while_empty (): is_empty = %d\n", is_empty);
#endif
if (is_empty) {
#if DEBUG
text_color_set(DW_COLOR_DEBUG);
dw_printf ("rdq_wait_while_empty (): SLEEP - about to call cond wait\n");
#endif
#if __WIN32__
WaitForSingleObject (wake_up_event, INFINITE);
#if DEBUG
text_color_set(DW_COLOR_DEBUG);
dw_printf ("rdq_wait_while_empty (): returned from wait\n");
#endif
#else
err = pthread_mutex_lock (&wake_up_mutex);
if (err != 0) {
text_color_set(DW_COLOR_ERROR);
dw_printf ("rdq_wait_while_empty: pthread_mutex_lock wu err=%d", err);
perror ("");
exit (1);
}
err = pthread_cond_wait (&wake_up_cond, &wake_up_mutex);
#if DEBUG
text_color_set(DW_COLOR_DEBUG);
dw_printf ("rdq_wait_while_empty (): WOKE UP - returned from cond wait, err = %d\n", err);
#endif
if (err != 0) {
text_color_set(DW_COLOR_ERROR);
dw_printf ("rdq_wait_while_empty: pthread_cond_wait err=%d", err);
perror ("");
exit (1);
}
err = pthread_mutex_unlock (&wake_up_mutex);
if (err != 0) {
text_color_set(DW_COLOR_ERROR);
dw_printf ("rdq_wait_while_empty: pthread_mutex_unlock wu err=%d", err);
perror ("");
exit (1);
}
#endif
}
#if DEBUG
text_color_set(DW_COLOR_DEBUG);
dw_printf ("rdq_wait_while_empty () returns\n");
#endif
}
/*-------------------------------------------------------------------
*
* Name: rdq_remove
*
* Purpose: Remove raw bit buffer from the head of the queue.
*
* Inputs: none
*
* Returns: Pointer to rrbb object.
* Caller should destroy it with rrbb_delete when finished with it.
*
*--------------------------------------------------------------------*/
rrbb_t rdq_remove (void)
{
rrbb_t result_p;
#ifndef __WIN32__
int err;
#endif
#if DEBUG
text_color_set(DW_COLOR_DEBUG);
dw_printf ("rdq_remove() enter critical section\n");
#endif
#if __WIN32__
EnterCriticalSection (&rdq_cs);
#else
err = pthread_mutex_lock (&rdq_mutex);
if (err != 0) {
text_color_set(DW_COLOR_ERROR);
dw_printf ("rdq_remove: pthread_mutex_lock err=%d", err);
perror ("");
exit (1);
}
#endif
if (queue_head == NULL) {
result_p = NULL;
}
else {
result_p = queue_head;
queue_head = rrbb_get_nextp(result_p);
rrbb_set_nextp (result_p, NULL);
}
#if __WIN32__
LeaveCriticalSection (&rdq_cs);
#else
err = pthread_mutex_unlock (&rdq_mutex);
if (err != 0) {
text_color_set(DW_COLOR_ERROR);
dw_printf ("rdq_remove: pthread_mutex_unlock err=%d", err);
perror ("");
exit (1);
}
#endif
#if DEBUG
text_color_set(DW_COLOR_DEBUG);
dw_printf ("rdq_remove() leave critical section, returns %p\n", result_p);
#endif
return (result_p);
}
/* end rdq.c */