File: demod_eas.c

package info (click to toggle)
multimon 1.0-7.1
  • links: PTS
  • area: main
  • in suites: bullseye, buster, sid, stretch
  • size: 576 kB
  • ctags: 924
  • sloc: ansic: 8,144; makefile: 233; perl: 41
file content (140 lines) | stat: -rw-r--r-- 4,232 bytes parent folder | download | duplicates (2)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
/*
 *      demod_eas.c -- Emergency Alert System demodulator
 *
 *      See http://www.nws.noaa.gov/nwr/nwrsame.htm
 *
 *      Copyright (C) 2000
 *          A. Maitland Bottoms <bottoms@debian.org>
 *
 *      Licensed under same terms and based upon the 
 *         demod_afsk12.c -- 1200 baud AFSK demodulator
 *
 *         Copyright (C) 1996  
 *          Thomas Sailer (sailer@ife.ee.ethz.ch, hb9jnx@hb9w.che.eu)
 *
 *      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, write to the Free Software
 *      Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
 */

/* ---------------------------------------------------------------------- */

#include "multimon.h"
#include "filter.h"
#include <math.h>
#include <string.h>

/* ---------------------------------------------------------------------- */

/*
 * Standard TCM3105 clock frequency: 4.4336MHz
 * Bit Parameters
 * The following definitions of a bit are based on a bit period equaling
 * 1920 microseconds (± one microsecond). 
 * a.) The speed is 520.83 bits per second   
 * b.)  Logic zero is 1562.5 Hz.
 * c.)  Logic one is 2083.3 Hz 
 */

#define FREQ_MARK  1083.3
#define FREQ_SPACE 1562.5
#define FREQ_SAMP  22050
#define BAUD       520.83
#define SUBSAMP    2

/* ---------------------------------------------------------------------- */

#define CORRLEN ((int)(FREQ_SAMP/BAUD))
#define SPHASEINC (0x10000u*BAUD*SUBSAMP/FREQ_SAMP)

static float corr_mark_i[CORRLEN];
static float corr_mark_q[CORRLEN];
static float corr_space_i[CORRLEN];
static float corr_space_q[CORRLEN];

/* ---------------------------------------------------------------------- */
	
static void eas_init(struct demod_state *s)
{
	float f;
	int i;

	hdlc_init(s);
	memset(&s->l1.eas, 0, sizeof(s->l1.eas));
	for (f = 0, i = 0; i < CORRLEN; i++) {
		corr_mark_i[i] = cos(f);
		corr_mark_q[i] = sin(f);
		f += 2.0*M_PI*FREQ_MARK/FREQ_SAMP;
	}
	for (f = 0, i = 0; i < CORRLEN; i++) {
		corr_space_i[i] = cos(f);
		corr_space_q[i] = sin(f);
		f += 2.0*M_PI*FREQ_SPACE/FREQ_SAMP;
	}
}

/* ---------------------------------------------------------------------- */

static void eas_demod(struct demod_state *s, float *buffer, int length)
{
	float f;
	unsigned char curbit;

	if (s->l1.eas.subsamp) {
		int numfill = SUBSAMP - s->l1.eas.subsamp;
		if (length < numfill) {
			s->l1.eas.subsamp += length;
			return;
		}
		buffer += numfill;
		length -= numfill;
		s->l1.eas.subsamp = 0;
	}
	for (; length >= SUBSAMP; length -= SUBSAMP, buffer += SUBSAMP) {
		f = fsqr(mac(buffer, corr_mark_i, CORRLEN)) +
			fsqr(mac(buffer, corr_mark_q, CORRLEN)) -
			fsqr(mac(buffer, corr_space_i, CORRLEN)) -
			fsqr(mac(buffer, corr_space_q, CORRLEN));
		s->l1.eas.dcd_shreg <<= 1;
		s->l1.eas.dcd_shreg |= (f > 0);
		verbprintf(10, "%c", '0'+(s->l1.eas.dcd_shreg & 1));
		/*
		 * check if transition
		 */
		if ((s->l1.eas.dcd_shreg ^ (s->l1.eas.dcd_shreg >> 1)) & 1) {
			if (s->l1.eas.sphase < (0x8000u-(SPHASEINC/2)))
				s->l1.eas.sphase += SPHASEINC/8;
			else
				s->l1.eas.sphase -= SPHASEINC/8;
		}
		s->l1.eas.sphase += SPHASEINC;
		if (s->l1.eas.sphase >= 0x10000u) {
			s->l1.eas.sphase &= 0xffffu;
			s->l1.eas.lasts <<= 1;
			s->l1.eas.lasts |= s->l1.eas.dcd_shreg & 1;
			curbit = (s->l1.eas.lasts ^ 
				  (s->l1.eas.lasts >> 1) ^ 1) & 1;
			verbprintf(9, " %c ", '0'+curbit);
			hdlc_rxbit(s, curbit);
		}
	}
	s->l1.eas.subsamp = length;
}

/* ---------------------------------------------------------------------- */

const struct demod_param demod_eas = {
	"EAS", FREQ_SAMP, CORRLEN, eas_init, eas_demod
};

/* ---------------------------------------------------------------------- */