实现六自由度运动学逆解算法，最终的权值矩阵就是滤波器的系数，FMCW调频连续波雷达的测距测角。- Six degrees of freedom to achieve inverse kinematics algorithm, The final weight matrix is ??the filter coefficient, FMCW frequency modulated continuous wave radar range and angular measurements.