#include "drake/util/TrigPoly.h"
#include <sstream>
#include <map>
#include "gtest/gtest.h"
#include "drake/util/Polynomial.h"