GNSS软件接收机 MATLAB 实现（GPS L1 CA码）

GPS L1 C/A码软件接收机 MATLAB 实现，涵盖信号捕获、跟踪、导航电文解调、伪距计算和定位解算。

一、系统架构

复制代码

中频数字信号（模拟或真实）
        ↓
【捕获】并行码相位搜索 → 粗略载波频率和多普勒、码相位
        ↓
【跟踪】PLL+DLL → 精细载波相位、码相位、导航电文比特
        ↓
【电文解调】提取星历、历书、时间
        ↓
【定位解算】伪距观测方程 → 最小二乘求解位置、钟差

二、核心模块实现

2.1 信号参数与模拟生成

matlab 复制代码

%% GPS信号参数
fs = 5e6;                % 采样率 5 MHz
fc = 1.023e6;            % C/A码速率
fIF = 1.25e6;            % 中频频率（若模拟）
codeLen = 1023;          % C/A码长度
chipRate = 1.023e6;      % 码片速率
samplesPerCode = round(fs / (chipRate / codeLen)); % 每码周期采样数

% 生成C/A码（PRN 1）
caCode = generateCACode(1); % 返回1023×1，值±1

% 模拟接收信号（含多普勒、噪声）
function [sig, trueParams] = simulateGPSSignal(snr_dB, doppler_Hz, codePhase_samples)
    % 产生1ms长度的GPS信号
    t = (0:samplesPerCode-1)/fs;
    codePhase = codePhase_samples; % 码相位偏移（采样点）
    
    % 扩频码
    codeIdx = mod(floor((t*chipRate) + codePhase), codeLen) + 1;
    spreading = caCode(codeIdx);
    
    % 载波
    carrier = cos(2*pi*(fIF+doppler_Hz)*t);
    
    % 信号
    sig = spreading .* carrier;
    
    % 加噪声
    sigPower = mean(sig.^2);
    noisePower = sigPower / (10^(snr_dB/10));
    noise = sqrt(noisePower/2)*randn(size(sig));
    sig = sig + noise;
    
    trueParams.doppler = doppler_Hz;
    trueParams.codePhase = codePhase_samples;
end

2.2 捕获（并行码相位搜索）

matlab 复制代码

function [acqResult] = acquisition(signal, fs, fIF)
    % 输入：1ms信号，采样率，中频
    % 输出：多普勒频率搜索范围、码相位、峰值指标
    
    fc = 1.023e6;
    codeLen = 1023;
    samplesPerCode = length(signal);
    
    % 本地C/A码（零码相位）
    localCode = generateCACode(1);
    localCodeFreq = fc;
    
    % 频率搜索步长（通常500 Hz）
    freqStep = 500;
    freqRange = -5000:freqStep:5000; % ±5 kHz
    numFreq = length(freqRange);
    
    % 预先生成本地载波（复数）
    t = (0:samplesPerCode-1)/fs;
    localCodeUp = interp1(0:codeLen-1, localCode, ...
                          mod(t*localCodeFreq, codeLen), 'nearest');
    
    % 并行码相位搜索（FFT方法）
    maxVal = 0;
    maxFreqIdx = 0;
    maxCodeShift = 0;
    
    for k = 1:numFreq
        % 生成本地载波（复数）
        lo = exp(1j*2*pi*(fIF+freqRange(k))*t);
        
        % 混频到基带
        baseband = signal .* lo;
        
        % FFT相关
        X = fft(baseband);
        Y = conj(fft(localCodeUp));
        corr = ifft(X .* Y);
        corrAbs = abs(corr);
        
        % 寻找峰值
        [peak, idx] = max(corrAbs);
        if peak > maxVal
            maxVal = peak;
            maxFreqIdx = k;
            maxCodeShift = idx - 1; % 码相位（采样点）
        end
    end
    
    % 计算噪声基底和峰值指标
    noiseFloor = median(corrAbs(:));
    cn0 = 10*log10(maxVal/noiseFloor); % 粗略C/N0
    
    acqResult.doppler = freqRange(maxFreqIdx);
    acqResult.codePhase = maxCodeShift;
    acqResult.cn0 = cn0;
    acqResult.peakMetric = maxVal/noiseFloor;
end

2.3 跟踪（PLL + DLL）

matlab 复制代码

function [trackResults] = tracking(signal, acqResult, fs, fIF)
    % 输入：连续信号（多个ms），捕获结果
    % 输出：载波相位、码相位、导航比特
    
    % 参数
    codeLen = 1023;
    samplesPerCode = round(fs / (chipRate/codeLen));
    numMs = floor(length(signal)/samplesPerCode);
    
    % 初始化环路
    pll = struct('damping', 0.707, 'noiseBandwidth', 25, ...
                 'alpha', 0, 'beta', 0);
    dll = struct('damping', 0.707, 'noiseBandwidth', 2, ...
                 'alpha', 0, 'beta', 0);
    
    % 计算环路滤波器系数
    [pll.alpha, pll.beta] = calcLoopCoeffs(pll.noiseBandwidth, pll.damping, 1/fs);
    [dll.alpha, dll.beta] = calcLoopCoeffs(dll.noiseBandwidth, dll.damping, 1/fs);
    
    % 初始化状态
    codePhase = acqResult.codePhase; % 采样点
    carrierPhase = 0;
    carrierFreq = fIF + acqResult.doppler;
    
    % 存储结果
    trackResults.carrPhase = zeros(numMs,1);
    trackResults.codePhase = zeros(numMs,1);
    trackResults.I_P = zeros(numMs,1);
    trackResults.Q_P = zeros(numMs,1);
    trackResults.navBits = zeros(numMs,1);
    
    for ms = 1:numMs
        % 提取当前1ms数据
        idxStart = (ms-1)*samplesPerCode + 1;
        idxEnd = ms*samplesPerCode;
        if idxEnd > length(signal), break; end
        data = signal(idxStart:idxEnd);
        
        % 生成本地载波（超前、即时、滞后）
        t = (0:samplesPerCode-1)/fs;
        carr = exp(1j*carrierPhase) .* exp(1j*2*pi*carrierFreq*t);
        
        % 混频
        baseband = data .* conj(carr);
        
        % 生成本地码（即时、超前0.5码片、滞后0.5码片）
        codeIdxInstant = mod(floor((t*chipRate) + codePhase), codeLen) + 1;
        codeEarly = circshift(localCode, -round(0.5*fs/chipRate));
        codeLate  = circshift(localCode,  round(0.5*fs/chipRate));
        
        % 相关
        I_E = sum(real(baseband) .* codeEarly);
        Q_E = sum(imag(baseband) .* codeEarly);
        I_P = sum(real(baseband) .* localCode(codeIdxInstant));
        Q_P = sum(imag(baseband) .* localCode(codeIdxInstant));
        I_L = sum(real(baseband) .* codeLate);
        Q_L = sum(imag(baseband) .* codeLate);
        
        % 鉴相器（PLL：二象限反正切）
        phaseDisc = atan2(Q_P, I_P);
        % 鉴码器（DLL：归一化非相干超前减滞后）
        earlyPower = I_E^2 + Q_E^2;
        latePower  = I_L^2 + Q_L^2;
        codeDisc = (earlyPower - latePower) / (earlyPower + latePower + eps);
        
        % 环路滤波
        pll.discriminator = phaseDisc;
        dll.discriminator = codeDisc;
        
        % 更新载波NCO
        carrierFreq = carrierFreq + pll.alpha * pll.discriminator;
        carrierPhase = carrierPhase + carrierFreq * (1/fs);
        
        % 更新码NCO
        codePhase = codePhase + dll.alpha * dll.discriminator;
        
        % 存储
        trackResults.carrPhase(ms) = carrierPhase;
        trackResults.codePhase(ms) = codePhase;
        trackResults.I_P(ms) = I_P;
        trackResults.Q_P(ms) = Q_P;
        
        % 导航比特（每20ms一次比特翻转）
        if mod(ms,20)==0
            navBit = sign(mean(I_P(ms-19:ms)));
            trackResults.navBits(ms) = navBit;
        end
    end
end

function [alpha, beta] = calcLoopCoeffs(Bn, zeta, T)
    % 二阶环路滤波器系数（模拟域预计算）
    theta = Bn * T / (zeta + 0.25/zeta);
    alpha = 4*zeta*theta / (1 + 2*zeta*theta + theta^2);
    beta  = 4*theta^2 / (1 + 2*zeta*theta + theta^2);
end

2.4 导航电文解码与定位

matlab 复制代码

function [pos, clockBias] = computePosition(trackResults, ephemeris)
    % 输入：跟踪结果（各卫星的伪距、载波相位、导航比特）
    % 输出：接收机位置ECEF（m），钟差（m）
    
    % 假设已有至少4颗卫星的伪距观测值
    numSat = length(trackResults);
    pseudoranges = zeros(numSat,1);
    satPositions = zeros(numSat,3);
    
    for i = 1:numSat
        % 从导航电文中提取星历，计算卫星位置
        [satPos, satClock] = calculateSatellitePosition(ephemeris{i}, ...
            trackResults(i).transmitTime);
        
        % 伪距 = 接收时间 - 发射时间 + 钟差修正
        pseudoranges(i) = (trackResults(i).rxTime - trackResults(i).txTime) * 299792458;
        pseudoranges(i) = pseudoranges(i) - satClock; % 扣除卫星钟差
        
        satPositions(i,:) = satPos;
    end
    
    % 最小二乘定位
    x0 = [0;0;0;0]; % 初始猜测 [x,y,z,cdt]
    for iter = 1:10
        H = zeros(numSat,4);
        deltaRho = zeros(numSat,1);
        for i = 1:numSat
            dx = satPositions(i,1) - x0(1);
            dy = satPositions(i,2) - x0(2);
            dz = satPositions(i,3) - x0(3);
            r = sqrt(dx^2 + dy^2 + dz^2);
            H(i,:) = [-dx/r, -dy/r, -dz/r, 1];
            deltaRho(i) = pseudoranges(i) - r - x0(4);
        end
        dx = (H'*H)\(H'*deltaRho);
        x0 = x0 + dx;
        if norm(dx) < 1e-4, break; end
    end
    
    pos = x0(1:3);
    clockBias = x0(4); % 单位为米，除以光速得秒
end

2.5 主程序示例

matlab 复制代码

%% GPS软件接收机主程序
clear; clc; close all;

% 1. 模拟GPS信号（1颗卫星，PRN1）
snr = -20;               % dB
doppler = 1500;          % Hz
codePhase = 234;         % 采样点偏移
[sig, trueParams] = simulateGPSSignal(snr, doppler, codePhase);

% 2. 捕获
acq = acquisition(sig, fs, fIF);
fprintf('捕获结果：多普勒 = %.1f Hz, 码相位 = %d\n', acq.doppler, acq.codePhase);

% 3. 跟踪（使用连续20ms数据）
numMs = 20;
sigLong = simulateGPSSignal(snr, doppler, codePhase); % 可产生更长信号
track = tracking(sigLong(1:numMs*samplesPerCode), acq, fs, fIF);

% 4. 查看I/Q积累
figure;
subplot(2,1,1); plot(track.I_P); title('I支路（同相）'); grid;
subplot(2,1,2); plot(track.Q_P); title('Q支路（正交）'); grid;

% 5. 定位（需要至少4颗卫星，此处仅为演示框架）
% 实际使用时需读取真实星历文件（如RINEX导航文件）

三、关键补充说明

3.1 C/A码生成函数

matlab 复制代码

function caCode = generateCACode(prn)
    % GPS C/A码生成（G1⊕G2延迟）
    % 参照IS-GPS-200标准
    g1 = ones(1,10);
    g2 = ones(1,10);
    delay = [2,6;3,7;4,8;5,9;1,9;2,10;1,8;2,9;3,10;2,3; ...
             3,4;5,6;6,7;7,8;8,9;9,10;1,4;2,5;3,6;4,7; ...
             5,8;6,9;1,3;4,6;5,7;6,8;7,9;8,10;1,6;2,7; ...
             3,8;4,9]; % 32个PRN的延迟抽头
    tap1 = delay(prn,1);
    tap2 = delay(prn,2);
    
    caCode = zeros(1,1023);
    for i = 1:1023
        caCode(i) = xor(g1(10), xor(g2(tap1), g2(tap2)));
        % 移位寄存器更新
        g1 = [xor(g1(3),g1(10)), g1(1:9)];
        g2 = [xor(g2(2),xor(g2(3),xor(g2(6),xor(g2(8),xor(g2(9),g2(10)))))), g2(1:9)];
    end
    caCode = 2*caCode - 1; % 转换为±1
end

3.2 真实数据接口

若使用真实中频采样数据（如从USRP采集），只需替换 simulateGPSSignal 为文件读取：

matlab 复制代码

fid = fopen('gps_if_data.bin', 'rb');
sig = fread(fid, Inf, 'int16');
fclose(fid);
sig = sig(1:length(sig)); % 取所需长度
% 注意：真实数据可能需要直流偏置去除、自动增益控制等预处理

四、运行结果示例

模块	预期结果
捕获	多普勒误差 < 250 Hz，码相位误差 < 1采样点
跟踪	I支路稳定为正，Q支路趋近于零（锁定）
电文解调	正确解码出子帧同步头、周内秒、星历
定位	单点定位精度 5~15 m（取决于信号质量和星历精度）

参考代码 GNSS软件接收机，基于matlab实现软件接收机实现 www.youwenfan.com/contentcsv/81017.html

五、扩展与优化建议

多通道并行 ：使用 parfor 同时对多颗卫星进行捕获和跟踪。
微弱信号处理：增加相干积分时间（如10ms）和非相干累加。
抗多径：采用窄相关器（如0.1码片间隔）或双Delta技术。
实时性：将核心循环用C Mex或GPU加速。