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>
55 #include <cpu/byteorder.h>
63 uint32_t data_written;
68 static void message_hook(UNUSED_ARG(struct AX25Msg *, msg))
73 static FILE *afsk_fileOpen(const char *name)
78 #warning TODO: open the file?
80 fp = fopen(name, "rb");
85 ASSERT(fread(snd, 1, 4, fp) == 4);
87 ASSERT(strcmp(snd, ".snd") == 0);
90 ASSERT(fread(&offset, 1, sizeof(offset), fp) == sizeof(offset));
91 offset = be32_to_cpu(offset);
92 kprintf("AU file offset: %ld\n", (long)offset);
95 ASSERT(fread(&data_size, 1, sizeof(data_size), fp) == sizeof(data_size));
96 data_size = be32_to_cpu(data_size);
97 kprintf("AU file data_size: %ld\n", (long)data_size);
101 ASSERT(fread(&encoding, 1, sizeof(encoding), fp) == sizeof(encoding));
102 encoding = be32_to_cpu(encoding);
103 kprintf("AU file encoding: %ld\n", (long)encoding);
104 ASSERT(encoding == 2); // 8 bit linear PCM
106 uint32_t sample_rate;
107 ASSERT(fread(&sample_rate, 1, sizeof(sample_rate), fp) == sizeof(sample_rate));
108 sample_rate = be32_to_cpu(sample_rate);
109 kprintf("AU file sample_rate: %ld\n", (long)sample_rate);
110 ASSERT(sample_rate == 9600);
113 ASSERT(fread(&channels, 1, sizeof(channels), fp) == sizeof(channels));
114 channels = be32_to_cpu(channels);
115 kprintf("AU file channels: %ld\n", (long)channels);
116 ASSERT(channels == 1);
119 #warning TODO: fseek?
121 ASSERT(fseek(fp, offset, SEEK_SET) == 0);
126 int afsk_testSetup(void)
129 fp_adc = afsk_fileOpen("test/afsk_test.au");
131 #warning TODO: open the file?
133 fp_dac = fopen("test/afsk_test_out.au", "w+b");
136 #define FS_HH (((uint32_t)CONFIG_AFSK_DAC_SAMPLERATE) >> 24)
137 #define FS_HL ((((uint32_t)CONFIG_AFSK_DAC_SAMPLERATE) >> 16) & 0xff)
138 #define FS_LH ((((uint32_t)CONFIG_AFSK_DAC_SAMPLERATE) >> 8) & 0xff)
139 #define FS_LL (((uint32_t)CONFIG_AFSK_DAC_SAMPLERATE) & 0xff)
141 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};
143 ASSERT(fwrite(snd_header, 1, sizeof(snd_header), fp_dac) == sizeof(snd_header));
146 afsk_init(&afsk_fd, 0 ,0);
147 ax25_init(&ax25, &afsk_fd.fd, message_hook);
152 static void messageout_hook(struct AX25Msg *msg)
154 ASSERT(strncmp(msg->dst.call, "ABCDEF", 6) == 0);
155 ASSERT(strncmp(msg->src.call, "123456", 6) == 0);
156 ASSERT(msg->src.ssid == 1);
157 ASSERT(msg->dst.ssid == 0);
158 ASSERT(msg->ctrl == AX25_CTRL_UI);
159 ASSERT(msg->pid == AX25_PID_NOLAYER3);
160 ASSERT(msg->len == 256);
161 for (int i = 0; i < 256; i++)
162 ASSERT(msg->info[i] == i);
165 int afsk_testRun(void)
168 while ((c = fgetc(fp_adc)) != EOF)
170 afsk_adc_isr(&afsk_fd, (int8_t)c);
174 kprintf("Messages correctly received: %d\n", msg_cnt);
175 ASSERT(msg_cnt >= 15);
178 for (unsigned i = 0; i < sizeof(buf); i++)
181 ax25_send(&ax25, AX25_CALL("abcdef", 0), AX25_CALL("123456", 1), buf, sizeof(buf));
185 int8_t val = afsk_dac_isr(&afsk_fd) - 128;
186 ASSERT(fwrite(&val, 1, sizeof(val), fp_dac) == sizeof(val));
189 while (afsk_fd.sending);
191 #define SND_DATASIZE_OFF 8
193 #warning TODO: fseek?
195 ASSERT(fseek(fp_dac, SND_DATASIZE_OFF, SEEK_SET) == 0);
197 data_written = cpu_to_be32(data_written);
198 ASSERT(fwrite(&data_written, 1, sizeof(data_written), fp_dac) == sizeof(data_written));
199 ASSERT(fclose(fp_adc) + fclose(fp_dac) == 0);
201 fp_adc = afsk_fileOpen("test/afsk_test_out.au");
202 ax25_init(&ax25, &afsk_fd.fd, messageout_hook);
204 while ((c = fgetc(fp_adc)) != EOF)
206 afsk_adc_isr(&afsk_fd, (int8_t)c);
214 int afsk_testTearDown(void)
216 return fclose(fp_adc);