mirror of
https://github.com/wpilibsuite/allwpilib
synced 2026-06-19 00:41:43 +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)
|