當前位置: 首頁>>代碼示例>>C#>>正文


C# MatrixFixed.Extract方法代碼示例

本文整理匯總了C#中SceneLibrary.MatrixFixed.Extract方法的典型用法代碼示例。如果您正苦於以下問題:C# MatrixFixed.Extract方法的具體用法?C# MatrixFixed.Extract怎麽用?C# MatrixFixed.Extract使用的例子?那麽, 這裏精選的方法代碼示例或許可以為您提供幫助。您也可以進一步了解該方法所在SceneLibrary.MatrixFixed的用法示例。


在下文中一共展示了MatrixFixed.Extract方法的1個代碼示例,這些例子默認根據受歡迎程度排序。您可以為喜歡或者感覺有用的代碼點讚,您的評價將有助於係統推薦出更棒的C#代碼示例。

示例1: fill_covariances

        public void fill_covariances(MatrixFixed M)
        {
            //assert (M.Rows() == total_state_size && M.Cols() == total_state_size);

            Pxx = M.Extract((int)motion_model.STATE_SIZE, (int)motion_model.STATE_SIZE, 0, 0);

            uint x_position = motion_model.STATE_SIZE;

            uint x_feature_no = 0;
            uint y_feature_no, y_position;
            Feature it;
            MatrixFixed itmat;
            for (int i=0;i<feature_list.Count;i++)
            {
                if (x_position < M.Columns)
                {
                    it = (Feature)feature_list[i];
                
                    y_feature_no = 0;
                    y_position = 0;

                    it.set_Pxy(M.Extract((int)motion_model.STATE_SIZE, (int)it.get_feature_measurement_model().FEATURE_STATE_SIZE, (int)y_position, (int)x_position));
                    y_position += motion_model.STATE_SIZE;

                    for (int j=0; j < it.matrix_block_list.Count; j++)
                    {
                        itmat = (MatrixFixed)(it.matrix_block_list[j]);

                        //assert (y_feature_no < x_feature_no);

                        itmat.Update(M.Extract(itmat.Rows, itmat.Columns, (int)y_position, (int)x_position));
                        y_position += (uint)itmat.Rows;
                        y_feature_no++;
                    }
                    it.set_Pyy(M.Extract((int)it.get_feature_measurement_model().FEATURE_STATE_SIZE,
                                         (int)it.get_feature_measurement_model().FEATURE_STATE_SIZE,
                                         (int)y_position, (int)x_position));

                    x_feature_no++;
                    x_position += it.get_feature_measurement_model().FEATURE_STATE_SIZE;                
                }
            }
            //assert (x_position <= total_state_size);
        }
開發者ID:iManbot,項目名稱:monoslam,代碼行數:44,代碼來源:scene_single.cs


注:本文中的SceneLibrary.MatrixFixed.Extract方法示例由純淨天空整理自Github/MSDocs等開源代碼及文檔管理平台,相關代碼片段篩選自各路編程大神貢獻的開源項目,源碼版權歸原作者所有,傳播和使用請參考對應項目的License;未經允許,請勿轉載。