Remove usage of CHECK_NOTNULL

We want to switch to absl logging instead of glog.  gtest and ceres are
going there, and we already have absl as a dependency.  ABSL doesn't
have CHECK_NOTNULL, and we can move things over in an easier to review
fashion.

Change-Id: Ifd9a11ec34a2357cec43f88dba015db9c28ed2cf
Signed-off-by: Austin Schuh <austin.linux@gmail.com>
diff --git a/frc971/control_loops/drivetrain/trajectory.cc b/frc971/control_loops/drivetrain/trajectory.cc
index cf9929f..4db41ee 100644
--- a/frc971/control_loops/drivetrain/trajectory.cc
+++ b/frc971/control_loops/drivetrain/trajectory.cc
@@ -38,9 +38,13 @@
         StateFeedbackLoop<2, 2, 2, double, StateFeedbackHybridPlant<2, 2, 2>,
                           HybridKalman<2, 2, 2>>>
         velocity_drivetrain)
-    : BaseTrajectory(CHECK_NOTNULL(CHECK_NOTNULL(buffer->spline())->spline())
-                         ->constraints(),
-                     config, std::move(velocity_drivetrain)),
+    : BaseTrajectory(
+          [&]() {
+            CHECK(buffer->spline() != nullptr);
+            CHECK(buffer->spline()->spline() != nullptr);
+            return buffer->spline()->spline()->constraints();
+          }(),
+          config, std::move(velocity_drivetrain)),
       buffer_(buffer),
       spline_(*buffer_->spline()) {}
 
@@ -819,8 +823,9 @@
 
 Eigen::Matrix<double, 2, 5> FinishedTrajectory::GainForDistance(
     double distance) const {
+  CHECK(trajectory().gains() != nullptr);
   const flatbuffers::Vector<flatbuffers::Offset<fb::GainPoint>> &gains =
-      *CHECK_NOTNULL(trajectory().gains());
+      *trajectory().gains();
   CHECK_LT(0u, gains.size());
   size_t index = 0;
   for (index = 0; index < gains.size() - 1; ++index) {