public ScissorLift(Drive drive)
{
m_pot = new AnalogPotentiometer(5);
m_pid = new PID(0.67, 0.225, 0.5659);
PTOEnabled = false;
m_drive = drive;
}
public DriveHelper(ref Drive drive_)
{
drive = drive_;
oldTurn = quickStopAccumulator = oldSpeed = oldWheel = negInertiaAccumulator = lastShift = 0;
throttleAccel = new InputFilter(0);
wheelAccel = new InputFilter(0);
isHighGear = false;
}
/**
* This function is run when the robot is first started up and should be
* used for any initialization code.
*/
public override void RobotInit()
{
drive = new Drive();
primary = new Controllers();
roller = new Roller();
conveyer = new Conveyer();
TeleopDrive = new DriveHelper(ref drive);
}