激光雷达定位算法在FPGA中的实现——section3 Matlab实现和校验

1、校验section2的计算方法是否正确

        以section1里面的图示

        举个例子：

1.1 手动计算

        

        

        

        

        

        

        可以计算出4*4方阵C相关参数：

        可以计算出余子式矩阵C_1相关参数：