2020-12-26 14:12:05 -08:00
|
|
|
// 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.
|
2017-10-17 21:37:58 -07:00
|
|
|
|
|
|
|
|
#pragma once
|
|
|
|
|
|
2018-07-20 00:03:45 -07:00
|
|
|
#include <frc/commands/Command.h>
|
2017-10-17 21:37:58 -07:00
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* Moves the pivot 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 pivot should make sure they disable PID!
|
|
|
|
|
*/
|
|
|
|
|
class SetPivotSetpoint : public frc::Command {
|
2018-05-13 17:09:56 -07:00
|
|
|
public:
|
|
|
|
|
explicit SetPivotSetpoint(double setpoint);
|
|
|
|
|
void Initialize() override;
|
|
|
|
|
bool IsFinished() override;
|
2017-10-17 21:37:58 -07:00
|
|
|
|
2018-05-13 17:09:56 -07:00
|
|
|
private:
|
|
|
|
|
double m_setpoint;
|
2017-10-17 21:37:58 -07:00
|
|
|
};
|