private static Matrix createMatrix(List<Feature> order,Map<Feature,Point3d> pts) throws IllegalArgumentException {
  double[][] A=new double[3][order.size()];
  int i=0;
  for (  Feature f : order) {
    Point3d p=pts.get(f);
    A[0][i]=p.x;
    A[1][i]=p.y;
    A[2][i]=p.z;
    i++;
  }
  return new Matrix(A);
}

private static Matrix createMatrix ( List < Feature > order , Map < Feature , Point3d > pts ) throws IllegalArgumentException { double [ ] [ ] A = new double [ 3 ] [ order . size ( ) ] ; int i = 0 ; for ( Feature f : order ) { Point3d p = pts . get ( f ) ; A [ 0 ] [ i ] = p . x ; A [ 1 ] [ i ] = p . y ; A [ 2 ] [ i ] = p . z ; i ++ ; } return new Matrix ( A ) ; }
creates matrix object from given points
