4 * This file is part of BeRTOS.
6 * Bertos is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or
9 * (at your option) any later version.
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
16 * You should have received a copy of the GNU General Public License
17 * along with this program; if not, write to the Free Software
18 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
20 * As a special exception, you may use this file as part of a free software
21 * library without restriction. Specifically, if other files instantiate
22 * templates or use macros or inline functions from this file, or you compile
23 * this file and link it with other files to produce an executable, this
24 * file does not by itself cause the resulting executable to be covered by
25 * the GNU General Public License. This exception does not however
26 * invalidate any other reasons why the executable file might be covered by
27 * the GNU General Public License.
29 * Copyright 2009 Develer S.r.l. (http://www.develer.com/)
33 * \brief AFSK demodulator test.
36 * \author Francesco Sacchi <batt@develer.com>
37 * $test$: cp bertos/cfg/cfg_ax25.h $cfgdir/
38 * $test$: echo "#undef AX25_LOG_LEVEL" >> $cfgdir/cfg_ax25.h
39 * $test$: echo "#define AX25_LOG_LEVEL LOG_LVL_INFO" >> $cfgdir/cfg_ax25.h
40 * $test$: cp bertos/cfg/cfg_afsk.h $cfgdir/
41 * $test$: echo "#undef CONFIG_AFSK_TX_BUFLEN" >> $cfgdir/cfg_afsk.h
42 * $test$: echo "#define CONFIG_AFSK_TX_BUFLEN 512" >> $cfgdir/cfg_afsk.h
47 #include "cfg/cfg_afsk.h"
49 #include <drv/timer.h>
53 #include <cfg/debug.h>
54 #include <cfg/kfile_debug.h>
56 #include <cpu/byteorder.h>
64 uint32_t data_written;
70 static void message_hook(struct AX25Msg *msg)
73 ax25_print(&dbg.fd, msg);
76 static FILE *afsk_fileOpen(const char *name)
81 #warning TODO: open the file?
83 fp = fopen(name, "rb");
88 ASSERT(fread(snd, 1, 4, fp) == 4);
90 ASSERT(strcmp(snd, ".snd") == 0);
93 ASSERT(fread(&offset, 1, sizeof(offset), fp) == sizeof(offset));
94 offset = be32_to_cpu(offset);
95 kprintf("AU file offset: %ld\n", (long)offset);
98 ASSERT(fread(&data_size, 1, sizeof(data_size), fp) == sizeof(data_size));
99 data_size = be32_to_cpu(data_size);
100 kprintf("AU file data_size: %ld\n", (long)data_size);
104 ASSERT(fread(&encoding, 1, sizeof(encoding), fp) == sizeof(encoding));
105 encoding = be32_to_cpu(encoding);
106 kprintf("AU file encoding: %ld\n", (long)encoding);
107 ASSERT(encoding == 2); // 8 bit linear PCM
109 uint32_t sample_rate;
110 ASSERT(fread(&sample_rate, 1, sizeof(sample_rate), fp) == sizeof(sample_rate));
111 sample_rate = be32_to_cpu(sample_rate);
112 kprintf("AU file sample_rate: %ld\n", (long)sample_rate);
113 ASSERT(sample_rate == 9600);
116 ASSERT(fread(&channels, 1, sizeof(channels), fp) == sizeof(channels));
117 channels = be32_to_cpu(channels);
118 kprintf("AU file channels: %ld\n", (long)channels);
119 ASSERT(channels == 1);
122 #warning TODO: fseek?
124 ASSERT(fseek(fp, offset, SEEK_SET) == 0);
129 int afsk_testSetup(void)
132 kfiledebug_init(&dbg);
133 fp_adc = afsk_fileOpen("test/afsk_test.au");
135 #warning TODO: open the file?
137 fp_dac = fopen("test/afsk_test_out.au", "w+b");
140 #define FS_HH (((uint32_t)CONFIG_AFSK_DAC_SAMPLERATE) >> 24)
141 #define FS_HL ((((uint32_t)CONFIG_AFSK_DAC_SAMPLERATE) >> 16) & 0xff)
142 #define FS_LH ((((uint32_t)CONFIG_AFSK_DAC_SAMPLERATE) >> 8) & 0xff)
143 #define FS_LL (((uint32_t)CONFIG_AFSK_DAC_SAMPLERATE) & 0xff)
145 uint8_t snd_header[] = { '.','s','n','d', 0,0,0,24, 0,0,0,0, 0,0,0,2, FS_HH,FS_HL,FS_LH,FS_LL, 0,0,0,1};
147 ASSERT(fwrite(snd_header, 1, sizeof(snd_header), fp_dac) == sizeof(snd_header));
150 afsk_init(&afsk_fd, 0 ,0);
151 ax25_init(&ax25, &afsk_fd.fd, message_hook);
156 static void messageout_hook(struct AX25Msg *msg)
158 ASSERT(strncmp(msg->dst.call, "ABCDEF", 6) == 0);
159 ASSERT(strncmp(msg->src.call, "123456", 6) == 0);
160 ASSERT(msg->src.ssid == 1);
161 ASSERT(msg->dst.ssid == 0);
162 ASSERT(msg->ctrl == AX25_CTRL_UI);
163 ASSERT(msg->pid == AX25_PID_NOLAYER3);
164 ASSERT(msg->len == 256);
165 for (int i = 0; i < 256; i++)
166 ASSERT(msg->info[i] == i);
169 int afsk_testRun(void)
172 while ((c = fgetc(fp_adc)) != EOF)
174 afsk_adc_isr(&afsk_fd, (int8_t)c);
178 kprintf("Messages correctly received: %d\n", msg_cnt);
179 ASSERT(msg_cnt >= 15);
182 for (unsigned i = 0; i < sizeof(buf); i++)
185 ax25_send(&ax25, AX25_CALL("abcdef", 0), AX25_CALL("123456", 1), buf, sizeof(buf));
189 int8_t val = afsk_dac_isr(&afsk_fd) - 128;
190 ASSERT(fwrite(&val, 1, sizeof(val), fp_dac) == sizeof(val));
193 while (afsk_fd.sending);
195 #define SND_DATASIZE_OFF 8
197 #warning TODO: fseek?
199 ASSERT(fseek(fp_dac, SND_DATASIZE_OFF, SEEK_SET) == 0);
201 data_written = cpu_to_be32(data_written);
202 ASSERT(fwrite(&data_written, 1, sizeof(data_written), fp_dac) == sizeof(data_written));
203 ASSERT(fclose(fp_adc) + fclose(fp_dac) == 0);
205 fp_adc = afsk_fileOpen("test/afsk_test_out.au");
206 ax25_init(&ax25, &afsk_fd.fd, messageout_hook);
208 while ((c = fgetc(fp_adc)) != EOF)
210 afsk_adc_isr(&afsk_fd, (int8_t)c);
218 int afsk_testTearDown(void)
220 return fclose(fp_adc);