Pigeon2.hpp

Go to the documentation of this file.

/*
 * Copyright (C) Cross The Road Electronics.  All rights reserved.
 * License information can be found in CTRE_LICENSE.txt
 * For support and suggestions contact support@ctr-electronics.com or file
 * an issue tracker at https://github.com/CrossTheRoadElec/Phoenix-Releases
 */
#pragma once
 
#include "ctre/phoenixpro/core/CorePigeon2.hpp"
#include "ctre/phoenix/platform/DeviceType.hpp"
 
#include "frc/interfaces/Gyro.h"
#include "frc/geometry/Rotation2d.h"
#include "wpi/sendable/Sendable.h"
#include "wpi/sendable/SendableBuilder.h"
#include "wpi/sendable/SendableHelper.h"
#include <hal/SimDevice.h>
 
 
namespace ctre {
namespace phoenixpro {
namespace hardware {
 
/**
 * Class description for the Pigeon 2 IMU sensor that measures orientation.
 */
class Pigeon2 : public core::CorePigeon2,
                public frc::Gyro,
                public wpi::Sendable,
                public wpi::SendableHelper<Pigeon2>
{
    /**
     * The StatusSignalValue getters are copies so that calls
     * to the WPI interface do not update any references
     *
     * These are also mutable so the const getter methods are
     * properly managed.
     */
    mutable StatusSignalValue<units::angle::degree_t> m_yawGetter = GetYaw();
    mutable StatusSignalValue<units::angular_velocity::degrees_per_second_t> m_yawRateGetter = GetAngularVelocityZ();
 
    static constexpr phoenix::platform::DeviceType kSimDeviceType = phoenix::platform::DeviceType::PRO_Pigeon2Type;
 
    hal::SimDevice m_simPigeon;
    hal::SimDouble m_simSupplyVoltage;
    hal::SimDouble m_simYaw;
    hal::SimDouble m_simRawYaw;
    hal::SimDouble m_simPitch;
    hal::SimDouble m_simRoll;
 
    int32_t m_simPeriodicUid{-1};
    std::vector<int32_t> m_simValueChangedUids;
 
    static void OnValueChanged(const char* name, void* param, HAL_SimValueHandle handle,
                               HAL_Bool readonly, const struct HAL_Value* value);
    static void OnPeriodic(void* param);
 
public:
    /**
     * Constructs a new Pigeon 2 sensor object.
     *
     * \param deviceId    ID of the device, as configured in Phoenix Tuner.
     * \param canbus      Name of the CAN bus this device is on. Possible CAN bus strings are:
     *                    - "rio" for the native roboRIO CAN bus
     *                    - CANivore name or serial number
     *                    - SocketCAN interface (non-FRC Linux only)
     *                    - "*" for any CANivore seen by the program
     *                    - empty string (default) to select the default for the system:
     *                      - "rio" on roboRIO
     *                      - "can0" on Linux
     *                      - "*" on Windows
     */
    Pigeon2(int deviceId, std::string canbus = "");
    ~Pigeon2();
 
    void InitSendable(wpi::SendableBuilder& builder) override;
 
    /**
     * This function does nothing; it exists
     * to satisfy the WPILib Gyro interface.
     *
     * Pigeon 2 does not require manual calibration.
     */
    void Calibrate() final {}
    void Reset() final;
    double GetAngle() const override;
    double GetRate() const override;
 
    frc::Rotation2d GetRotation2d() const override;
};
 
}
}
}