HackRF-Treasure-Chest/Software/BTLE/matlab/test_float_point.m

69 lines
3.0 KiB
Mathematica
Raw Normal View History

2022-09-22 18:26:57 +02:00
clear all;
close all;
% original float point version
gauss_coef = [0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 2.231548e-14, 2.007605e-11, 7.561773e-09, 1.197935e-06, 8.050684e-05, 2.326833e-03, 2.959908e-02, 1.727474e-01, 4.999195e-01, 8.249246e-01, 9.408018e-01, 8.249246e-01, 4.999195e-01, 1.727474e-01, 2.959908e-02, 2.326833e-03, 8.050684e-05, 1.197935e-06, 7.561773e-09, 2.007605e-11, 2.231548e-14, 0];
%plot(gauss_coef, 'r+-'); axis([0 length(gauss_coef) 0 0.0001]);
% short it to 16 points:
gauss_coef = [7.561773e-09, 1.197935e-06, 8.050684e-05, 2.326833e-03, 2.959908e-02, 1.727474e-01, 4.999195e-01, 8.249246e-01, 9.408018e-01, 8.249246e-01, 4.999195e-01, 1.727474e-01, 2.959908e-02, 2.326833e-03, 8.050684e-05, 1.197935e-06];
%plot(gauss_coef, 'r+-');
SAMPLE_PER_SYMBOL = 4;
LEN_GAUSS_FILTER = length(gauss_coef)/SAMPLE_PER_SYMBOL;
MAX_NUM_PHY_BYTE = 47;
MAX_NUM_PHY_SAMPLE = ((MAX_NUM_PHY_BYTE*8*SAMPLE_PER_SYMBOL)+(LEN_GAUSS_FILTER*SAMPLE_PER_SYMBOL));
MOD_IDX = 0.5;
AMPLITUDE = 127;
tmp_phy_bit_over_sampling = zeros(1, MAX_NUM_PHY_SAMPLE + 2*LEN_GAUSS_FILTER*SAMPLE_PER_SYMBOL);
tmp_phy_bit_over_sampling = zeros(1, MAX_NUM_PHY_SAMPLE);
num_bit = MAX_NUM_PHY_BYTE*8;
%bit = round(rand(1, num_bit));
bit = get_number;
num_bit_oversample = num_bit*SAMPLE_PER_SYMBOL;
len_gauss_oversample = LEN_GAUSS_FILTER*SAMPLE_PER_SYMBOL;
num_sample = num_bit_oversample + len_gauss_oversample;
pre_len = len_gauss_oversample-1;
tmp_phy_bit_over_sampling(1:pre_len) = 0.0;
post_sp = num_bit_oversample + pre_len + 1;
post_ep = post_sp + pre_len - 1;
tmp_phy_bit_over_sampling(post_sp:post_ep) = 0.0;
tmp_phy_bit_over_sampling((pre_len+1):(pre_len+num_bit_oversample)) = 0;
tmp_phy_bit_over_sampling((pre_len+1):SAMPLE_PER_SYMBOL:(pre_len+num_bit_oversample)) = bit.*2 - 1;
% len_conv_result = length(tmp_phy_bit_over_sampling) - len_gauss_oversample + 1
% = post_ep - len_gauss_oversample + 1
% = num_bit_oversample + pre_len + 1 + pre_len - 1 - len_gauss_oversample + 1
% = num_bit_oversample + 2*(len_gauss_oversample-1) - len_gauss_oversample + 1
% = num_bit_oversample + len_gauss_oversample - 1
len_conv_result = num_sample - 1;
% -------------------------------------- float point reference -----------------------------------------------
for i = 1 : len_conv_result
acc = 0;
for j = 1 : len_gauss_oversample
acc = acc + gauss_coef(len_gauss_oversample-j+1)*tmp_phy_bit_over_sampling(i+j-1); %num_sample - 1+len_gauss_oversample-1= length(tmp_phy_bit_over_sampling)
end
tmp_phy_bit_over_sampling1(i) = acc;
end
tmp = 0;
sample = zeros(1, 2*num_sample);
sample(1) = round( cos(tmp)*AMPLITUDE );
sample(2) = round( sin(tmp)*AMPLITUDE );
for i=2:num_sample
tmp = tmp + (pi*MOD_IDX)*tmp_phy_bit_over_sampling1(i-1)/(SAMPLE_PER_SYMBOL);
sample((i-1)*2 + 1) = round( cos(tmp)*AMPLITUDE );
sample((i-1)*2 + 2) = round( sin(tmp)*AMPLITUDE );
end
figure(1);
subplot(2,1,1); plot(sample);
ref_sample = get_number1;
hold on; plot(ref_sample, 'r.');
subplot(2,1,2); plot(abs(sample-ref_sample));