Subsystem-Alt Sistem için Kod Yazma

Gerçek bir çalışan alt sistem oluşturmak için kod eklemek çok basittir. Geri bildirim kullanmayan basit alt sistemler için son derece basit olduğu ortaya çıkıyor. Bu bölümde bir Claw alt sistemi örneğine bakacağız. Claw alt sistemi ayrıca bir nesnenin kavramada olup olmadığını belirlemek için bir limit anahtarına sahiptir.

Claw Subsystem-Pençe Alt Sisteminin RobotBuilder Temsili

../../../../../_images/writing-subsystem-code-1.png

Bir robot kolunun ucundaki pençe, tek bir VictorSPX Motor Kontrol Cihazı tarafından çalıştırılan bir alt sistemdir. Motorun yapmasını istediğimiz üç şey var, açmaya başlaması, kapanmaya başlaması ve hareket etmeyi bırakması. Bu, alt sistemin sorumluluğundadır. Açma ve kapama zamanlaması, bu eğitimin ilerleyen bölümlerinde bir komutla ele alınacaktır. Pençenin bir nesneyi tutup tutmadığını anlamak için bir yöntem de tanımlayacağız.

Subsystem-Alt Sistem Yetenekleri Ekleme

11// ROBOTBUILDER TYPE: Subsystem.
12
13package frc.robot.subsystems;
14
15
16import frc.robot.commands.*;
17import edu.wpi.first.wpilibj.livewindow.LiveWindow;
18import edu.wpi.first.wpilibj2.command.SubsystemBase;
19
20// BEGIN AUTOGENERATED CODE, SOURCE=ROBOTBUILDER ID=IMPORTS
21import edu.wpi.first.wpilibj.DigitalInput;
22import edu.wpi.first.wpilibj.motorcontrol.PWMVictorSPX;
23
24    // END AUTOGENERATED CODE, SOURCE=ROBOTBUILDER ID=IMPORTS
25
26
27/**
28 *
29 */
30public class Claw extends SubsystemBase {
31    // BEGIN AUTOGENERATED CODE, SOURCE=ROBOTBUILDER ID=CONSTANTS
32
33    // END AUTOGENERATED CODE, SOURCE=ROBOTBUILDER ID=CONSTANTS
34
35    // BEGIN AUTOGENERATED CODE, SOURCE=ROBOTBUILDER ID=DECLARATIONS
36private PWMVictorSPX motor;
37private DigitalInput limitswitch;
38
39    // END AUTOGENERATED CODE, SOURCE=ROBOTBUILDER ID=DECLARATIONS
40    
41    /**
42    *
43    */
44    public Claw() {
45        // BEGIN AUTOGENERATED CODE, SOURCE=ROBOTBUILDER ID=CONSTRUCTORS
46motor = new PWMVictorSPX(4);
47 addChild("motor",motor);
48 motor.setInverted(false);
49
50limitswitch = new DigitalInput(4);
51 addChild("limit switch", limitswitch);
52 
53
54
55    // END AUTOGENERATED CODE, SOURCE=ROBOTBUILDER ID=CONSTRUCTORS
56    }
57
58    @Override
59    public void periodic() {
60        // This method will be called once per scheduler run
61
62    }
63
64    @Override
65    public void simulationPeriodic() {
66        // This method will be called once per scheduler run when in simulation
67
68    }
69
70    // Put methods for controlling this subsystem
71    // here. Call these from Commands.
72    
73    public void open() {
74        motor.set(1.0);
75    }
76
77    public void close() {
78        motor.set(-1.0);
79    }
80
81    public void stop() {
82        motor.set(0.0);
83    }
84
85    public boolean isGripping() {
86        return limitswitch.get();
87    }
88
89}
11// ROBOTBUILDER TYPE: Subsystem.
12
13// BEGIN AUTOGENERATED CODE, SOURCE=ROBOTBUILDER ID=INCLUDES
14#include "subsystems/Claw.h"
15#include <frc/smartdashboard/SmartDashboard.h>
16
17    // END AUTOGENERATED CODE, SOURCE=ROBOTBUILDER ID=INCLUDES
18
19Claw::Claw(){
20    SetName("Claw");
21    // BEGIN AUTOGENERATED CODE, SOURCE=ROBOTBUILDER ID=DECLARATIONS
22    SetSubsystem("Claw");
23
24 AddChild("limit switch", &m_limitswitch);
25 
26
27 AddChild("motor", &m_motor);
28 m_motor.SetInverted(false);
29
30
31    // END AUTOGENERATED CODE, SOURCE=ROBOTBUILDER ID=DECLARATIONS
32}
33
34void Claw::Periodic() {
35    // Put code here to be run every loop
36
37}
38
39void Claw::SimulationPeriodic() {
40    // This method will be called once per scheduler run when in simulation
41
42}
43
44// BEGIN AUTOGENERATED CODE, SOURCE=ROBOTBUILDER ID=CMDPIDGETTERS
45
46    // END AUTOGENERATED CODE, SOURCE=ROBOTBUILDER ID=CMDPIDGETTERS
47
48
49// Put methods for controlling this subsystem
50// here. Call these from Commands.
51
52void Claw::Open() {
53    m_motor.Set(1.0);
54}
55
56void Claw::Close() {
57    m_motor.Set(-1.0);
58}
59
60void Claw::Stop() {
61    m_motor.Set(0.0);
62}
63
64bool Claw::IsGripping() {
65    return m_limitswitch.Get();
66}

claw.java veya claw.cpp ye pençe hareketini açacak, kapatacak ve durduracak ve pençe sınır anahtarını alacak yöntemler ekleyin. Bunlar pençeyi gerçekten çalıştıran komutlar tarafından kullanılacak.

motor ve limitswitch adlı üye değişkeninin RobotBuilder tarafından yaratıldığına dikkat edin, böylece alt sistem genelinde kullanılabilir. Sürüklenen palet öğelerinizin her biri, RobotBuilder’da verilen ada sahip bir üye değişkenine sahip olacaktır.

Üstbilgi Dosyasına Yöntem Bildirimleri Ekleme (Yalnızca C ++)

11// ROBOTBUILDER TYPE: Subsystem.
12#pragma once
13
14// BEGIN AUTOGENERATED CODE, SOURCE=ROBOTBUILDER ID=INCLUDES
15#include <frc2/command/SubsystemBase.h>
16#include <frc/DigitalInput.h>
17#include <frc/motorcontrol/PWMVictorSPX.h>
18
19    // END AUTOGENERATED CODE, SOURCE=ROBOTBUILDER ID=INCLUDES
20
21/**
22 *
23 *
24 * @author ExampleAuthor
25 */
26class Claw: public frc2::SubsystemBase {
27private:
28    // It's desirable that everything possible is private except
29    // for methods that implement subsystem capabilities
30    // BEGIN AUTOGENERATED CODE, SOURCE=ROBOTBUILDER ID=DECLARATIONS
31frc::DigitalInput m_limitswitch{4};
32frc::PWMVictorSPX m_motor{4};
33
34    // END AUTOGENERATED CODE, SOURCE=ROBOTBUILDER ID=DECLARATIONS
35public:
36Claw();
37
38    void Periodic() override;
39    void SimulationPeriodic() override;
40    void Open();
41    void Close();
42    void Stop();
43    bool IsGripping();
44
45    // BEGIN AUTOGENERATED CODE, SOURCE=ROBOTBUILDER ID=CMDPIDGETTERS
46
47    // END AUTOGENERATED CODE, SOURCE=ROBOTBUILDER ID=CMDPIDGETTERS
48    // BEGIN AUTOGENERATED CODE, SOURCE=ROBOTBUILDER ID=CONSTANTS
49
50    // END AUTOGENERATED CODE, SOURCE=ROBOTBUILDER ID=CONSTANTS
51
52
53};

Yöntemleri sınıf uygulama dosyasına Claw.cpp eklemeye ek olarak, yöntemlerin bildirimlerinin Claw.h başlık dosyasına eklenmesi gerekir. Eklenmesi gereken beyanlar burada gösterilmektedir.

Açma ve kapama davranışını pençe alt sistemine eklemek için şunları yapmanız gerekir <../introduction/robotbuilder-creating-command> komutlarını tanımlayın.