MatBuilder.java

// Copyright (c) FIRST and other WPILib contributors.
// Open Source Software; you can modify and/or share it under the terms of
// the WPILib BSD license file in the root directory of this project.
 
package org.wpilib.math.linalg;
 
import java.util.Objects;
import org.ejml.simple.SimpleMatrix;
import org.wpilib.math.util.Nat;
import org.wpilib.math.util.Num;

public final class MatBuilder {
  private MatBuilder() {
    throw new UnsupportedOperationException("This is a utility class!");
  }

  public static <R extends Num, C extends Num> Matrix<R, C> fill(
      Nat<R> rows, Nat<C> cols, double... data) {
    if (Objects.requireNonNull(data).length != rows.getNum() * cols.getNum()) {
      throw new IllegalArgumentException(
          "Invalid matrix data provided. Wanted "
              + rows.getNum()
              + " x "
              + cols.getNum()
              + " matrix, but got "
              + data.length
              + " elements");
    }
    return new Matrix<>(new SimpleMatrix(rows.getNum(), cols.getNum(), true, data));
  }
}