writepacketheader.m

基于串行接口的GPS驱动程序

function WritePacketHeader(gps, id, sz)
global pid_dle_byte

% Three byte header: (DLE, id, size)
fwrite(gps, pid_dle_byte);
fwrite(gps, id);
fwrite(gps, sz);
if (pid_dle_byte == sz)
    fwrite(gps, pid_dle_byte);
end