Sensor inercial#

Introducción#

La clase inertial se utiliza para controlar y acceder a los datos de un sensor inercial V5 conectado a un puerto inteligente.

El sensor inercial V5 mide el movimiento y los giros del robot. El giroscopio mide la dirección, la rotación, la velocidad angular y la orientación. El acelerómetro mide los cambios de movimiento, como la aceleración o la desaceleración en los ejes x, y y z.

Constructores de clases#

inertial(
  int32_t  index,
  turnType dir = turnType::right );

Instructor de clase#

Destruye el objeto inercial inertial y libera los recursos asociados.

~inertial();

Parámetros#

Parámetro

Tipo

Descripción

index

int32_t

El puerto inteligente al que está conectado el sensor inercial, escrito como PORTx, donde x es el número de puerto (por ejemplo, PORT1).

dir

turnType

Opcional. La dirección que devuelve valores positivos:

  • right (predeterminado) — Los giros a la derecha devuelven valores positivos.
  • left — Los giros a la izquierda devuelven valores positivos.

Ejemplos#

// Create an inertial instance for the V5 Inertial Sensor
inertial myInertial = inertial(
    PORT1,      // Smart Port 1
    right);     // dir

Funciones de los miembros#

La clase inertial incluye las siguientes funciones miembro:

  • heading — Devuelve la dirección hacia la que apunta el sensor.

  • rotation — Devuelve cuánto ha girado el sensor.

  • setHeading — Establece el rumbo actual del sensor a un nuevo valor de rumbo.

  • setRotation — Establece la rotación actual del sensor a un nuevo valor de rotación.

  • calibrate — Calibra el sensor inercial.

  • resetHeading — Restablece el rumbo actual del sensor a 0 grados.

  • resetRotation — Restablece la rotación actual del sensor a 0 grados.

  • isCalibrating — Devuelve si el sensor inercial se está calibrando actualmente.

  • changed — Registra una función de devolución de llamada que se ejecuta cuando cambia el encabezado.

  • installed — Devuelve si el sensor inercial está instalado.

  • acceleration — Devuelve la rapidez con la que el sensor acelera o desacelera en el eje seleccionado.

  • gyroRate — Devuelve la velocidad de rotación del sensor en el eje seleccionado.

  • orientation — Devuelve el ángulo de balanceo, cabeceo o guiñada del sensor inercial.

  • collision — Registra una función de devolución de llamada que se ejecuta cuando se detecta una colisión.

  • setTurnType — Establece qué dirección de giro devuelve valores positivos.

  • getTurnType — Devuelve qué dirección de giro produce valores positivos.

Antes de llamar a cualquier función miembro inertial , se debe crear una instancia inertial , como se muestra a continuación:

/* This constructor is required when using VS Code.
Inertial Sensor configuration is generated automatically
in VEXcode using the Device Menu. Replace the values
as needed. */

// Create an inertial instance for the V5 Inertial Sensor connected to Port 1.
inertial myInertial = inertial(PORT1);

heading#

La orientación es la dirección hacia la que apunta el sensor, medida en grados de 0 a 359,99. Esta función devuelve la orientación actual del sensor.

El rumbo inicial es de 0 grados. Si el sensor gira más allá de los 359,99 grados, el rumbo vuelve a 0 grados.

Available Functions
double heading( rotationUnits units = degrees );

Parameters

Parámetro

Tipo

Descripción

units

rotationUnits

Unidad de encabezado:

  • deg / degrees (predeterminado) — grados
  • turns / rev — revoluciones

Return Values

Devuelve un valor booleano double que representa la orientación actual del sensor en las unidades especificadas.

Notes
  • El valor de la dirección se ajusta entre 0 y 359,99 grados. Utilice rotation para acceder al valor de rotación continua.

Examples
// Turn, then show the current heading
Drivetrain.turnFor(right, 450, degrees);
Brain.Screen.print("%f", myInertial.heading(degrees));

rotation#

Devuelve la rotación actual del sensor inercial.

La rotación indica cuánto ha girado el sensor. A diferencia de la orientación, la rotación puede superar los 359,99 grados o disminuir por debajo de 0 grados. Por ejemplo, dos giros completos a la derecha dan como resultado una rotación de 720 grados. Un giro completo a la izquierda desde 0 grados da como resultado una rotación de -360 grados.

Available Functions
double rotation( rotationUnits units = degrees );

Parameters

Parámetro

Tipo

Descripción

units

rotationUnits

Unidad de rotación:

  • deg / degrees (predeterminado) — grados
  • turns / rev — revoluciones

Return Values

Returns a double representing the current rotation in the specified units.

Notes
  • El valor de rotación es continuo y no se reinicia entre 0 y 359,99 grados. Utilice heading para acceder al valor de rumbo reiniciado.

Examples
// Turn, then show the current rotation
Drivetrain.turnFor(right, 450, degrees);
Brain.Screen.print("%f", myInertial.rotation(degrees));

setHeading#

La orientación es la dirección hacia la que apunta el sensor, medida en grados de 0 a 359,99. Esta función cambia la orientación actual del sensor inercial a un nuevo valor.

Por ejemplo, si el sensor se ha girado hacia la derecha, al ajustar la orientación a 0 grados, esa posición hacia la derecha se convierte en la nueva dirección de 0 grados. De esta forma, el sensor puede seguir otras orientaciones basándose en esa nueva dirección.

Available Functions
void setHeading( double value, rotationUnits units );

Parameters

Parámetro

Tipo

Descripción

value

double

El valor de rumbo, en grados, que se configurará para el sensor. Este valor puede estar entre 0 y 359,99.

units

rotationUnits

Unidad de medida:

  • deg / degrees — grados
  • turns / rev — revoluciones

Return Values

Esta función no devuelve ningún valor.

Examples
// Turn the robot around
myInertial.setHeading(180, degrees);
Drivetrain.turnToHeading(0, degrees);

setRotation#

La rotación indica cuánto ha girado el sensor, medida en grados. A diferencia de la orientación, la rotación puede superar los 359,99 grados o disminuir por debajo de 0 grados. Al inicio de un proyecto, el valor de rotación se establece en 0 grados. Esta función cambia la rotación actual del sensor inercial a un nuevo valor.

Por ejemplo, si el sensor ha dado dos vueltas completas a la derecha, su valor de rotación será de 720 grados. Al establecer la rotación en 0 grados, esta volverá a su valor original. De esta forma, el sensor podrá registrar las rotaciones basándose en ese nuevo valor.

Available Functions
void setRotation( double value, rotationUnits units );

Parameters

Parámetro

Tipo

Descripción

value

double

El valor de rotación, en grados, que se configurará para el sensor. Puede ser un número entero o decimal.

units

rotationUnits

Unidad de rotación:

  • deg / degrees — grados
  • turns / rev — revoluciones

Return Values

Esta función no devuelve ningún valor.

Examples
// Turn the robot around
myInertial.setRotation(-180, degrees);
Drivetrain.turnToRotation(0, degrees);

calibrate#

Calibra el sensor inercial.

La calibración ayuda al sensor a medir los giros correctamente. Mantenga el sensor inmóvil durante la calibración. Si el sensor se mueve durante la calibración, es posible que los valores de rumbo, rotación, velocidad angular y orientación no se midan correctamente.

Available Functions
void calibrate( );

Parameters

Esta función no acepta ningún parámetro.

Return Values

Esta función no devuelve ningún valor.

Notes
  • El sensor debe permanecer inmóvil mientras se realiza la calibración.

  • Utilice isCalibrating para determinar cuándo se ha completado la calibración.

resetHeading#

Restablece la orientación actual del sensor inercial a 0 grados.

Una vez utilizada esta función, la dirección actual del sensor se convierte en la nueva dirección de 0 grados.

Available Functions
void resetHeading();

Parameters

Esta función no requiere ningún parámetro.

Return Values

Esta función no devuelve ningún valor.

resetRotation#

Restablece la rotación actual del sensor inercial a 0 grados.

Una vez utilizada esta función, el sensor realiza un seguimiento de los giros futuros a partir del nuevo valor de rotación de 0 grados.

Available Functions
void resetRotation();

Parameters

Esta función no requiere ningún parámetro.

Return Values

Esta función no devuelve ningún valor.

isCalibrating#

Indica si el sensor inercial se está calibrando actualmente.

Available Functions
bool isCalibrating();

Parameters

Esta función no requiere ningún parámetro.

Return Values

Devuelve un valor booleano que indica si el sensor inercial se está calibrando:

  • true — The sensor is currently calibrating.
  • false — The sensor is not currently calibrating.

changed#

Registra una función de devolución de llamada que se ejecuta cuando cambia el valor de rumbo del sensor inercial.

Available Functions
void changed( void (* callback)(void) );

Parameters

Parámetro

Tipo

Descripción

callback

void (*)(void)

Un puntero a una función que se llamará cuando cambie el valor del encabezado. La función no debe tomar parámetros y devolver void.

Return Values

Esta función no devuelve ningún valor.

Examples

Defina la función de devolución de llamada (fuera de int main())

// Display the heading when the Inertial Sensor's heading value changes.
void onHeadingChanged() {
  Brain.Screen.clearScreen();
  Brain.Screen.setCursor(1, 1);
  Brain.Screen.print("Heading: %.2f", myInertial.heading());
}

Registra la función de devolución de llamada dentro de int main()

int main() {
  // Run onHeadingChanged when the Inertial Sensor's heading value changes.
  myInertial.changed(onHeadingChanged);
}

installed#

Indica si el sensor inercial está instalado y conectado.

Available Functions
bool installed();

Parameters

Esta función no requiere ningún parámetro.

Return Values

Devuelve un valor booleano que indica si el sensor inercial está instalado y conectado:

  • true — The sensor is connected and responding.
  • false — The sensor is not connected or not detected.

acceleration#

La aceleración indica la rapidez con la que el sensor aumenta o disminuye su velocidad. Esta función devuelve la aceleración del sensor inercial en el eje seleccionado, desde -4,0 G hasta 4,0 G.

G es una unidad que se utiliza para medir la aceleración. 1 G equivale aproximadamente a la aceleración que se siente debido a la gravedad estando sentado. El valor puede ser positivo o negativo según la dirección de la aceleración en el eje seleccionado.

Available Functions
double acceleration( axisType axis );

Parameters

Parámetro

Tipo

Descripción

axis

axisType

Ejes para medir la aceleración:

  • xaxis
  • yaxis
  • zaxis

Return Values

Returns a double representing the acceleration along the specified axis in G (gravitational units).

Notes
  • Los valores de aceleración se informan en unidades de G.

gyroRate#

La velocidad del giroscopio indica la rapidez con la que gira el sensor inercial. Esta función devuelve la velocidad de rotación actual del sensor inercial en el eje seleccionado.

El valor puede ser positivo o negativo dependiendo de la dirección en la que gire el sensor sobre ese eje.

Available Functions
double gyroRate( axisType axis, velocityUnits units );

Parameters

Parámetro

Tipo

Descripción

axis

axisType

Eje desde el que se obtiene la velocidad del giroscopio:

  • xaxis
  • yaxis
  • zaxis

units

velocityUnits

Unidad de velocidad del giroscopio:

  • dps — grados por segundo
  • rpm — revoluciones por minuto

Return Values

Returns a double representing the current rotation speed along the specified axis in the selected units.

Examples
// Display the rate of change of rotation while turning in dps
Drivetrain.turn(right);
wait(1, seconds);

Brain.Screen.print(myInertial.gyroRate(zaxis, dps));

Drivetrain.stop();

orientation#

La orientación es el ángulo actual del sensor inercial en el eje seleccionado. Esta función devuelve la orientación actual del sensor inercial para el eje especificado.

El eje x, y o z seleccionado corresponde a uno de los ejes de orientación del sensor.

Available Functions
double orientation(
  axisType      axis,
  rotationUnits units );

Parameters

Parámetro

Tipo

Descripción

axis

axisType

El eje para el que se devuelve la orientación:

  • xaxis
  • yaxis
  • zaxis

units

rotationUnits

Unidad de orientación:

  • deg / degrees — grados
  • turns / rev — revoluciones

Return Values

Returns a double representing the selected orientation angle in the specified units.

Examples
while (true) {
  Brain.Screen.clearScreen();
  Brain.Screen.setCursor(1,1);
  // Show the Inertial Sensor's orientation value
  // for roll in degrees
  double orient = myInertial.orientation(xaxis, deg);
  Brain.Screen.print("%f", orient);
  wait(0.1, seconds);
}

collision#

Registra una función de devolución de llamada que se ejecuta cuando el sensor inercial detecta un impacto o colisión repentina.

Available Functions
void collision( void (* callback)(axisType, double, double, double) );

Parameters

Parámetro

Tipo

Descripción

callback

void (*)(axisType, double, double, double)

Un puntero a una función que se llamará cuando se detecte una colisión. La función de devolución de llamada debe aceptar los siguientes parámetros:

  • axisType — El eje en el que se detectó la colisión.
  • Valores de aceleración en el momento del impacto, en orden:
    • double — Aceleración a lo largo del eje x (en G).
    • double — Aceleración a lo largo del eje y (en G).
    • double — Aceleración a lo largo del eje z (en G).
La función debe devolver void.

Return Values

Esta función no devuelve ningún valor.

Examples

Defina la función de devolución de llamada (fuera de int main())

// Display a message when the Inertial Sensor detects a collision.
void onCollision(axisType axis, double x, double y, double z) {
  Brain.Screen.print("Collision detected!");
}

Registra la función de devolución de llamada dentro de int main()

int main() {
  // Run onCollision when the Inertial Sensor detects a collision.
  myInertial.collision(onCollision);
}

setTurnType#

Los conjuntos que indican la dirección de giro devuelven valores positivos.

Available Functions
void setTurnType( turnType dir );

Parameters

Parámetro

Tipo

Descripción

dir

turnType

La dirección que devuelve valores positivos:

  • right
  • left

Return Values

Esta función no devuelve ningún valor.

Notes

getTurnType#

Devuelve valores cuyo cambio de dirección produce valores positivos.

Available Functions
turnType getTurnType();

Parameters

Esta función no requiere ningún parámetro.

Return Values

Devuelve un valor turnType que indica qué dirección produce valores positivos:

  • right — Clockwise rotation returns positive values.
  • left — Counterclockwise rotation returns positive values.
Notes