mirror of
https://github.com/wpilibsuite/allwpilib
synced 2026-06-20 00:51:42 +00:00
58021f7397
AnalogModule and DigitalModule classes still exist, at least until they are refactored into the classes that use them. Change-Id: I5544d5418822f19d54ba0a5d651e64fad8b7b10d
91 lines
3.0 KiB
C++
91 lines
3.0 KiB
C++
/*----------------------------------------------------------------------------*/
|
|
/* Copyright (c) FIRST 2008. All Rights Reserved. */
|
|
/* Open Source Software - may be modified and shared by FRC teams. The code */
|
|
/* must be accompanied by the FIRST BSD license file in $(WIND_BASE)/WPILib. */
|
|
/*----------------------------------------------------------------------------*/
|
|
#pragma once
|
|
|
|
#include "SensorBase.h"
|
|
#include "Task.h"
|
|
#include "PIDSource.h"
|
|
#include "LiveWindow/LiveWindowSendable.h"
|
|
|
|
class Counter;
|
|
class DigitalInput;
|
|
class DigitalOutput;
|
|
|
|
/**
|
|
* Ultrasonic rangefinder class.
|
|
* The Ultrasonic rangefinder measures absolute distance based on the round-trip time
|
|
* of a ping generated by the controller. These sensors use two transducers, a speaker and
|
|
* a microphone both tuned to the ultrasonic range. A common ultrasonic sensor, the Daventech SRF04
|
|
* requires a short pulse to be generated on a digital channel. This causes the chirp to be
|
|
* emmitted. A second line becomes high as the ping is transmitted and goes low when
|
|
* the echo is received. The time that the line is high determines the round trip distance
|
|
* (time of flight).
|
|
*/
|
|
class Ultrasonic : public SensorBase, public PIDSource, public LiveWindowSendable
|
|
{
|
|
public:
|
|
enum DistanceUnit
|
|
{
|
|
kInches = 0,
|
|
kMilliMeters = 1
|
|
};
|
|
|
|
Ultrasonic(DigitalOutput *pingChannel, DigitalInput *echoChannel, DistanceUnit units = kInches);
|
|
Ultrasonic(DigitalOutput &pingChannel, DigitalInput &echoChannel, DistanceUnit units = kInches);
|
|
Ultrasonic(uint32_t pingChannel, uint32_t echoChannel, DistanceUnit units = kInches);
|
|
virtual ~Ultrasonic();
|
|
|
|
void Ping();
|
|
bool IsRangeValid();
|
|
static void SetAutomaticMode(bool enabling);
|
|
double GetRangeInches();
|
|
double GetRangeMM();
|
|
bool IsEnabled()
|
|
{
|
|
return m_enabled;
|
|
}
|
|
void SetEnabled(bool enable)
|
|
{
|
|
m_enabled = enable;
|
|
}
|
|
|
|
double PIDGet();
|
|
void SetDistanceUnits(DistanceUnit units);
|
|
DistanceUnit GetDistanceUnits();
|
|
|
|
void UpdateTable();
|
|
void StartLiveWindowMode();
|
|
void StopLiveWindowMode();
|
|
std::string GetSmartDashboardType();
|
|
void InitTable(ITable *subTable);
|
|
ITable * GetTable();
|
|
|
|
private:
|
|
void Initialize();
|
|
|
|
static void UltrasonicChecker();
|
|
|
|
static constexpr double kPingTime = 10 * 1e-6; ///< Time (sec) for the ping trigger pulse.
|
|
static const uint32_t kPriority = 90; ///< Priority that the ultrasonic round robin task runs.
|
|
static constexpr double kMaxUltrasonicTime = 0.1; ///< Max time (ms) between readings.
|
|
static constexpr double kSpeedOfSoundInchesPerSec = 1130.0 * 12.0;
|
|
|
|
static Task m_task; // task doing the round-robin automatic sensing
|
|
static Ultrasonic *m_firstSensor; // head of the ultrasonic sensor list
|
|
static bool m_automaticEnabled; // automatic round robin mode
|
|
static SEMAPHORE_ID m_semaphore; // synchronize access to the list of sensors
|
|
|
|
DigitalInput *m_echoChannel;
|
|
DigitalOutput *m_pingChannel;
|
|
bool m_allocatedChannels;
|
|
bool m_enabled;
|
|
Counter *m_counter;
|
|
Ultrasonic *m_nextSensor;
|
|
DistanceUnit m_units;
|
|
|
|
ITable *m_table;
|
|
};
|