Add new joystick features

Axis counts other than six and POVs are both present in C++ and Java now

Add dynamic joystick axis counts, up to 12

Change-Id: Ieade5e61a89df822df8702cb32326e4635558778

Add support for POVs in C++

Change-Id: I12dc0fcaca605a256ddcf990eebde45767229171

Make POVs work in Java

Change-Id: Ie2d98adb416c1930f058bdd21c3e7d26289df503
This commit is contained in:
Thomas Clark
2014-10-17 14:46:25 -04:00
parent 08c8723174
commit 8a541a67ca
16 changed files with 199 additions and 74 deletions

View File

@@ -161,9 +161,20 @@ enum HALAllianceStationID {
kHALAllianceStationID_blue3, kHALAllianceStationID_blue3,
}; };
/* The maximum number of axes that will be stored in a single HALJoystickAxes
struct. This is used for allocating buffers, not bounds checking, since
there are usually less axes in practice. */
static constexpr size_t kMaxJoystickAxes = 12;
static constexpr size_t kMaxJoystickPOVs = 12;
struct HALJoystickAxes { struct HALJoystickAxes {
uint16_t count; uint16_t count;
int16_t axes[6]; int16_t axes[kMaxJoystickAxes];
};
struct HALJoystickPOVs {
uint16_t count;
int16_t povs[kMaxJoystickPOVs];
}; };
typedef uint32_t HALJoystickButtons; typedef uint32_t HALJoystickButtons;
@@ -199,7 +210,8 @@ extern "C"
int HALGetControlWord(HALControlWord *data); int HALGetControlWord(HALControlWord *data);
int HALGetAllianceStation(enum HALAllianceStationID *allianceStation); int HALGetAllianceStation(enum HALAllianceStationID *allianceStation);
int HALGetJoystickAxes(uint8_t joystickNum, HALJoystickAxes *axes, uint8_t maxAxes); int HALGetJoystickAxes(uint8_t joystickNum, HALJoystickAxes *axes);
int HALGetJoystickPOVs(uint8_t joystickNum, HALJoystickPOVs *povs);
int HALGetJoystickButtons(uint8_t joystickNum, HALJoystickButtons *buttons, uint8_t *count); int HALGetJoystickButtons(uint8_t joystickNum, HALJoystickButtons *buttons, uint8_t *count);
void HALSetNewDataSem(pthread_mutex_t *); void HALSetNewDataSem(pthread_mutex_t *);

View File

@@ -125,9 +125,14 @@ int HALGetAllianceStation(enum HALAllianceStationID *allianceStation)
return FRC_NetworkCommunication_getAllianceStation((AllianceStationID_t*) allianceStation); return FRC_NetworkCommunication_getAllianceStation((AllianceStationID_t*) allianceStation);
} }
int HALGetJoystickAxes(uint8_t joystickNum, HALJoystickAxes *axes, uint8_t maxAxes) int HALGetJoystickAxes(uint8_t joystickNum, HALJoystickAxes *axes)
{ {
return FRC_NetworkCommunication_getJoystickAxes(joystickNum, (JoystickAxes_t*) axes, maxAxes); return FRC_NetworkCommunication_getJoystickAxes(joystickNum, (JoystickAxes_t*) axes, kMaxJoystickAxes);
}
int HALGetJoystickPOVs(uint8_t joystickNum, HALJoystickPOVs *povs)
{
return FRC_NetworkCommunication_getJoystickPOVs(joystickNum, (JoystickPOV_t*) povs, kMaxJoystickPOVs);
} }
int HALGetJoystickButtons(uint8_t joystickNum, HALJoystickButtons *buttons, uint8_t *count) int HALGetJoystickButtons(uint8_t joystickNum, HALJoystickButtons *buttons, uint8_t *count)

View File

@@ -33,4 +33,6 @@ public:
virtual bool GetTop(JoystickHand hand = kRightHand) = 0; virtual bool GetTop(JoystickHand hand = kRightHand) = 0;
virtual bool GetBumper(JoystickHand hand = kRightHand) = 0; virtual bool GetBumper(JoystickHand hand = kRightHand) = 0;
virtual bool GetRawButton(uint32_t button) = 0; virtual bool GetRawButton(uint32_t button) = 0;
virtual int GetPOV(uint32_t pov = 1) = 0;
}; };

View File

@@ -65,8 +65,8 @@ S(CompressorTaskError, 3, "Compressor task won't start");
S(LoopTimingError, 4, "Digital module loop timing is not the expected value"); S(LoopTimingError, 4, "Digital module loop timing is not the expected value");
S(NonBinaryDigitalValue, 5, "Digital output value is not 0 or 1"); S(NonBinaryDigitalValue, 5, "Digital output value is not 0 or 1");
S(IncorrectBatteryChannel, 6, "Battery measurement channel is not correct value"); S(IncorrectBatteryChannel, 6, "Battery measurement channel is not correct value");
S(BadJoystickIndex, 7, "Joystick index is out of range, should be 1-4"); S(BadJoystickIndex, 7, "Joystick index is out of range, should be 0-3");
S(BadJoystickAxis, 8, "Joystick axis is out of range"); S(BadJoystickAxis, 8, "Joystick axis or POV is out of range");
S(InvalidMotorIndex, 9, "Motor index is out of range, should be 0-3"); S(InvalidMotorIndex, 9, "Motor index is out of range, should be 0-3");
S(DriverStationTaskError, 10, "Driver Station task won't start"); S(DriverStationTaskError, 10, "Driver Station task won't start");
S(EnhancedIOPWMPeriodOutOfRange, 11, "Driver Station Enhanced IO PWM Output period out of range."); S(EnhancedIOPWMPeriodOutOfRange, 11, "Driver Station Enhanced IO PWM Output period out of range.");

View File

@@ -30,9 +30,9 @@ public:
static DriverStation *GetInstance(); static DriverStation *GetInstance();
static const uint32_t kJoystickPorts = 4; static const uint32_t kJoystickPorts = 4;
static const uint32_t kJoystickAxes = 6;
float GetStickAxis(uint32_t stick, uint32_t axis); float GetStickAxis(uint32_t stick, uint32_t axis);
int GetStickPOV(uint32_t stick, uint32_t pov);
short GetStickButtons(uint32_t stick); short GetStickButtons(uint32_t stick);
bool IsEnabled(); bool IsEnabled();
@@ -98,6 +98,7 @@ private:
HALControlWord m_controlWord; HALControlWord m_controlWord;
HALAllianceStationID m_allianceStationID; HALAllianceStationID m_allianceStationID;
HALJoystickAxes m_joystickAxes[kJoystickPorts]; HALJoystickAxes m_joystickAxes[kJoystickPorts];
HALJoystickPOVs m_joystickPOVs[kJoystickPorts];
HALJoystickButtons m_joystickButtons[kJoystickPorts]; HALJoystickButtons m_joystickButtons[kJoystickPorts];
MUTEX_ID m_statusDataSemaphore; MUTEX_ID m_statusDataSemaphore;

View File

@@ -42,7 +42,7 @@ public:
virtual ~Joystick(); virtual ~Joystick();
uint32_t GetAxisChannel(AxisType axis); uint32_t GetAxisChannel(AxisType axis);
void SetAxisChannel(AxisType axis, uint32_t channel); void SetAxisChannel(AxisType axis, uint32_t channel);
virtual float GetX(JoystickHand hand = kRightHand); virtual float GetX(JoystickHand hand = kRightHand);
virtual float GetY(JoystickHand hand = kRightHand); virtual float GetY(JoystickHand hand = kRightHand);
@@ -55,10 +55,11 @@ public:
virtual bool GetTrigger(JoystickHand hand = kRightHand); virtual bool GetTrigger(JoystickHand hand = kRightHand);
virtual bool GetTop(JoystickHand hand = kRightHand); virtual bool GetTop(JoystickHand hand = kRightHand);
virtual bool GetBumper(JoystickHand hand = kRightHand); virtual bool GetBumper(JoystickHand hand = kRightHand);
virtual bool GetButton(ButtonType button); virtual bool GetRawButton(uint32_t button);
bool GetRawButton(uint32_t button); virtual int GetPOV(uint32_t pov = 1);
bool GetButton(ButtonType button);
static Joystick* GetStickForPort(uint32_t port); static Joystick* GetStickForPort(uint32_t port);
virtual float GetMagnitude(); virtual float GetMagnitude();
virtual float GetDirectionRadians(); virtual float GetDirectionRadians();
virtual float GetDirectionDegrees(); virtual float GetDirectionDegrees();
@@ -74,4 +75,3 @@ private:
}; };
#endif #endif

View File

@@ -24,7 +24,6 @@ TLogLevel dsLogLevel = logDEBUG;
else Log().Get(level) else Log().Get(level)
const uint32_t DriverStation::kJoystickPorts; const uint32_t DriverStation::kJoystickPorts;
const uint32_t DriverStation::kJoystickAxes;
DriverStation* DriverStation::m_instance = NULL; DriverStation* DriverStation::m_instance = NULL;
/** /**
@@ -46,6 +45,13 @@ DriverStation::DriverStation()
{ {
memset(&m_controlWord, 0, sizeof(m_controlWord)); memset(&m_controlWord, 0, sizeof(m_controlWord));
// All joysticks should default to having zero axes and povs, so
// uninitialized memory doesn't get sent to speed controllers.
for(unsigned int i = 0; i < kJoystickPorts; i++) {
m_joystickAxes[i].count = 0;
m_joystickPOVs[i].count = 0;
}
// Create a new semaphore // Create a new semaphore
m_packetDataAvailableSem = initializeMutexNormal(); m_packetDataAvailableSem = initializeMutexNormal();
m_newControlData = initializeSemaphore(SEMAPHORE_EMPTY); m_newControlData = initializeSemaphore(SEMAPHORE_EMPTY);
@@ -135,7 +141,8 @@ void DriverStation::GetData()
for(uint8_t stick = 0; stick < kJoystickPorts; stick++) { for(uint8_t stick = 0; stick < kJoystickPorts; stick++) {
uint8_t count; uint8_t count;
HALGetJoystickAxes(stick, &m_joystickAxes[stick], kJoystickAxes); HALGetJoystickAxes(stick, &m_joystickAxes[stick]);
HALGetJoystickPOVs(stick, &m_joystickPOVs[stick]);
HALGetJoystickButtons(stick, &m_joystickButtons[stick], &count); HALGetJoystickButtons(stick, &m_joystickButtons[stick], &count);
} }
@@ -185,7 +192,7 @@ float DriverStation::GetStickAxis(uint32_t stick, uint32_t axis)
return 0; return 0;
} }
if (axis < 1 || axis > kJoystickAxes) if (axis < 1 || axis > m_joystickAxes[stick].count)
{ {
wpi_setWPIError(BadJoystickAxis); wpi_setWPIError(BadJoystickAxis);
return 0.0f; return 0.0f;
@@ -203,6 +210,27 @@ float DriverStation::GetStickAxis(uint32_t stick, uint32_t axis)
} }
} }
/**
* Get the state of a POV on the joystick.
*
* @return the angle of the POV in degrees, or -1 if the POV is not pressed.
*/
int DriverStation::GetStickPOV(uint32_t stick, uint32_t pov) {
if (stick >= kJoystickPorts)
{
wpi_setWPIError(BadJoystickIndex);
return 0;
}
if (pov < 1 || pov > m_joystickPOVs[stick].count)
{
wpi_setWPIError(BadJoystickAxis);
return 0;
}
return m_joystickPOVs[stick].povs[pov - 1];
}
/** /**
* The state of the buttons on the joystick. * The state of the buttons on the joystick.
* 12 buttons (4 msb are unused) from the joystick. * 12 buttons (4 msb are unused) from the joystick.

View File

@@ -23,7 +23,7 @@ static bool joySticksInitialized = false;
/** /**
* Construct an instance of a joystick. * Construct an instance of a joystick.
* The joystick index is the usb port on the drivers station. * The joystick index is the usb port on the drivers station.
* *
* @param port The port on the driver station that the joystick is plugged into. * @param port The port on the driver station that the joystick is plugged into.
*/ */
Joystick::Joystick(uint32_t port) Joystick::Joystick(uint32_t port)
@@ -39,7 +39,7 @@ Joystick::Joystick(uint32_t port)
m_axes[kZAxis] = kDefaultZAxis; m_axes[kZAxis] = kDefaultZAxis;
m_axes[kTwistAxis] = kDefaultTwistAxis; m_axes[kTwistAxis] = kDefaultTwistAxis;
m_axes[kThrottleAxis] = kDefaultThrottleAxis; m_axes[kThrottleAxis] = kDefaultThrottleAxis;
m_buttons[kTriggerButton] = kDefaultTriggerButton; m_buttons[kTriggerButton] = kDefaultTriggerButton;
m_buttons[kTopButton] = kDefaultTopButton; m_buttons[kTopButton] = kDefaultTopButton;
@@ -48,10 +48,10 @@ Joystick::Joystick(uint32_t port)
/** /**
* Version of the constructor to be called by sub-classes. * Version of the constructor to be called by sub-classes.
* *
* This constructor allows the subclass to configure the number of constants * This constructor allows the subclass to configure the number of constants
* for axes and buttons. * for axes and buttons.
* *
* @param port The port on the driver station that the joystick is plugged into. * @param port The port on the driver station that the joystick is plugged into.
* @param numAxisTypes The number of axis types in the enum. * @param numAxisTypes The number of axis types in the enum.
* @param numButtonTypes The number of button types in the enum. * @param numButtonTypes The number of button types in the enum.
@@ -148,7 +148,7 @@ float Joystick::GetThrottle()
/** /**
* Get the value of the axis. * Get the value of the axis.
* *
* @param axis The axis to read [1-6]. * @param axis The axis to read [1-6].
* @return The value of the axis. * @return The value of the axis.
*/ */
@@ -159,10 +159,10 @@ float Joystick::GetRawAxis(uint32_t axis)
/** /**
* For the current joystick, return the axis determined by the argument. * For the current joystick, return the axis determined by the argument.
* *
* This is for cases where the joystick axis is returned programatically, otherwise one of the * This is for cases where the joystick axis is returned programatically, otherwise one of the
* previous functions would be preferable (for example GetX()). * previous functions would be preferable (for example GetX()).
* *
* @param axis The axis to read. * @param axis The axis to read.
* @return The value of the axis. * @return The value of the axis.
*/ */
@@ -183,9 +183,9 @@ float Joystick::GetAxis(AxisType axis)
/** /**
* Read the state of the trigger on the joystick. * Read the state of the trigger on the joystick.
* *
* Look up which button has been assigned to the trigger and read its state. * Look up which button has been assigned to the trigger and read its state.
* *
* @param hand This parameter is ignored for the Joystick class and is only here to complete the GenericHID interface. * @param hand This parameter is ignored for the Joystick class and is only here to complete the GenericHID interface.
* @return The state of the trigger. * @return The state of the trigger.
*/ */
@@ -196,9 +196,9 @@ bool Joystick::GetTrigger(JoystickHand hand)
/** /**
* Read the state of the top button on the joystick. * Read the state of the top button on the joystick.
* *
* Look up which button has been assigned to the top and read its state. * Look up which button has been assigned to the top and read its state.
* *
* @param hand This parameter is ignored for the Joystick class and is only here to complete the GenericHID interface. * @param hand This parameter is ignored for the Joystick class and is only here to complete the GenericHID interface.
* @return The state of the top button. * @return The state of the top button.
*/ */
@@ -219,10 +219,10 @@ bool Joystick::GetBumper(JoystickHand hand)
/** /**
* Get the button value for buttons 1 through 12. * Get the button value for buttons 1 through 12.
* *
* The buttons are returned in a single 16 bit value with one bit representing the state * The buttons are returned in a single 16 bit value with one bit representing the state
* of each button. The appropriate button is returned as a boolean value. * of each button. The appropriate button is returned as a boolean value.
* *
* @param button The button number to be read. * @param button The button number to be read.
* @return The state of the button. * @return The state of the button.
**/ **/
@@ -231,11 +231,20 @@ bool Joystick::GetRawButton(uint32_t button)
return ((0x1 << (button-1)) & m_ds->GetStickButtons(m_port)) != 0; return ((0x1 << (button-1)) & m_ds->GetStickButtons(m_port)) != 0;
} }
/**
* Get the state of a POV on the joystick.
*
* @return the angle of the POV in degrees, or -1 if the POV is not pressed.
*/
int Joystick::GetPOV(uint32_t pov) {
return m_ds->GetStickPOV(m_port, pov);
}
/** /**
* Get buttons based on an enumerated type. * Get buttons based on an enumerated type.
* *
* The button type will be looked up in the list of buttons and then read. * The button type will be looked up in the list of buttons and then read.
* *
* @param button The type of button to read. * @param button The type of button to read.
* @return The state of the button. * @return The state of the button.
*/ */
@@ -252,7 +261,7 @@ bool Joystick::GetButton(ButtonType button)
/** /**
* Get the channel currently associated with the specified axis. * Get the channel currently associated with the specified axis.
* *
* @param axis The axis to look up the channel for. * @param axis The axis to look up the channel for.
* @return The channel fr the axis. * @return The channel fr the axis.
*/ */
@@ -263,7 +272,7 @@ uint32_t Joystick::GetAxisChannel(AxisType axis)
/** /**
* Set the channel associated with a specified axis. * Set the channel associated with a specified axis.
* *
* @param axis The axis to set the channel for. * @param axis The axis to set the channel for.
* @param channel The channel to set the axis to. * @param channel The channel to set the axis to.
*/ */
@@ -275,7 +284,7 @@ void Joystick::SetAxisChannel(AxisType axis, uint32_t channel)
/** /**
* Get the magnitude of the direction vector formed by the joystick's * Get the magnitude of the direction vector formed by the joystick's
* current position relative to its origin * current position relative to its origin
* *
* @return The magnitude of the direction vector * @return The magnitude of the direction vector
*/ */
float Joystick::GetMagnitude(){ float Joystick::GetMagnitude(){
@@ -285,7 +294,7 @@ float Joystick::GetMagnitude(){
/** /**
* Get the direction of the vector formed by the joystick and its origin * Get the direction of the vector formed by the joystick and its origin
* in radians * in radians
* *
* @return The direction of the vector in radians * @return The direction of the vector in radians
*/ */
float Joystick::GetDirectionRadians(){ float Joystick::GetDirectionRadians(){
@@ -295,10 +304,10 @@ float Joystick::GetDirectionRadians(){
/** /**
* Get the direction of the vector formed by the joystick and its origin * Get the direction of the vector formed by the joystick and its origin
* in degrees * in degrees
* *
* uses acos(-1) to represent Pi due to absence of readily accessable Pi * uses acos(-1) to represent Pi due to absence of readily accessable Pi
* constant in C++ * constant in C++
* *
* @return The direction of the vector in degrees * @return The direction of the vector in degrees
*/ */
float Joystick::GetDirectionDegrees(){ float Joystick::GetDirectionDegrees(){

View File

@@ -42,7 +42,7 @@ public:
virtual ~Joystick(); virtual ~Joystick();
uint32_t GetAxisChannel(AxisType axis); uint32_t GetAxisChannel(AxisType axis);
void SetAxisChannel(AxisType axis, uint32_t channel); void SetAxisChannel(AxisType axis, uint32_t channel);
virtual float GetX(JoystickHand hand = kRightHand); virtual float GetX(JoystickHand hand = kRightHand);
virtual float GetY(JoystickHand hand = kRightHand); virtual float GetY(JoystickHand hand = kRightHand);
@@ -55,10 +55,11 @@ public:
virtual bool GetTrigger(JoystickHand hand = kRightHand); virtual bool GetTrigger(JoystickHand hand = kRightHand);
virtual bool GetTop(JoystickHand hand = kRightHand); virtual bool GetTop(JoystickHand hand = kRightHand);
virtual bool GetBumper(JoystickHand hand = kRightHand); virtual bool GetBumper(JoystickHand hand = kRightHand);
virtual bool GetButton(ButtonType button); virtual bool GetRawButton(uint32_t button);
bool GetRawButton(uint32_t button); virtual int GetPOV(uint32_t pov = 1);
bool GetButton(ButtonType button);
static Joystick* GetStickForPort(uint32_t port); static Joystick* GetStickForPort(uint32_t port);
virtual float GetMagnitude(); virtual float GetMagnitude();
virtual float GetDirectionRadians(); virtual float GetDirectionRadians();
virtual float GetDirectionDegrees(); virtual float GetDirectionDegrees();
@@ -74,4 +75,3 @@ private:
}; };
#endif #endif

View File

@@ -22,7 +22,7 @@ static bool joySticksInitialized = false;
/** /**
* Construct an instance of a joystick. * Construct an instance of a joystick.
* The joystick index is the usb port on the drivers station. * The joystick index is the usb port on the drivers station.
* *
* @param port The port on the driver station that the joystick is plugged into. * @param port The port on the driver station that the joystick is plugged into.
*/ */
Joystick::Joystick(uint32_t port) Joystick::Joystick(uint32_t port)
@@ -38,17 +38,17 @@ Joystick::Joystick(uint32_t port)
m_axes[kZAxis] = kDefaultZAxis; m_axes[kZAxis] = kDefaultZAxis;
m_axes[kTwistAxis] = kDefaultTwistAxis; m_axes[kTwistAxis] = kDefaultTwistAxis;
m_axes[kThrottleAxis] = kDefaultThrottleAxis; m_axes[kThrottleAxis] = kDefaultThrottleAxis;
m_buttons[kTriggerButton] = kDefaultTriggerButton; m_buttons[kTriggerButton] = kDefaultTriggerButton;
m_buttons[kTopButton] = kDefaultTopButton; m_buttons[kTopButton] = kDefaultTopButton;
} }
/** /**
* Version of the constructor to be called by sub-classes. * Version of the constructor to be called by sub-classes.
* *
* This constructor allows the subclass to configure the number of constants * This constructor allows the subclass to configure the number of constants
* for axes and buttons. * for axes and buttons.
* *
* @param port The port on the driver station that the joystick is plugged into. * @param port The port on the driver station that the joystick is plugged into.
* @param numAxisTypes The number of axis types in the enum. * @param numAxisTypes The number of axis types in the enum.
* @param numButtonTypes The number of button types in the enum. * @param numButtonTypes The number of button types in the enum.
@@ -71,7 +71,7 @@ void Joystick::InitJoystick(uint32_t numAxisTypes, uint32_t numButtonTypes)
joySticksInitialized = true; joySticksInitialized = true;
} }
joysticks[m_port - 1] = this; joysticks[m_port - 1] = this;
m_ds = DriverStation::GetInstance(); m_ds = DriverStation::GetInstance();
m_axes = new uint32_t[numAxisTypes]; m_axes = new uint32_t[numAxisTypes];
m_buttons = new uint32_t[numButtonTypes]; m_buttons = new uint32_t[numButtonTypes];
@@ -141,7 +141,7 @@ float Joystick::GetThrottle()
/** /**
* Get the value of the axis. * Get the value of the axis.
* *
* @param axis The axis to read [1-6]. * @param axis The axis to read [1-6].
* @return The value of the axis. * @return The value of the axis.
*/ */
@@ -152,10 +152,10 @@ float Joystick::GetRawAxis(uint32_t axis)
/** /**
* For the current joystick, return the axis determined by the argument. * For the current joystick, return the axis determined by the argument.
* *
* This is for cases where the joystick axis is returned programatically, otherwise one of the * This is for cases where the joystick axis is returned programatically, otherwise one of the
* previous functions would be preferable (for example GetX()). * previous functions would be preferable (for example GetX()).
* *
* @param axis The axis to read. * @param axis The axis to read.
* @return The value of the axis. * @return The value of the axis.
*/ */
@@ -176,9 +176,9 @@ float Joystick::GetAxis(AxisType axis)
/** /**
* Read the state of the trigger on the joystick. * Read the state of the trigger on the joystick.
* *
* Look up which button has been assigned to the trigger and read its state. * Look up which button has been assigned to the trigger and read its state.
* *
* @param hand This parameter is ignored for the Joystick class and is only here to complete the GenericHID interface. * @param hand This parameter is ignored for the Joystick class and is only here to complete the GenericHID interface.
* @return The state of the trigger. * @return The state of the trigger.
*/ */
@@ -189,9 +189,9 @@ bool Joystick::GetTrigger(JoystickHand hand)
/** /**
* Read the state of the top button on the joystick. * Read the state of the top button on the joystick.
* *
* Look up which button has been assigned to the top and read its state. * Look up which button has been assigned to the top and read its state.
* *
* @param hand This parameter is ignored for the Joystick class and is only here to complete the GenericHID interface. * @param hand This parameter is ignored for the Joystick class and is only here to complete the GenericHID interface.
* @return The state of the top button. * @return The state of the top button.
*/ */
@@ -212,10 +212,10 @@ bool Joystick::GetBumper(JoystickHand hand)
/** /**
* Get the button value for buttons 1 through 12. * Get the button value for buttons 1 through 12.
* *
* The buttons are returned in a single 16 bit value with one bit representing the state * The buttons are returned in a single 16 bit value with one bit representing the state
* of each button. The appropriate button is returned as a boolean value. * of each button. The appropriate button is returned as a boolean value.
* *
* @param button The button number to be read. * @param button The button number to be read.
* @return The state of the button. * @return The state of the button.
**/ **/
@@ -224,11 +224,20 @@ bool Joystick::GetRawButton(uint32_t button)
return m_ds->GetStickButton(m_port, button); return m_ds->GetStickButton(m_port, button);
} }
/**
* Get the state of a POV on the joystick.
*
* @return the angle of the POV in degrees, or -1 if the POV is not pressed.
*/
int Joystick::GetPOV(uint32_t pov) {
return 0; // TODO
}
/** /**
* Get buttons based on an enumerated type. * Get buttons based on an enumerated type.
* *
* The button type will be looked up in the list of buttons and then read. * The button type will be looked up in the list of buttons and then read.
* *
* @param button The type of button to read. * @param button The type of button to read.
* @return The state of the button. * @return The state of the button.
*/ */
@@ -245,7 +254,7 @@ bool Joystick::GetButton(ButtonType button)
/** /**
* Get the channel currently associated with the specified axis. * Get the channel currently associated with the specified axis.
* *
* @param axis The axis to look up the channel for. * @param axis The axis to look up the channel for.
* @return The channel fr the axis. * @return The channel fr the axis.
*/ */
@@ -256,7 +265,7 @@ uint32_t Joystick::GetAxisChannel(AxisType axis)
/** /**
* Set the channel associated with a specified axis. * Set the channel associated with a specified axis.
* *
* @param axis The axis to set the channel for. * @param axis The axis to set the channel for.
* @param channel The channel to set the axis to. * @param channel The channel to set the axis to.
*/ */
@@ -268,7 +277,7 @@ void Joystick::SetAxisChannel(AxisType axis, uint32_t channel)
/** /**
* Get the magnitude of the direction vector formed by the joystick's * Get the magnitude of the direction vector formed by the joystick's
* current position relative to its origin * current position relative to its origin
* *
* @return The magnitude of the direction vector * @return The magnitude of the direction vector
*/ */
float Joystick::GetMagnitude(){ float Joystick::GetMagnitude(){
@@ -278,7 +287,7 @@ float Joystick::GetMagnitude(){
/** /**
* Get the direction of the vector formed by the joystick and its origin * Get the direction of the vector formed by the joystick and its origin
* in radians * in radians
* *
* @return The direction of the vector in radians * @return The direction of the vector in radians
*/ */
float Joystick::GetDirectionRadians(){ float Joystick::GetDirectionRadians(){
@@ -288,10 +297,10 @@ float Joystick::GetDirectionRadians(){
/** /**
* Get the direction of the vector formed by the joystick and its origin * Get the direction of the vector formed by the joystick and its origin
* in degrees * in degrees
* *
* uses acos(-1) to represent Pi due to absence of readily accessable Pi * uses acos(-1) to represent Pi due to absence of readily accessable Pi
* constant in C++ * constant in C++
* *
* @return The direction of the vector in degrees * @return The direction of the vector in degrees
*/ */
float Joystick::GetDirectionDegrees(){ float Joystick::GetDirectionDegrees(){

View File

@@ -152,4 +152,10 @@ public abstract class GenericHID {
* @return true if the button is pressed * @return true if the button is pressed
*/ */
public abstract boolean getRawButton(int button); public abstract boolean getRawButton(int button);
public abstract int getPOV(int pov);
public int getPOV() {
return getPOV(1);
}
} }

View File

@@ -30,10 +30,6 @@ public class DriverStation implements RobotState.Interface {
* Number of Joystick Ports * Number of Joystick Ports
*/ */
public static final int kJoystickPorts = 4; public static final int kJoystickPorts = 4;
/**
* Number of Joystick Axes
*/
public static final int kJoystickAxes = 6;
/** /**
* Convert from raw values to volts * Convert from raw values to volts
*/ */
@@ -61,7 +57,8 @@ public class DriverStation implements RobotState.Interface {
private HALControlWord m_controlWord; private HALControlWord m_controlWord;
private HALAllianceStationID m_allianceStationID; private HALAllianceStationID m_allianceStationID;
private short[][] m_joystickAxes = new short[kJoystickAxes][kJoystickPorts]; private short[][] m_joystickAxes = new short[FRCNetworkCommunicationsLibrary.kMaxJoystickAxes][kJoystickPorts];
private short[][] m_joystickPOVs = new short[FRCNetworkCommunicationsLibrary.kMaxJoystickPOVs][kJoystickPorts];
private int[] m_joystickButtons = new int[kJoystickPorts]; private int[] m_joystickButtons = new int[kJoystickPorts];
private Thread m_thread; private Thread m_thread;
@@ -185,6 +182,7 @@ public class DriverStation implements RobotState.Interface {
for(byte stick = 0; stick < kJoystickPorts; stick++) { for(byte stick = 0; stick < kJoystickPorts; stick++) {
m_joystickButtons[stick] = FRCNetworkCommunicationsLibrary.HALGetJoystickButtons(stick); m_joystickButtons[stick] = FRCNetworkCommunicationsLibrary.HALGetJoystickButtons(stick);
m_joystickAxes[stick] = FRCNetworkCommunicationsLibrary.HALGetJoystickAxes(stick); m_joystickAxes[stick] = FRCNetworkCommunicationsLibrary.HALGetJoystickAxes(stick);
m_joystickPOVs[stick] = FRCNetworkCommunicationsLibrary.HALGetJoystickPOVs(stick);
} }
if (!lastEnabled && isEnabled()) { if (!lastEnabled && isEnabled()) {
@@ -228,7 +226,7 @@ public class DriverStation implements RobotState.Interface {
throw new RuntimeException("Joystick index is out of range, should be 0-3"); throw new RuntimeException("Joystick index is out of range, should be 0-3");
} }
if (axis < 1 || axis > kJoystickAxes) { if (axis < 1 || axis > m_joystickAxes[stick].length) {
throw new RuntimeException("Joystick axis is out of range"); throw new RuntimeException("Joystick axis is out of range");
} }
@@ -241,6 +239,23 @@ public class DriverStation implements RobotState.Interface {
} }
} }
/**
* Get the state of a POV on the joystick.
*
* @return the angle of the POV in degrees, or -1 if the POV is not pressed.
*/
public int getStickPOV(int stick, int pov) {
if(stick < 0 || stick >= kJoystickPorts) {
throw new RuntimeException("Joystick index is out of range, should be 0-3");
}
if (pov < 1 || pov > m_joystickPOVs[stick].length) {
throw new RuntimeException("Joystick POV is out of range");
}
return m_joystickPOVs[stick][pov - 1];
}
/** /**
* The state of the buttons on the joystick. * The state of the buttons on the joystick.
* 12 buttons (4 msb are unused) from the joystick. * 12 buttons (4 msb are unused) from the joystick.

View File

@@ -279,6 +279,15 @@ public class Joystick extends GenericHID {
return ((0x1 << (button - 1)) & m_ds.getStickButtons(m_port)) != 0; return ((0x1 << (button - 1)) & m_ds.getStickButtons(m_port)) != 0;
} }
/**
* Get the state of a POV on the joystick.
*
* @return the angle of the POV in degrees, or -1 if the POV is not pressed.
*/
public int getPOV(int pov) {
return m_ds.getStickPOV(m_port, pov - 1);
}
/** /**
* Get buttons based on an enumerated type. * Get buttons based on an enumerated type.
* *

View File

@@ -463,7 +463,10 @@ public class FRCNetworkCommunicationsLibrary extends JNIWrapper {
case 2: case 2:
return HALAllianceStationID.Red3; return HALAllianceStationID.Red3;
case 3: case 3:
return HALAllianceStationID.Blue1;
case 4:
return HALAllianceStationID.Blue2; return HALAllianceStationID.Blue2;
case 5:
return HALAllianceStationID.Blue3; return HALAllianceStationID.Blue3;
default: default:
return null; return null;

View File

@@ -293,7 +293,7 @@ JNIEXPORT jshortArray JNICALL Java_edu_wpi_first_wpilibj_communication_FRCNetwor
(JNIEnv * env, jclass, jbyte joystickNum) (JNIEnv * env, jclass, jbyte joystickNum)
{ {
HALJoystickAxes axes; HALJoystickAxes axes;
HALGetJoystickAxes(joystickNum, &axes, 6); HALGetJoystickAxes(joystickNum, &axes);
jshortArray axesArray = env->NewShortArray(axes.count); jshortArray axesArray = env->NewShortArray(axes.count);
env->SetShortArrayRegion(axesArray, 0, axes.count, axes.axes); env->SetShortArrayRegion(axesArray, 0, axes.count, axes.axes);
@@ -301,6 +301,23 @@ JNIEXPORT jshortArray JNICALL Java_edu_wpi_first_wpilibj_communication_FRCNetwor
return axesArray; return axesArray;
} }
/*
* Class: edu_wpi_first_wpilibj_communication_FRCNetworkCommunicationsLibrary
* Method: HALGetJoystickPOVs
* Signature: (B)[S
*/
JNIEXPORT jshortArray JNICALL Java_edu_wpi_first_wpilibj_communication_FRCNetworkCommunicationsLibrary_HALGetJoystickPOVs
(JNIEnv * env, jclass, jbyte joystickNum)
{
HALJoystickPOVs povs;
HALGetJoystickPOVs(joystickNum, &povs);
jshortArray povsArray = env->NewShortArray(povs.count);
env->SetShortArrayRegion(povsArray, 0, povs.count, povs.povs);
return povsArray;
}
/* /*
* Class: edu_wpi_first_wpilibj_communication_FRCNetworkCommunicationsLibrary * Class: edu_wpi_first_wpilibj_communication_FRCNetworkCommunicationsLibrary
* Method: HALGetJoystickButtons * Method: HALGetJoystickButtons

View File

@@ -276,6 +276,15 @@ public class Joystick extends GenericHID {
return m_ds.getStickButton(m_port, button); return m_ds.getStickButton(m_port, button);
} }
/**
* Get the state of a POV on the joystick.
*
* @return the angle of the POV in degrees, or -1 if the POV is not pressed.
*/
public int getPOV(int pov) {
return 0; // TODO
}
/** /**
* Get buttons based on an enumerated type. * Get buttons based on an enumerated type.
* *