calcLocalizationCRB.m Err.m graphtest.m iterative_calculating.m L2_distance.m matrix_optimal.m matrix_optimala.m trygraphtest.m