fixed the double comparison

git-svn-id: https://robotics.mvla.net/svn/frc971/2013/trunk/src@4187 f308d9b7-e957-4cde-b6ac-9a88185e7312
diff --git a/aos/common/util/trapezoid_profile_test.cc b/aos/common/util/trapezoid_profile_test.cc
index 6a06942..882d1b5 100644
--- a/aos/common/util/trapezoid_profile_test.cc
+++ b/aos/common/util/trapezoid_profile_test.cc
@@ -31,11 +31,12 @@
   TrapezoidProfile profile_;
 
   ::testing::AssertionResult At(double position, double velocity) {
-    if (velocity != position_(1)) {
+    static const double kDoubleNear = 0.00001;
+    if (::std::abs(velocity - position_(1)) > kDoubleNear) {
       return ::testing::AssertionFailure() << "velocity is " << position_(1) <<
           " not " << velocity;
     }
-    if (position != position_(0)) {
+    if (::std::abs(position - position_(0)) > kDoubleNear) {
       return ::testing::AssertionFailure() << "position is " << position_(0) <<
           " not " << position;
     }