// 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.

#include <gtest/gtest.h>

#include "wpi/math/controller/BangBangController.hpp"

TEST(BangBangInputOutputTest, ShouldOutput) {
  wpi::math::BangBangController controller;

  EXPECT_DOUBLE_EQ(controller.Calculate(0, 1), 1);
}

TEST(BangBangInputOutputTest, ShouldNotOutput) {
  wpi::math::BangBangController controller;

  EXPECT_DOUBLE_EQ(controller.Calculate(1, 0), 0);
}
