用FPGA CORDIC IP核实现信号的相位检测
1.matlab仿真
波形仿真代码:
代码功能:生成一个点频信号s,求出s的实部和虚部;并且结算相位角atan2。画出图形,并且将Q和I数据写入文件中。
%代码功能:生成一个点频信号s,求出s的实部和虚部;并且结算相位角atan2。画出图形,并且将Q和I数据写入 clc; clear;close all; F1=1; %信号频率 Fs=65536; %采样频率 Fs=N,能采一个周期 P1=45; %信号初始相位(单位:°),90-cos函数 N=65536; %采样点数 t=[0:1/Fs:(N-1)/Fs]; %采样时刻 A=2^15-1; %信号幅度 %生成点频信号 s=A*exp(1i *(2*pi*F1*t + pi*P1/180)); % IQ分解,分别提取实部和虚部 I = real(s); Q = imag(s); % 计算相位角 phase = atan2(Q, I); % 提取初始相位(t=0处的相位值) initial_phase = phase(1); %显示初始相位值,将其转换为π的倍数进行显示 disp(['初始相位值:', num2str(initial_phase/pi),'pi']); % 绘制结果图,画出signal信号的实部和虚部 figure; subplot(3,1,1); plot(t, real(s), 'b'); title('In-phase Component (I)'); subplot(3,1,2); plot(t, imag(s), 'r'); title('Quadrature Component (Q)'); xlabel('Time (s)'); % 计算相位角 subplot(3,1,3); plot(t, phase); xlabel('时间'); ylabel('相位'); title('相位随时间变化'); %将纵坐标转化为Π的倍数 yticks([-1*pi, -0.5*pi, 0, 0.5*pi, pi]); yticklabels({'-π', '-0.5π', '0', '0.5π', 'π'}); %创建 coe 文件 Idata fild = fopen('Idata_65536x15bit.coe','wt'); %写入 coe 文件头 %固定写法,表示写入的数据是 10 进制表示 fprintf(fild, '%s\n','memory_initialization_radix=10;'); %固定写法,下面开始写入数据 fprintf(fild, '%s\n\n','memory_initialization_vector ='); for i = 1:N s2(i) = round(I(i)); %对小数四舍五入以取整 fprintf(fild, '%d',s2(i)); %数据写入 if i==N fprintf(fild, '%s\n',';'); %最后一个数据用; else fprintf(fild,',\n'); % 其他数据用, end end fclose(fild); % 写完了,关闭文件 %创建 coe 文件 Qdata fild = fopen('Qdata_65536x15bit.coe','wt'); %写入 coe 文件头 %固定写法,表示写入的数据是 10 进制表示 fprintf(fild, '%s\n','memory_initialization_radix=10;'); %固定写法,下面开始写入数据 fprintf(fild, '%s\n\n','memory_initialization_vector ='); for i = 1:N s3(i) = round(Q(i)); %对小数四舍五入以取整 fprintf(fild, '%d',s3(i)); %数据写入 if i==N fprintf(fild, '%s\n',';'); %最后一个数据用; else fprintf(fild,',\n'); % 其他数据用, end end fclose(fild); % 写完了,关闭文件
上面的代码除了生成下面的波形结果外,还将数据写入文件“Idata_65536x15bit.coe” 和 “Qdata_65536x15bit.coe”
可以在电脑win图标旁边直接搜索这两个文件,默认是在MATLAB文件中的一个文件夹中。
波形结果
2.FPGA实现
生成的点频信号signal
以及I,Q
的分解,可以用ROM来输入。
用FPGA实现的关键以及难点是计算相位角phase = atan2(Q, I);
ROM
创建两个ROM,分别将Idata_65536x15bit 和 Qdata_65536x15bit 写入。
数学知识补充:atan和atan2
参考文章:atan2函数和atan函数 - 知乎 (zhihu.com)
在MATLAB中,atan和atan2函数都用于计算角度,但它们之间有一些重要的区别。
- atan函数:
- atan函数是计算反正切值的标准函数,其语法为y = atan(x)。
- atan函数返回的角度范围是[-π/2, π/2],即从-90度到90度之间。
- atan函数只能接受一个参数,即y = atan(x),其中x是输入的实数值。
- atan2函数:
- atan2函数是计算反正切值的扩展函数,其语法为y = atan2(y, x)。
- atan2函数返回的角度范围是[-π, π],即从-180度到180度之间。
- atan2函数可以处理所有四个象限的情况,避免了由于分母为零而导致的错误。
- atan2函数接受两个参数,即y = atan2(y, x),其中y是输入的虚部,x是输入的实部。
主要区别在于atan函数只能处理一个参数且返回值范围是[-π/2, π/2],而atan2函数可以处理两个参数且返回值范围是[-π, π],并且能够处理所有四个象限的情况。在处理复数的相位角度时,通常会使用atan2函数来确保得到正确的结果。
这两个函数的转换关系
atan函数转换为atan2函数:(图片来自知乎)
- x > 0, 是一、四象限的点,等价atan;
- x < 0,是二、三象限的点,根据y的范围来确定:
- y > 0,是第二象限的点,先用atan得到第四象限的弧度制,再加上Π就转换到了第二象限;
- y < 0.是第三象限的点,先用atan得到第一象限的弧度制,再减去Π就转换到了第二象限;
- x = 0,根据y的正负来确定
- y > 0, 值为Π/2
- y < 0,值为-Π/2
- 注意,当x=0,y=0时,atan2(0,0)=0 (matlab中这样规定)
FPGA代码思路
VIVADO的CORDIC IP核中的Arc Tan ,可以直接计算atan2(自动将atan转换为atan2)。
CORDIC IP核使用
参考视频:FPGA IP之CORDIC使用与仿真_哔哩哔哩_bilibili
参考文章:FPGA数字信号处理(十四)Vivado Cordic IP核计算arctan_fpga arctan-CSDN博客
FPGA 代码
DDS_IQ模块,是DDS波形产生模块,读取ROM中存入的数据,生成两个波形 I_data 和 Q_data
module DDS_IQ ( input clk, //系统时钟 input rst_n, output signed [15:0] I_data, output signed [15:0] Q_data ); reg [15:0]r_Fword; //频率控制字寄存器 reg [1:0]r_Pword; //相位控制字寄存器 reg [31:0] Fcnt; //累加寄存器 wire [15:0] I_rom_addr; //ROM地址,宽度:16位 wire [15:0] Q_rom_addr; //ROM地址,宽度:16位 //将值存入寄存器 always@(posedge clk or negedge rst_n)begin if(!rst_n)begin r_Fword <= 16'd0; r_Pword <= 2'd0; end else begin r_Fword <= 16'd1000; r_Pword <= 2'd0; end end //累加 always@(posedge clk or negedge rst_n)begin if(!rst_n) Fcnt <= 32'd0; else Fcnt <= Fcnt + r_Fword; end //相位调制器 assign I_rom_addr = Fcnt[31:15] + r_Pword; //截取高位,并加上相位累加器的值 assign Q_rom_addr = Fcnt[31:15] + r_Pword; blk_mem_gen_I I_value( .clka(clk), // input wire clka .ena(1'b1), // input wire ena .addra(I_rom_addr), // input wire [15 : 0] addra .douta(I_data) // output wire [15 : 0] douta ); blk_mem_gen_Q Q_value ( .clka(clk), // input wire clka .ena(1'b1), // input wire ena .addra(Q_rom_addr), // input wire [15 : 0] addra .douta(Q_data) // output wire [15 : 0] douta ); endmodule
顶层 atan_top 模块,计算atan(Q/I)
module atan_top( input clk, //系统时钟 input rst_n, input [15:0] I_data, input [15:0] Q_data, output signed out_valid, //输出有效信号 output signed [15:0]theta //arctan计算结果 ); //例化DDS_IQ模块,将两个信号引入 DDS_IQ u_DDS_IQ( .clk (clk), .rst_n (rst_n), .I_data (I_data), .Q_data (Q_data) ); //输入I和Q,out=arctan(Q/I); //tdata端口,虚部Q在前,实部I在后 cordic_1 u_cordic_1 ( .aclk(clk), // input wire aclk .aresetn(rst_n), // input wire aresetn .s_axis_cartesian_tvalid(1'b1), // input wire s_axis_cartesian_tvalid .s_axis_cartesian_tdata({Q_data[15],Q_data[15:1],I_data[15],I_data[15:1]}), // input wire [31 : 0] s_axis_cartesian_tdata .m_axis_dout_tvalid(out_valid), // output wire m_axis_dout_tvalid .m_axis_dout_tdata(theta) // output wire [15 : 0] m_axis_dout_tdata ); //输入的32位中,[15:0]为实部I,[16:31]为虚部Q endmodule
TB文件
module cordic_tb_top(); //接口声明 reg clk; reg rst_n; wire signed out_valid; wire signed [15:0]theta; wire signed[15:0]I_data; wire signed[15:0]Q_data; //initial handle = $fopen("F:/MY_WORK/3U_phase_discrimination/cordic.txt");//打开文件 /* //对被测的设计进行例化 DDS_IQ u_DDS_IQ( .clk (clk), .rst_n (rst_n), .I_data (I_data), .Q_data (Q_data) ); */ DDS_IQ u_DDS_IQ( .clk (clk), .rst_n (rst_n), .I_data (I_data), .Q_data (Q_data) ); atan_top u_atan_top( .clk (clk), .rst_n (rst_n), .I_data (I_data), .Q_data (Q_data), .out_valid (out_valid), .theta (theta) ); //产生时钟 50MHZ initial clk = 1; always #10 clk = ~clk; //测试激励产生 initial begin rst_n = 0; #200; rst_n = 1; end /* always@(posedge clk) begin if(out_valid) $fdisplay(handle,"%b",theta);//写数据 end */ endmodule
仿真结果
注意这三个波形为模拟波形,有符号数
结果分析
如何判断自己的仿真结果是正确的?
就以上面的仿真图片和下面的结果来验证一下
数据1:Q = 0 ; I = -32767 ; atan2 = 25736
数据2:Q = -25279; I = -20848; atan2 = -18517
这些数据如何转化为二进制,可以查看CORDIC IP核中的这个界面:
Q格式数据可以用Fix格式数据表示。
对于有符号数,表示为Fix(1+X+N)_N,X表示整数位数,N表示小数位数。
但是在这里的结果验证中,不需要转换数据格式就可以
- 数据1:属于《数学知识补充:atan和atan2》 的第二种情况,x<0, y>=0
atan2(Q,I) = atan(Q/I) + Π = 0 + Π = Π
而根据输出波形,atan2 = 25736,将它转换:25736/(2^13) = 3.1416 √
- 数据2:属于《数学知识补充:atan和atan2》 的第三种情况,x<0, y<0
atan2(Q,I) = atan(Q/I) - Π
其中,atan(Q/I) = atan(-25279/-20848) = atan(1.2125) = 0.88115 Radians
∴ atan2(Q,I) = 0.88115 - Π = -2.26
而根据输出波形,atan2 = -18517,将它转换:-18517/(2^13) = -2.26 √
仿真结果符合事实