|
|
|
@ -52,52 +52,99 @@ int srslte_mod_modulate(srslte_modem_table_t* q, uint8_t *bits, cf_t* symbols, u
|
|
|
|
|
return j;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/* Assumes packet bits as input */
|
|
|
|
|
int srslte_mod_modulate_bytes(srslte_modem_table_t* q, uint8_t *bits, cf_t* symbols, uint32_t nbits) {
|
|
|
|
|
if (nbits%8) {
|
|
|
|
|
fprintf(stderr, "Warning: srslte_mod_modulate_bytes() accepts byte-aligned inputs only "
|
|
|
|
|
"(nbits=%d, bits_x_symbol=%d)\n", nbits, q->nbits_x_symbol);
|
|
|
|
|
void mod_bpsk_bytes(srslte_modem_table_t* q, uint8_t *bits, cf_t* symbols, uint32_t nbits) {
|
|
|
|
|
uint8_t mask_bpsk[8] = {0x80, 0x40, 0x20, 0x10, 0x08, 0x04, 0x02, 0x01};
|
|
|
|
|
uint8_t shift_bpsk[8] = {7, 6, 5, 4, 3, 2, 1, 0};
|
|
|
|
|
|
|
|
|
|
for (int i=0;i<nbits/8;i++) {
|
|
|
|
|
memcpy(&symbols[8*i], &q->symbol_table_bpsk[bits[i]], sizeof(bpsk_packed_t));
|
|
|
|
|
}
|
|
|
|
|
for (int i=0;i<nbits%8;i++) {
|
|
|
|
|
symbols[8*(nbits/8)+i] = q->symbol_table[(bits[8*(nbits/8)+i]&mask_bpsk[i])>>shift_bpsk[i]];
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void mod_qpsk_bytes(srslte_modem_table_t* q, uint8_t *bits, cf_t* symbols, uint32_t nbits) {
|
|
|
|
|
uint8_t mask_qpsk[4] = {0xc0, 0x30, 0x0c, 0x03};
|
|
|
|
|
uint8_t shift_qpsk[4] = {6, 4, 2, 0};
|
|
|
|
|
for (int i=0;i<nbits/8;i++) {
|
|
|
|
|
memcpy(&symbols[4*i], &q->symbol_table_qpsk[bits[i]], sizeof(qpsk_packed_t));
|
|
|
|
|
}
|
|
|
|
|
for (int i=0;i<(nbits%8)/2;i++) {
|
|
|
|
|
symbols[8*(nbits/8)+i] = q->symbol_table[(bits[8*(nbits/8)]&mask_qpsk[i])>>shift_qpsk[i]];
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void mod_16qam_bytes(srslte_modem_table_t* q, uint8_t *bits, cf_t* symbols, uint32_t nbits) {
|
|
|
|
|
for (int i=0;i<nbits/8;i++) {
|
|
|
|
|
memcpy(&symbols[2*i], &q->symbol_table_16qam[bits[i]], sizeof(qam16_packed_t));
|
|
|
|
|
}
|
|
|
|
|
symbols[8*(nbits/8)] = q->symbol_table[(bits[8*(nbits/8)]&0xf0)>>4];
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void mod_64qam_bytes(srslte_modem_table_t* q, uint8_t *bits, cf_t* symbols, uint32_t nbits) {
|
|
|
|
|
uint8_t in0, in1, in2, in3;
|
|
|
|
|
uint32_t in80, in81, in82;
|
|
|
|
|
|
|
|
|
|
for (int i=0;i<nbits/24;i++) {
|
|
|
|
|
in80 = bits[3*i+0];
|
|
|
|
|
in81 = bits[3*i+1];
|
|
|
|
|
in82 = bits[3*i+2];
|
|
|
|
|
|
|
|
|
|
in0 = (in80&0xfc)>>2;
|
|
|
|
|
in1 = (in80&0x03)<<4 | ((in81&0xf0)>>4);
|
|
|
|
|
in2 = (in81&0x0f)<<2 | ((in82&0xc0)>>6);
|
|
|
|
|
in3 = in82&0x3f;
|
|
|
|
|
|
|
|
|
|
symbols[i*4+0] = q->symbol_table[in0];
|
|
|
|
|
symbols[i*4+1] = q->symbol_table[in1];
|
|
|
|
|
symbols[i*4+2] = q->symbol_table[in2];
|
|
|
|
|
symbols[i*4+3] = q->symbol_table[in3];
|
|
|
|
|
}
|
|
|
|
|
if (nbits%24 >= 6) {
|
|
|
|
|
in80 = bits[24*(nbits/24)+0];
|
|
|
|
|
in0 = (in80&0xfc)>>2;
|
|
|
|
|
|
|
|
|
|
symbols[24*(nbits/24)+0] = q->symbol_table[in0];
|
|
|
|
|
}
|
|
|
|
|
if (nbits%24 >= 12) {
|
|
|
|
|
in81 = bits[24*(nbits/24)+1];
|
|
|
|
|
in1 = (in80&0x03)<<4 | ((in81&0xf0)>>4);
|
|
|
|
|
|
|
|
|
|
symbols[24*(nbits/24)+1] = q->symbol_table[in1];
|
|
|
|
|
}
|
|
|
|
|
if (nbits%24 >= 18) {
|
|
|
|
|
in82 = bits[24*(nbits/24)+2];
|
|
|
|
|
in2 = (in81&0x0f)<<2 | ((in82&0xc0)>>6);
|
|
|
|
|
|
|
|
|
|
symbols[24*(nbits/24)+2] = q->symbol_table[in2];
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/* Assumes packet bits as input */
|
|
|
|
|
int srslte_mod_modulate_bytes(srslte_modem_table_t* q, uint8_t *bits, cf_t* symbols, uint32_t nbits)
|
|
|
|
|
{
|
|
|
|
|
|
|
|
|
|
if (!q->byte_tables_init) {
|
|
|
|
|
fprintf(stderr, "Error need to initiated modem tables for packeted bits before calling srslte_mod_modulate_bytes()\n");
|
|
|
|
|
return -1;
|
|
|
|
|
}
|
|
|
|
|
if (nbits % q->nbits_x_symbol) {
|
|
|
|
|
fprintf(stderr, "Error modulator expects number of bits (%d) to be multiple of %d\n", nbits, q->nbits_x_symbol);
|
|
|
|
|
return -1;
|
|
|
|
|
}
|
|
|
|
|
switch(q->nbits_x_symbol) {
|
|
|
|
|
case 1:
|
|
|
|
|
for (int i=0;i<nbits/8;i++) {
|
|
|
|
|
memcpy(&symbols[8*i], &q->symbol_table_bpsk[bits[i]], sizeof(bpsk_packed_t));
|
|
|
|
|
}
|
|
|
|
|
mod_bpsk_bytes(q, bits, symbols, nbits);
|
|
|
|
|
break;
|
|
|
|
|
case 2:
|
|
|
|
|
for (int i=0;i<nbits/8;i++) {
|
|
|
|
|
memcpy(&symbols[4*i], &q->symbol_table_qpsk[bits[i]], sizeof(qpsk_packed_t));
|
|
|
|
|
}
|
|
|
|
|
mod_qpsk_bytes(q, bits, symbols, nbits);
|
|
|
|
|
break;
|
|
|
|
|
case 4:
|
|
|
|
|
for (int i=0;i<nbits/8;i++) {
|
|
|
|
|
memcpy(&symbols[2*i], &q->symbol_table_16qam[bits[i]], sizeof(qam16_packed_t));
|
|
|
|
|
}
|
|
|
|
|
mod_16qam_bytes(q, bits, symbols, nbits);
|
|
|
|
|
break;
|
|
|
|
|
case 6:
|
|
|
|
|
if (nbits%24) {
|
|
|
|
|
fprintf(stderr, "Warning: for 64QAM srslte_mod_modulate_bytes() accepts 24-bit aligned inputs only\n");
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
for (int i=0;i<nbits/24;i++) {
|
|
|
|
|
uint32_t in80 = bits[3*i+0];
|
|
|
|
|
uint32_t in81 = bits[3*i+1];
|
|
|
|
|
uint32_t in82 = bits[3*i+2];
|
|
|
|
|
|
|
|
|
|
uint8_t in0 = (in80&0xfc)>>2;
|
|
|
|
|
uint8_t in1 = (in80&0x03)<<4 | ((in81&0xf0)>>4);
|
|
|
|
|
uint8_t in2 = (in81&0x0f)<<2 | ((in82&0xc0)>>6);
|
|
|
|
|
uint8_t in3 = in82&0x3f;
|
|
|
|
|
|
|
|
|
|
symbols[i*4+0] = q->symbol_table[in0];
|
|
|
|
|
symbols[i*4+1] = q->symbol_table[in1];
|
|
|
|
|
symbols[i*4+2] = q->symbol_table[in2];
|
|
|
|
|
symbols[i*4+3] = q->symbol_table[in3];
|
|
|
|
|
}
|
|
|
|
|
mod_64qam_bytes(q, bits, symbols, nbits);
|
|
|
|
|
break;
|
|
|
|
|
default:
|
|
|
|
|
fprintf(stderr, "srslte_mod_modulate_bytes() accepts QPSK/16QAM/64QAM modulations only\n");
|
|
|
|
|