Restoring jammer and RDS functionalities, please wait...

Started work on frequency manager and numbers station simulator
This commit is contained in:
furrtek 2016-12-05 12:56:41 +01:00
parent ef0feae62b
commit d18b6d135d
43 changed files with 1083 additions and 734 deletions

View file

@ -22,7 +22,7 @@
#include "ui_rds.hpp"
#include "ch.h"
#include "rds.hpp"
#include "ff.h"
#include "hackrf_gpio.hpp"
#include "portapack.hpp"
@ -35,6 +35,7 @@
#include <cstring>
using namespace portapack;
using namespace rds;
namespace ui {
@ -42,186 +43,49 @@ void RDSView::focus() {
button_editpsn.focus();
}
void RDSView::on_tuning_frequency_changed(rf::Frequency f) {
transmitter_model.set_tuning_frequency(f);
}
RDSView::~RDSView() {
radio::disable();
transmitter_model.disable();
baseband::shutdown();
}
std::string to_string_bin(const uint32_t n, const uint8_t l) {
char p[33];
for (uint8_t c = 0; c < l; c++) {
if ((n << c) & (1 << l))
p[c] = '1';
else
p[c] = '0';
}
p[l] = 0;
return p;
}
uint32_t makeblock(uint32_t blockdata, uint16_t offset) {
uint16_t CRC = 0;
uint8_t doinv;
for (uint8_t i = 0; i < 16; i++) {
doinv = (((blockdata << i) & 0x8000) >> 15) ^ (CRC >> 9);
if (doinv) CRC ^= 0b0011011100;
CRC = ((CRC << 1) | doinv) & 0x3FF;
}
return (blockdata << 10) | (CRC ^ offset);
}
// Todo:
// Make PI
// Set frequency
// TA/TP flags
// Group selection
uint8_t RDSView::b2b(const bool in) {
if (in)
return 1;
else
return 0;
}
void RDSView::make_0B_group(uint32_t group[], const uint16_t PI_code, const bool TP, const uint8_t PTY, const bool TA,
const bool MS, const bool DI, const uint8_t C, const char * chars) {
group[0] = PI_code;
group[1] = (0x0 << 12) | (1 << 11) | (b2b(TP) << 10) | (PTY << 5) | (b2b(TA) << 4) | (b2b(MS) << 3) | (b2b(DI) << 2) | (C & 3);
group[2] = PI_code;
group[3] = (chars[0] << 8) | chars[1];
}
void RDSView::make_2A_group(uint32_t group[], const uint16_t PI_code, const bool TP, const uint8_t PTY, const bool AB,
const bool segment, const char * chars) {
group[0] = PI_code;
group[1] = (0x0 << 12) | (1 << 11) | (b2b(TP) << 10) | (PTY << 5) | (b2b(AB) << 4) | (segment & 15);
group[2] = (chars[0] << 8) | chars[1];
group[3] = (chars[2] << 8) | chars[3];
}
void RDSView::gen_PSN(const char * psname) {
uint8_t c;
uint32_t group[4][4] = { 0 };
make_0B_group(&group[0][0], 0xF849, true, options_pty.selected_index(), false, true, false, 0, &psname[0]);
make_0B_group(&group[1][0], 0xF849, true, options_pty.selected_index(), false, true, false, 1, &psname[2]);
make_0B_group(&group[2][0], 0xF849, true, options_pty.selected_index(), false, true, false, 2, &psname[4]);
make_0B_group(&group[3][0], 0xF849, true, options_pty.selected_index(), false, true, false, 3, &psname[6]);
void RDSView::start_tx() {
transmitter_model.set_baseband_configuration({
.mode = 0,
.sampling_rate = 2280000,
.decimation_factor = 1,
});
transmitter_model.set_rf_amp(true);
transmitter_model.set_lna(40);
transmitter_model.set_vga(40);
transmitter_model.set_baseband_bandwidth(1750000);
transmitter_model.enable();
/*uint32_t group[4][4] = {
{
0b1111100001001001, //PI
0b0000110011101000, //Address
0b1111100001001001, //PI
0b0000000000000000 //Replaced
},
{
0b1111100001001001, //PI
0b0000110011101001, //Address
0b1111100001001001, //PI
0b0000000000000000 //Replaced
},
{
0b1111100001001001, //PI
0b0000110011101010, //Address
0b1111100001001001, //PI
0b0000000000000000 //Replaced
},
{
0b1111100001001001, //PI
0b0000110011101011, //Address
0b1111100001001001, //PI
0b0000000000000000 //Replaced
},
};
//Insert PSN data in groups
group[0][3] = (psname[0] << 8) | psname[1];
group[1][3] = (psname[2] << 8) | psname[3];
group[2][3] = (psname[4] << 8) | psname[5];
group[3][3] = (psname[6] << 8) | psname[7];
*/
// Generate checkbits
for (c = 0; c < 4; c++) {
group[c][0] = makeblock(group[c][0], RDS_OFFSET_A);
group[c][1] = makeblock(group[c][1], RDS_OFFSET_B);
group[c][2] = makeblock(group[c][2], RDS_OFFSET_Cp); // C' !
group[c][3] = makeblock(group[c][3], RDS_OFFSET_D);
}
// Todo
//for (c = 0; c < 16; c++)
// shared_memory.radio_data[c] = group[c >> 2][c & 3];
shared_memory.bit_length = 4 * 4 * 26;
}
void RDSView::gen_RadioText(const char * radiotext) {
size_t c, i;
uint32_t * group;
char radiotext_buffer[65] = { 0 };
uint8_t rtlen, groups;
strcpy(radiotext_buffer, radiotext);
rtlen = strlen(radiotext_buffer);
radiotext_buffer[rtlen] = 0x0D;
// Pad to multiple of 4
while(rtlen & 3) {
radiotext_buffer[rtlen] = ' ';
rtlen++;
}
groups = rtlen >> 2; // 4 characters per group
group = (uint32_t*)chHeapAlloc(0x0, 4 * groups * sizeof(uint32_t));
for (c = 0; c < groups; c++)
make_2A_group(&group[c << 2], 0xF849, true, options_pty.selected_index(), false, c, &radiotext_buffer[c << 2]);
// Generate checkbits
for (c = 0; c < groups; c++) {
i = c * 4;
group[i + 0] = makeblock(group[i + 0], RDS_OFFSET_A);
group[i + 1] = makeblock(group[i + 1], RDS_OFFSET_B);
group[i + 2] = makeblock(group[i + 2], RDS_OFFSET_C);
group[i + 3] = makeblock(group[i + 3], RDS_OFFSET_D);
}
// Todo
//for (c = 0; c < (groups * 4); c++)
// shared_memory.radio_data[c] = group[c];
shared_memory.bit_length = groups * 4 * 26;
baseband::set_rds_data(message_length);
}
void RDSView::paint(Painter& painter) {
char RadioTextA[17];
(void)painter;
text_psn.set(PSN);
memcpy(RadioTextA, RadioText, 16);
RadioTextA[16] = 0;
text_radiotexta.set(RadioTextA);
text_radiotextb.set(&RadioText[16]);
memcpy(RadioTextA, RadioText + 16, 8);
RadioTextA[8] = 0;
text_radiotextb.set(RadioTextA);
}
RDSView::RDSView(NavigationView& nav) {
baseband::run_image(portapack::spi_flash::image_tag_rds);
strcpy(PSN, "TEST1234");
strcpy(RadioText, "Radiotext test !");
strcpy(RadioText, "Radiotext test ABCD1234");
add_children({ {
&field_frequency,
@ -239,12 +103,16 @@ RDSView::RDSView(NavigationView& nav) {
&button_exit
} });
rds_radio_config.tuning_frequency = tuning_frequency;
field_frequency.set_step(100000);
field_frequency.set_value(transmitter_model.tuning_frequency());
field_frequency.set_step(50000); // 50kHz steps
field_frequency.on_change = [this](rf::Frequency f) {
this->on_tuning_frequency_changed(f);
};
field_frequency.on_edit = [this, &nav]() {
auto new_view = nav.push<FrequencyKeypadView>(tuning_frequency);
auto new_view = nav.push<FrequencyKeypadView>(field_frequency.value());
new_view->on_changed = [this](rf::Frequency f) {
this->field_frequency.set_value(f);
this->on_tuning_frequency_changed(f);
};
};
@ -257,16 +125,15 @@ RDSView::RDSView(NavigationView& nav) {
};
button_txpsn.on_select = [this](Button&){
if (txing) {
radio::disable();
button_txpsn.set_text("PSN");
button_txradiotext.set_text("Radiotext");
transmitter_model.disable();
txing = false;
} else {
gen_PSN(PSN);
rds_radio_config.tuning_frequency = tuning_frequency;
message_length = gen_PSN(PSN, options_pty.selected_index());
button_txpsn.set_text("STOP");
txing = true;
radio::disable();
start_tx();
}
};
@ -275,16 +142,15 @@ RDSView::RDSView(NavigationView& nav) {
};
button_txradiotext.on_select = [this](Button&){
if (txing) {
radio::disable();
button_txpsn.set_text("PSN");
button_txradiotext.set_text("Radiotext");
transmitter_model.disable();
txing = false;
} else {
gen_RadioText(RadioText);
rds_radio_config.tuning_frequency = tuning_frequency;
message_length = gen_RadioText(RadioText, options_pty.selected_index());
button_txradiotext.set_text("STOP");
txing = true;
radio::enable(rds_radio_config);
start_tx();
}
};