2016-07-07 21:31:45 -07:00
|
|
|
/*----------------------------------------------------------------------------*/
|
2020-06-26 17:12:55 -07:00
|
|
|
/* Copyright (c) 2016-2020 FIRST. All Rights Reserved. */
|
2016-07-07 21:31:45 -07:00
|
|
|
/* Open Source Software - may be modified and shared by FRC teams. The code */
|
|
|
|
|
/* must be accompanied by the FIRST BSD license file in the root directory of */
|
|
|
|
|
/* the project. */
|
|
|
|
|
/*----------------------------------------------------------------------------*/
|
|
|
|
|
|
|
|
|
|
#include <jni.h>
|
|
|
|
|
|
2018-05-13 17:09:56 -07:00
|
|
|
#include <cassert>
|
2016-07-07 21:31:45 -07:00
|
|
|
|
2018-05-13 17:09:56 -07:00
|
|
|
#include "HALUtil.h"
|
2018-09-20 21:59:46 -07:00
|
|
|
#include "edu_wpi_first_hal_AnalogGyroJNI.h"
|
2018-07-20 00:03:45 -07:00
|
|
|
#include "hal/AnalogGyro.h"
|
|
|
|
|
#include "hal/handles/HandlesInternal.h"
|
2016-07-07 21:31:45 -07:00
|
|
|
|
2020-06-26 17:12:55 -07:00
|
|
|
using namespace hal;
|
2016-10-31 23:04:49 -07:00
|
|
|
|
2016-07-07 21:31:45 -07:00
|
|
|
extern "C" {
|
|
|
|
|
/*
|
2018-09-20 21:59:46 -07:00
|
|
|
* Class: edu_wpi_first_hal_AnalogGyroJNI
|
2016-07-07 21:31:45 -07:00
|
|
|
* Method: initializeAnalogGyro
|
|
|
|
|
* Signature: (I)I
|
|
|
|
|
*/
|
2018-05-13 17:09:56 -07:00
|
|
|
JNIEXPORT jint JNICALL
|
2018-09-20 21:59:46 -07:00
|
|
|
Java_edu_wpi_first_hal_AnalogGyroJNI_initializeAnalogGyro
|
2018-05-13 17:09:56 -07:00
|
|
|
(JNIEnv* env, jclass, jint id)
|
|
|
|
|
{
|
2016-07-07 21:31:45 -07:00
|
|
|
int32_t status = 0;
|
2018-05-13 17:09:56 -07:00
|
|
|
HAL_GyroHandle handle =
|
|
|
|
|
HAL_InitializeAnalogGyro((HAL_AnalogInputHandle)id, &status);
|
2016-07-13 20:29:28 -07:00
|
|
|
// Analog input does range checking, so we don't need to do so.
|
2016-09-29 20:18:40 -07:00
|
|
|
CheckStatusForceThrow(env, status);
|
2018-05-13 17:09:56 -07:00
|
|
|
return (jint)handle;
|
2016-07-07 21:31:45 -07:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/*
|
2018-09-20 21:59:46 -07:00
|
|
|
* Class: edu_wpi_first_hal_AnalogGyroJNI
|
2016-07-07 21:31:45 -07:00
|
|
|
* Method: setupAnalogGyro
|
|
|
|
|
* Signature: (I)V
|
|
|
|
|
*/
|
2018-05-13 17:09:56 -07:00
|
|
|
JNIEXPORT void JNICALL
|
2018-09-20 21:59:46 -07:00
|
|
|
Java_edu_wpi_first_hal_AnalogGyroJNI_setupAnalogGyro
|
2018-05-13 17:09:56 -07:00
|
|
|
(JNIEnv* env, jclass, jint id)
|
|
|
|
|
{
|
2016-07-07 21:31:45 -07:00
|
|
|
int32_t status = 0;
|
2016-07-09 00:24:26 -07:00
|
|
|
HAL_SetupAnalogGyro((HAL_GyroHandle)id, &status);
|
2016-07-07 21:31:45 -07:00
|
|
|
CheckStatus(env, status);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/*
|
2018-09-20 21:59:46 -07:00
|
|
|
* Class: edu_wpi_first_hal_AnalogGyroJNI
|
2016-07-07 21:31:45 -07:00
|
|
|
* Method: freeAnalogGyro
|
|
|
|
|
* Signature: (I)V
|
|
|
|
|
*/
|
2018-05-13 17:09:56 -07:00
|
|
|
JNIEXPORT void JNICALL
|
2018-09-20 21:59:46 -07:00
|
|
|
Java_edu_wpi_first_hal_AnalogGyroJNI_freeAnalogGyro
|
2018-05-13 17:09:56 -07:00
|
|
|
(JNIEnv* env, jclass, jint id)
|
|
|
|
|
{
|
2016-07-09 00:24:26 -07:00
|
|
|
HAL_FreeAnalogGyro((HAL_GyroHandle)id);
|
2016-07-07 21:31:45 -07:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/*
|
2018-09-20 21:59:46 -07:00
|
|
|
* Class: edu_wpi_first_hal_AnalogGyroJNI
|
2016-07-07 21:31:45 -07:00
|
|
|
* Method: setAnalogGyroParameters
|
2016-11-20 07:25:03 -08:00
|
|
|
* Signature: (IDDI)V
|
2016-07-07 21:31:45 -07:00
|
|
|
*/
|
2018-05-13 17:09:56 -07:00
|
|
|
JNIEXPORT void JNICALL
|
2018-09-20 21:59:46 -07:00
|
|
|
Java_edu_wpi_first_hal_AnalogGyroJNI_setAnalogGyroParameters
|
2018-05-13 17:09:56 -07:00
|
|
|
(JNIEnv* env, jclass, jint id, jdouble vPDPS, jdouble offset, jint center)
|
|
|
|
|
{
|
2016-07-07 21:31:45 -07:00
|
|
|
int32_t status = 0;
|
2018-05-13 17:09:56 -07:00
|
|
|
HAL_SetAnalogGyroParameters((HAL_GyroHandle)id, vPDPS, offset, center,
|
|
|
|
|
&status);
|
2016-07-07 21:31:45 -07:00
|
|
|
CheckStatus(env, status);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/*
|
2018-09-20 21:59:46 -07:00
|
|
|
* Class: edu_wpi_first_hal_AnalogGyroJNI
|
2016-07-07 21:31:45 -07:00
|
|
|
* Method: setAnalogGyroVoltsPerDegreePerSecond
|
2016-11-20 07:25:03 -08:00
|
|
|
* Signature: (ID)V
|
2016-07-07 21:31:45 -07:00
|
|
|
*/
|
2018-05-13 17:09:56 -07:00
|
|
|
JNIEXPORT void JNICALL
|
2018-09-20 21:59:46 -07:00
|
|
|
Java_edu_wpi_first_hal_AnalogGyroJNI_setAnalogGyroVoltsPerDegreePerSecond
|
2018-05-13 17:09:56 -07:00
|
|
|
(JNIEnv* env, jclass, jint id, jdouble vPDPS)
|
|
|
|
|
{
|
2016-07-07 21:31:45 -07:00
|
|
|
int32_t status = 0;
|
2016-07-09 00:24:26 -07:00
|
|
|
HAL_SetAnalogGyroVoltsPerDegreePerSecond((HAL_GyroHandle)id, vPDPS, &status);
|
2016-07-07 21:31:45 -07:00
|
|
|
CheckStatus(env, status);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/*
|
2018-09-20 21:59:46 -07:00
|
|
|
* Class: edu_wpi_first_hal_AnalogGyroJNI
|
2016-07-07 21:31:45 -07:00
|
|
|
* Method: resetAnalogGyro
|
|
|
|
|
* Signature: (I)V
|
|
|
|
|
*/
|
2018-05-13 17:09:56 -07:00
|
|
|
JNIEXPORT void JNICALL
|
2018-09-20 21:59:46 -07:00
|
|
|
Java_edu_wpi_first_hal_AnalogGyroJNI_resetAnalogGyro
|
2018-05-13 17:09:56 -07:00
|
|
|
(JNIEnv* env, jclass, jint id)
|
|
|
|
|
{
|
2016-07-07 21:31:45 -07:00
|
|
|
int32_t status = 0;
|
2016-07-09 00:24:26 -07:00
|
|
|
HAL_ResetAnalogGyro((HAL_GyroHandle)id, &status);
|
2016-07-07 21:31:45 -07:00
|
|
|
CheckStatus(env, status);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/*
|
2018-09-20 21:59:46 -07:00
|
|
|
* Class: edu_wpi_first_hal_AnalogGyroJNI
|
2016-07-07 21:31:45 -07:00
|
|
|
* Method: calibrateAnalogGyro
|
|
|
|
|
* Signature: (I)V
|
|
|
|
|
*/
|
2018-05-13 17:09:56 -07:00
|
|
|
JNIEXPORT void JNICALL
|
2018-09-20 21:59:46 -07:00
|
|
|
Java_edu_wpi_first_hal_AnalogGyroJNI_calibrateAnalogGyro
|
2018-05-13 17:09:56 -07:00
|
|
|
(JNIEnv* env, jclass, jint id)
|
|
|
|
|
{
|
2016-07-07 21:31:45 -07:00
|
|
|
int32_t status = 0;
|
2016-07-09 00:24:26 -07:00
|
|
|
HAL_CalibrateAnalogGyro((HAL_GyroHandle)id, &status);
|
2016-07-07 21:31:45 -07:00
|
|
|
CheckStatus(env, status);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/*
|
2018-09-20 21:59:46 -07:00
|
|
|
* Class: edu_wpi_first_hal_AnalogGyroJNI
|
2016-07-07 21:31:45 -07:00
|
|
|
* Method: setAnalogGyroDeadband
|
2016-11-20 07:25:03 -08:00
|
|
|
* Signature: (ID)V
|
2016-07-07 21:31:45 -07:00
|
|
|
*/
|
2018-05-13 17:09:56 -07:00
|
|
|
JNIEXPORT void JNICALL
|
2018-09-20 21:59:46 -07:00
|
|
|
Java_edu_wpi_first_hal_AnalogGyroJNI_setAnalogGyroDeadband
|
2018-05-13 17:09:56 -07:00
|
|
|
(JNIEnv* env, jclass, jint id, jdouble deadband)
|
|
|
|
|
{
|
2016-07-07 21:31:45 -07:00
|
|
|
int32_t status = 0;
|
2016-07-09 00:24:26 -07:00
|
|
|
HAL_SetAnalogGyroDeadband((HAL_GyroHandle)id, deadband, &status);
|
2016-07-07 21:31:45 -07:00
|
|
|
CheckStatus(env, status);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/*
|
2018-09-20 21:59:46 -07:00
|
|
|
* Class: edu_wpi_first_hal_AnalogGyroJNI
|
2016-07-07 21:31:45 -07:00
|
|
|
* Method: getAnalogGyroAngle
|
2016-11-20 07:25:03 -08:00
|
|
|
* Signature: (I)D
|
2016-07-07 21:31:45 -07:00
|
|
|
*/
|
2018-05-13 17:09:56 -07:00
|
|
|
JNIEXPORT jdouble JNICALL
|
2018-09-20 21:59:46 -07:00
|
|
|
Java_edu_wpi_first_hal_AnalogGyroJNI_getAnalogGyroAngle
|
2018-05-13 17:09:56 -07:00
|
|
|
(JNIEnv* env, jclass, jint id)
|
|
|
|
|
{
|
2016-07-07 21:31:45 -07:00
|
|
|
int32_t status = 0;
|
2016-11-20 07:25:03 -08:00
|
|
|
jdouble value = HAL_GetAnalogGyroAngle((HAL_GyroHandle)id, &status);
|
2016-07-07 21:31:45 -07:00
|
|
|
CheckStatus(env, status);
|
|
|
|
|
return value;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/*
|
2018-09-20 21:59:46 -07:00
|
|
|
* Class: edu_wpi_first_hal_AnalogGyroJNI
|
2016-07-07 21:31:45 -07:00
|
|
|
* Method: getAnalogGyroRate
|
|
|
|
|
* Signature: (I)D
|
|
|
|
|
*/
|
2018-05-13 17:09:56 -07:00
|
|
|
JNIEXPORT jdouble JNICALL
|
2018-09-20 21:59:46 -07:00
|
|
|
Java_edu_wpi_first_hal_AnalogGyroJNI_getAnalogGyroRate
|
2018-05-13 17:09:56 -07:00
|
|
|
(JNIEnv* env, jclass, jint id)
|
|
|
|
|
{
|
2016-07-07 21:31:45 -07:00
|
|
|
int32_t status = 0;
|
2016-07-09 00:24:26 -07:00
|
|
|
jdouble value = HAL_GetAnalogGyroRate((HAL_GyroHandle)id, &status);
|
2016-07-07 21:31:45 -07:00
|
|
|
CheckStatus(env, status);
|
|
|
|
|
return value;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/*
|
2018-09-20 21:59:46 -07:00
|
|
|
* Class: edu_wpi_first_hal_AnalogGyroJNI
|
2016-07-07 21:31:45 -07:00
|
|
|
* Method: getAnalogGyroOffset
|
2016-11-20 07:25:03 -08:00
|
|
|
* Signature: (I)D
|
2016-07-07 21:31:45 -07:00
|
|
|
*/
|
2018-05-13 17:09:56 -07:00
|
|
|
JNIEXPORT jdouble JNICALL
|
2018-09-20 21:59:46 -07:00
|
|
|
Java_edu_wpi_first_hal_AnalogGyroJNI_getAnalogGyroOffset
|
2018-05-13 17:09:56 -07:00
|
|
|
(JNIEnv* env, jclass, jint id)
|
|
|
|
|
{
|
2016-07-07 21:31:45 -07:00
|
|
|
int32_t status = 0;
|
2016-11-20 07:25:03 -08:00
|
|
|
jdouble value = HAL_GetAnalogGyroOffset((HAL_GyroHandle)id, &status);
|
2016-07-07 21:31:45 -07:00
|
|
|
CheckStatus(env, status);
|
|
|
|
|
return value;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/*
|
2018-09-20 21:59:46 -07:00
|
|
|
* Class: edu_wpi_first_hal_AnalogGyroJNI
|
2016-07-07 21:31:45 -07:00
|
|
|
* Method: getAnalogGyroCenter
|
|
|
|
|
* Signature: (I)I
|
|
|
|
|
*/
|
2018-05-13 17:09:56 -07:00
|
|
|
JNIEXPORT jint JNICALL
|
2018-09-20 21:59:46 -07:00
|
|
|
Java_edu_wpi_first_hal_AnalogGyroJNI_getAnalogGyroCenter
|
2018-05-13 17:09:56 -07:00
|
|
|
(JNIEnv* env, jclass, jint id)
|
|
|
|
|
{
|
2016-07-07 21:31:45 -07:00
|
|
|
int32_t status = 0;
|
2016-07-09 00:24:26 -07:00
|
|
|
jint value = HAL_GetAnalogGyroCenter((HAL_GyroHandle)id, &status);
|
2016-07-07 21:31:45 -07:00
|
|
|
CheckStatus(env, status);
|
|
|
|
|
return value;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
} // extern "C"
|