mirror of
https://github.com/wpilibsuite/allwpilib
synced 2026-06-20 00:51:42 +00:00
29 lines
744 B
Python
29 lines
744 B
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 xrp
|
||
|
|
|
||
|
|
|
||
|
|
class Arm(commands2.Subsystem):
|
||
|
|
|
||
|
|
def __init__(self):
|
||
|
|
"""Creates a new Arm."""
|
||
|
|
|
||
|
|
# Device number 4 maps to the physical Servo 1 port on the XRP
|
||
|
|
self.armServo = xrp.XRPServo(4)
|
||
|
|
|
||
|
|
def periodic(self):
|
||
|
|
"""This method will be called once per scheduler run"""
|
||
|
|
|
||
|
|
def setAngle(self, angleDeg: float):
|
||
|
|
"""
|
||
|
|
Set the current angle of the arm (0 - 180 degrees).
|
||
|
|
|
||
|
|
:param angleDeg: Desired arm angle in degrees
|
||
|
|
"""
|
||
|
|
self.armServo.setAngle(angleDeg)
|