本文整理汇总了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);
}