INS/GPS组合导航MATLAB处理库

%dout=A*din+b;
function [A b]=cp_affine（doutdin）
nvin=size（din1）;
nvout=size（dout1）;
ndat=size（din2）;

data=[din;ones（1ndat）];
mx_a=（dout*data‘）/（data*data‘）;

A=mx_a（1:nvout1:nvin）;
b=mx_a（1:nvoutnvin+1）;