锁相环 代码 matlab

以下是一个简单的锁相环模拟代码，使用MATLAB实现：

% 参数定义
fc = 100;   % 输入信号频率
fs = 1000;  % 采样率 
N = 10000;  % 采样点数 
Kp = 0.1;  % 比例增益
Ki = 0.01; % 积分增益
Kd = 0.01; % 微分增益
fref = 50; % 参考频率

% 信号生成
t = (0:N-1)/fs;
x = sin(2*pi*fc*t);

% 相位检测器
theta = zeros(1, N); % 相位
error = zeros(1, N); % 相位误差
for n=2:N
    error(n) = x(n)*sin(2*pi*fref*t(n) + theta(n-1));
    theta(n) = theta(n-1) + 2*pi*fref/fs + Kp*error(n) + Ki*sum(error) + Kd*(error(n)-error(n-1));
end

% 输出结果
subplot(2,1,1);
plot(t, x);
title('输入信号');
xlabel('时间 (s)');
ylabel('幅度');

subplot(2,1,2);
plot(t, theta);
title('锁相环输出');
xlabel('时间 (s)');
ylabel('相位 (rad)');

该代码实现了一个简单的锁相环，通过相位检测器和PID控制器来调整输出信号的相位，使其与参考信号同步。其中，Kp、Ki、Kd分别为比例、积分、微分增益，fref为参考频率。运行该代码可以得到输入信号和锁相环输出的波形图。