#include "drake/solvers/system_identification.h"
#include <algorithm>
#include <cmath>
#include "drake/common/drake_assert.h"
#include "drake/solvers/Optimization.h"