mirror of
https://github.com/wpilibsuite/allwpilib
synced 2026-06-19 00:41:43 +00:00
36 lines
1.1 KiB
Python
36 lines
1.1 KiB
Python
|
#
|
||
|
|
# 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.
|
||
|
|
#
|
||
|
|
|
||
|
|
import commands2
|
||
|
|
|
||
|
|
import constants
|
||
|
|
|
||
|
|
from .drivedistance import DriveDistance
|
||
|
|
from .releasehatch import ReleaseHatch
|
||
|
|
|
||
|
|
from subsystems.drivesubsystem import DriveSubsystem
|
||
|
|
from subsystems.hatchsubsystem import HatchSubsystem
|
||
|
|
|
||
|
|
|
||
|
|
class ComplexAuto(commands2.SequentialCommandGroup):
|
||
|
|
"""
|
||
|
|
A complex auto command that drives forward, releases a hatch, and then drives backward.
|
||
|
|
"""
|
||
|
|
|
||
|
|
def __init__(self, drive: DriveSubsystem, hatch: HatchSubsystem):
|
||
|
|
super().__init__(
|
||
|
|
# Drive forward the specified distance
|
||
|
|
DriveDistance(
|
||
|
|
constants.kAutoDriveDistanceInches, constants.kAutoDriveSpeed, drive
|
||
|
|
),
|
||
|
|
# Release the hatch
|
||
|
|
ReleaseHatch(hatch),
|
||
|
|
# Drive backward the specified distance
|
||
|
|
DriveDistance(
|
||
|
|
constants.kAutoBackupDistanceInches, -constants.kAutoDriveSpeed, drive
|
||
|
|
),
|
||
|
|
)
|