卡尔曼滤波,由笛卡尔坐标到极坐标的转换,并给出测量噪声的相关矩阵R的公式,MATLAB即可实现。(坐标系转化的推导文档)
1