Files
allwpilib/wpilibcExamples/src/main/cpp/examples/ElevatorSimulation/include/Constants.hpp
2025-11-07 23:09:21 -08:00

56 lines
1.8 KiB
C++

// 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.
#pragma once
#include <numbers>
#include <units/acceleration.h>
#include <units/angle.h>
#include <units/length.h>
#include <units/mass.h>
#include <units/time.h>
#include <units/velocity.h>
#include <units/voltage.h>
/**
* The Constants header provides a convenient place for teams to hold robot-wide
* numerical or bool constants. This should not be used for any other purpose.
*
* It is generally a good idea to place constants into subsystem- or
* command-specific namespaces within this header, which can then be used where
* they are needed.
*/
namespace Constants {
inline constexpr int kMotorPort = 0;
inline constexpr int kEncoderAChannel = 0;
inline constexpr int kEncoderBChannel = 1;
inline constexpr int kJoystickPort = 0;
inline constexpr double kElevatorKp = 5.0;
inline constexpr double kElevatorKi = 0.0;
inline constexpr double kElevatorKd = 0.0;
inline constexpr units::volt_t kElevatorkS = 0.0_V;
inline constexpr units::volt_t kElevatorkG = 0.762_V;
inline constexpr auto kElevatorkV = 0.762_V / 1_mps;
inline constexpr auto kElevatorkA = 0.0_V / 1_mps_sq;
inline constexpr double kElevatorGearing = 10.0;
inline constexpr units::meter_t kElevatorDrumRadius = 2_in;
inline constexpr units::kilogram_t kCarriageMass = 4.0_kg;
inline constexpr units::meter_t kSetpoint = 75_cm;
inline constexpr units::meter_t kMinElevatorHeight = 0_cm;
inline constexpr units::meter_t kMaxElevatorHeight = 1.25_m;
// distance per pulse = (distance per revolution) / (pulses per revolution)
// = (Pi * D) / ppr
inline constexpr double kArmEncoderDistPerPulse =
2.0 * std::numbers::pi * kElevatorDrumRadius.value() / 4096.0;
} // namespace Constants