mirror of
https://github.com/wpilibsuite/allwpilib
synced 2026-06-20 00:51:42 +00:00
31 lines
1.1 KiB
C++
31 lines
1.1 KiB
C++
/*----------------------------------------------------------------------------*/
|
|
/* Copyright (c) 2017-2019 FIRST. All Rights Reserved. */
|
|
/* Open Source Software - may be modified and shared by FRC teams. The code */
|
|
/* must be accompanied by the FIRST BSD license file in the root directory of */
|
|
/* the project. */
|
|
/*----------------------------------------------------------------------------*/
|
|
|
|
#pragma once
|
|
|
|
#include <frc2/command/CommandBase.h>
|
|
#include <frc2/command/CommandHelper.h>
|
|
|
|
#include "subsystems/Wrist.h"
|
|
|
|
/**
|
|
* Move the wrist to a given angle. This command finishes when it is within
|
|
* the tolerance, but leaves the PID loop running to maintain the position.
|
|
* Other commands using the wrist should make sure they disable PID!
|
|
*/
|
|
class SetWristSetpoint
|
|
: public frc2::CommandHelper<frc2::CommandBase, SetWristSetpoint> {
|
|
public:
|
|
explicit SetWristSetpoint(double setpoint, Wrist* wrist);
|
|
void Initialize() override;
|
|
bool IsFinished() override;
|
|
|
|
private:
|
|
double m_setpoint;
|
|
Wrist* m_wrist;
|
|
};
|